2 RFCOMM implementation for Linux Bluetooth stack (BlueZ).
3 Copyright (C) 2002 Maxim Krasnyansky <maxk@qualcomm.com>
4 Copyright (C) 2002 Marcel Holtmann <marcel@holtmann.org>
6 This program is free software; you can redistribute it and/or modify
7 it under the terms of the GNU General Public License version 2 as
8 published by the Free Software Foundation;
10 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
11 OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
12 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
13 IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
14 CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
15 WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
16 ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
17 OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
19 ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
20 COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
21 SOFTWARE IS DISCLAIMED.
27 * $Id: tty.c,v 1.24 2002/10/03 01:54:38 holtmann Exp $
30 #include <linux/module.h>
32 #include <linux/tty.h>
33 #include <linux/tty_driver.h>
34 #include <linux/tty_flip.h>
36 #include <linux/capability.h>
37 #include <linux/slab.h>
38 #include <linux/skbuff.h>
40 #include <net/bluetooth/bluetooth.h>
41 #include <net/bluetooth/rfcomm.h>
43 #ifndef CONFIG_BT_RFCOMM_DEBUG
48 #define RFCOMM_TTY_MAGIC 0x6d02 /* magic number for rfcomm struct */
49 #define RFCOMM_TTY_PORTS RFCOMM_MAX_DEV /* whole lotta rfcomm devices */
50 #define RFCOMM_TTY_MAJOR 216 /* device node major id of the usb/bluetooth.c driver */
51 #define RFCOMM_TTY_MINOR 0
53 static struct tty_driver *rfcomm_tty_driver;
56 struct list_head list;
71 struct rfcomm_dlc *dlc;
72 struct tty_struct *tty;
73 wait_queue_head_t wait;
74 struct tasklet_struct wakeup_task;
79 static LIST_HEAD(rfcomm_dev_list);
80 static DEFINE_RWLOCK(rfcomm_dev_lock);
82 static void rfcomm_dev_data_ready(struct rfcomm_dlc *dlc, struct sk_buff *skb);
83 static void rfcomm_dev_state_change(struct rfcomm_dlc *dlc, int err);
84 static void rfcomm_dev_modem_status(struct rfcomm_dlc *dlc, u8 v24_sig);
86 static void rfcomm_tty_wakeup(unsigned long arg);
88 /* ---- Device functions ---- */
89 static void rfcomm_dev_destruct(struct rfcomm_dev *dev)
91 struct rfcomm_dlc *dlc = dev->dlc;
93 BT_DBG("dev %p dlc %p", dev, dlc);
96 /* Detach DLC if it's owned by this dev */
97 if (dlc->owner == dev)
99 rfcomm_dlc_unlock(dlc);
103 tty_unregister_device(rfcomm_tty_driver, dev->id);
105 /* Refcount should only hit zero when called from rfcomm_dev_del()
106 which will have taken us off the list. Everything else are
108 BUG_ON(!list_empty(&dev->list));
112 /* It's safe to call module_put() here because socket still
113 holds reference to this module. */
114 module_put(THIS_MODULE);
117 static inline void rfcomm_dev_hold(struct rfcomm_dev *dev)
119 atomic_inc(&dev->refcnt);
122 static inline void rfcomm_dev_put(struct rfcomm_dev *dev)
124 /* The reason this isn't actually a race, as you no
125 doubt have a little voice screaming at you in your
126 head, is that the refcount should never actually
127 reach zero unless the device has already been taken
128 off the list, in rfcomm_dev_del(). And if that's not
129 true, we'll hit the BUG() in rfcomm_dev_destruct()
131 if (atomic_dec_and_test(&dev->refcnt))
132 rfcomm_dev_destruct(dev);
135 static struct rfcomm_dev *__rfcomm_dev_get(int id)
137 struct rfcomm_dev *dev;
140 list_for_each(p, &rfcomm_dev_list) {
141 dev = list_entry(p, struct rfcomm_dev, list);
149 static inline struct rfcomm_dev *rfcomm_dev_get(int id)
151 struct rfcomm_dev *dev;
153 read_lock(&rfcomm_dev_lock);
155 dev = __rfcomm_dev_get(id);
157 rfcomm_dev_hold(dev);
159 read_unlock(&rfcomm_dev_lock);
164 static int rfcomm_dev_add(struct rfcomm_dev_req *req, struct rfcomm_dlc *dlc)
166 struct rfcomm_dev *dev;
167 struct list_head *head = &rfcomm_dev_list, *p;
170 BT_DBG("id %d channel %d", req->dev_id, req->channel);
172 dev = kmalloc(sizeof(struct rfcomm_dev), GFP_KERNEL);
175 memset(dev, 0, sizeof(struct rfcomm_dev));
177 write_lock_bh(&rfcomm_dev_lock);
179 if (req->dev_id < 0) {
182 list_for_each(p, &rfcomm_dev_list) {
183 if (list_entry(p, struct rfcomm_dev, list)->id != dev->id)
190 dev->id = req->dev_id;
192 list_for_each(p, &rfcomm_dev_list) {
193 struct rfcomm_dev *entry = list_entry(p, struct rfcomm_dev, list);
195 if (entry->id == dev->id) {
200 if (entry->id > dev->id - 1)
207 if ((dev->id < 0) || (dev->id > RFCOMM_MAX_DEV - 1)) {
212 sprintf(dev->name, "rfcomm%d", dev->id);
214 list_add(&dev->list, head);
215 atomic_set(&dev->refcnt, 1);
217 bacpy(&dev->src, &req->src);
218 bacpy(&dev->dst, &req->dst);
219 dev->channel = req->channel;
221 dev->flags = req->flags &
222 ((1 << RFCOMM_RELEASE_ONHUP) | (1 << RFCOMM_REUSE_DLC));
224 init_waitqueue_head(&dev->wait);
225 tasklet_init(&dev->wakeup_task, rfcomm_tty_wakeup, (unsigned long) dev);
227 rfcomm_dlc_lock(dlc);
228 dlc->data_ready = rfcomm_dev_data_ready;
229 dlc->state_change = rfcomm_dev_state_change;
230 dlc->modem_status = rfcomm_dev_modem_status;
234 rfcomm_dlc_unlock(dlc);
236 /* It's safe to call __module_get() here because socket already
237 holds reference to this module. */
238 __module_get(THIS_MODULE);
241 write_unlock_bh(&rfcomm_dev_lock);
248 tty_register_device(rfcomm_tty_driver, dev->id, NULL);
253 static void rfcomm_dev_del(struct rfcomm_dev *dev)
255 BT_DBG("dev %p", dev);
257 write_lock_bh(&rfcomm_dev_lock);
258 list_del_init(&dev->list);
259 write_unlock_bh(&rfcomm_dev_lock);
264 /* ---- Send buffer ---- */
265 static inline unsigned int rfcomm_room(struct rfcomm_dlc *dlc)
267 /* We can't let it be zero, because we don't get a callback
268 when tx_credits becomes nonzero, hence we'd never wake up */
269 return dlc->mtu * (dlc->tx_credits?:1);
272 static void rfcomm_wfree(struct sk_buff *skb)
274 struct rfcomm_dev *dev = (void *) skb->sk;
275 atomic_sub(skb->truesize, &dev->wmem_alloc);
276 if (test_bit(RFCOMM_TTY_ATTACHED, &dev->flags))
277 tasklet_schedule(&dev->wakeup_task);
281 static inline void rfcomm_set_owner_w(struct sk_buff *skb, struct rfcomm_dev *dev)
283 rfcomm_dev_hold(dev);
284 atomic_add(skb->truesize, &dev->wmem_alloc);
285 skb->sk = (void *) dev;
286 skb->destructor = rfcomm_wfree;
289 static struct sk_buff *rfcomm_wmalloc(struct rfcomm_dev *dev, unsigned long size, gfp_t priority)
291 if (atomic_read(&dev->wmem_alloc) < rfcomm_room(dev->dlc)) {
292 struct sk_buff *skb = alloc_skb(size, priority);
294 rfcomm_set_owner_w(skb, dev);
301 /* ---- Device IOCTLs ---- */
303 #define NOCAP_FLAGS ((1 << RFCOMM_REUSE_DLC) | (1 << RFCOMM_RELEASE_ONHUP))
305 static int rfcomm_create_dev(struct sock *sk, void __user *arg)
307 struct rfcomm_dev_req req;
308 struct rfcomm_dlc *dlc;
311 if (copy_from_user(&req, arg, sizeof(req)))
314 BT_DBG("sk %p dev_id %id flags 0x%x", sk, req.dev_id, req.flags);
316 if (req.flags != NOCAP_FLAGS && !capable(CAP_NET_ADMIN))
319 if (req.flags & (1 << RFCOMM_REUSE_DLC)) {
320 /* Socket must be connected */
321 if (sk->sk_state != BT_CONNECTED)
324 dlc = rfcomm_pi(sk)->dlc;
325 rfcomm_dlc_hold(dlc);
327 dlc = rfcomm_dlc_alloc(GFP_KERNEL);
332 id = rfcomm_dev_add(&req, dlc);
338 if (req.flags & (1 << RFCOMM_REUSE_DLC)) {
339 /* DLC is now used by device.
340 * Socket must be disconnected */
341 sk->sk_state = BT_CLOSED;
347 static int rfcomm_release_dev(void __user *arg)
349 struct rfcomm_dev_req req;
350 struct rfcomm_dev *dev;
352 if (copy_from_user(&req, arg, sizeof(req)))
355 BT_DBG("dev_id %id flags 0x%x", req.dev_id, req.flags);
357 if (!(dev = rfcomm_dev_get(req.dev_id)))
360 if (dev->flags != NOCAP_FLAGS && !capable(CAP_NET_ADMIN)) {
365 if (req.flags & (1 << RFCOMM_HANGUP_NOW))
366 rfcomm_dlc_close(dev->dlc, 0);
373 static int rfcomm_get_dev_list(void __user *arg)
375 struct rfcomm_dev_list_req *dl;
376 struct rfcomm_dev_info *di;
378 int n = 0, size, err;
383 if (get_user(dev_num, (u16 __user *) arg))
386 if (!dev_num || dev_num > (PAGE_SIZE * 4) / sizeof(*di))
389 size = sizeof(*dl) + dev_num * sizeof(*di);
391 if (!(dl = kmalloc(size, GFP_KERNEL)))
396 read_lock_bh(&rfcomm_dev_lock);
398 list_for_each(p, &rfcomm_dev_list) {
399 struct rfcomm_dev *dev = list_entry(p, struct rfcomm_dev, list);
400 (di + n)->id = dev->id;
401 (di + n)->flags = dev->flags;
402 (di + n)->state = dev->dlc->state;
403 (di + n)->channel = dev->channel;
404 bacpy(&(di + n)->src, &dev->src);
405 bacpy(&(di + n)->dst, &dev->dst);
410 read_unlock_bh(&rfcomm_dev_lock);
413 size = sizeof(*dl) + n * sizeof(*di);
415 err = copy_to_user(arg, dl, size);
418 return err ? -EFAULT : 0;
421 static int rfcomm_get_dev_info(void __user *arg)
423 struct rfcomm_dev *dev;
424 struct rfcomm_dev_info di;
429 if (copy_from_user(&di, arg, sizeof(di)))
432 if (!(dev = rfcomm_dev_get(di.id)))
435 di.flags = dev->flags;
436 di.channel = dev->channel;
437 di.state = dev->dlc->state;
438 bacpy(&di.src, &dev->src);
439 bacpy(&di.dst, &dev->dst);
441 if (copy_to_user(arg, &di, sizeof(di)))
448 int rfcomm_dev_ioctl(struct sock *sk, unsigned int cmd, void __user *arg)
450 BT_DBG("cmd %d arg %p", cmd, arg);
453 case RFCOMMCREATEDEV:
454 return rfcomm_create_dev(sk, arg);
456 case RFCOMMRELEASEDEV:
457 return rfcomm_release_dev(arg);
459 case RFCOMMGETDEVLIST:
460 return rfcomm_get_dev_list(arg);
462 case RFCOMMGETDEVINFO:
463 return rfcomm_get_dev_info(arg);
469 /* ---- DLC callbacks ---- */
470 static void rfcomm_dev_data_ready(struct rfcomm_dlc *dlc, struct sk_buff *skb)
472 struct rfcomm_dev *dev = dlc->owner;
473 struct tty_struct *tty;
475 if (!dev || !(tty = dev->tty)) {
480 BT_DBG("dlc %p tty %p len %d", dlc, tty, skb->len);
482 tty_insert_flip_string(tty, skb->data, skb->len);
483 tty_flip_buffer_push(tty);
488 static void rfcomm_dev_state_change(struct rfcomm_dlc *dlc, int err)
490 struct rfcomm_dev *dev = dlc->owner;
494 BT_DBG("dlc %p dev %p err %d", dlc, dev, err);
497 wake_up_interruptible(&dev->wait);
499 if (dlc->state == BT_CLOSED) {
501 if (test_bit(RFCOMM_RELEASE_ONHUP, &dev->flags)) {
502 rfcomm_dev_hold(dev);
505 /* We have to drop DLC lock here, otherwise
506 rfcomm_dev_put() will dead lock if it's
507 the last reference. */
508 rfcomm_dlc_unlock(dlc);
510 rfcomm_dlc_lock(dlc);
513 tty_hangup(dev->tty);
517 static void rfcomm_dev_modem_status(struct rfcomm_dlc *dlc, u8 v24_sig)
519 struct rfcomm_dev *dev = dlc->owner;
523 BT_DBG("dlc %p dev %p v24_sig 0x%02x", dlc, dev, v24_sig);
525 if ((dev->modem_status & TIOCM_CD) && !(v24_sig & RFCOMM_V24_DV)) {
526 if (dev->tty && !C_CLOCAL(dev->tty))
527 tty_hangup(dev->tty);
531 ((v24_sig & RFCOMM_V24_RTC) ? (TIOCM_DSR | TIOCM_DTR) : 0) |
532 ((v24_sig & RFCOMM_V24_RTR) ? (TIOCM_RTS | TIOCM_CTS) : 0) |
533 ((v24_sig & RFCOMM_V24_IC) ? TIOCM_RI : 0) |
534 ((v24_sig & RFCOMM_V24_DV) ? TIOCM_CD : 0);
537 /* ---- TTY functions ---- */
538 static void rfcomm_tty_wakeup(unsigned long arg)
540 struct rfcomm_dev *dev = (void *) arg;
541 struct tty_struct *tty = dev->tty;
545 BT_DBG("dev %p tty %p", dev, tty);
547 if (test_bit(TTY_DO_WRITE_WAKEUP, &tty->flags) && tty->ldisc.write_wakeup)
548 (tty->ldisc.write_wakeup)(tty);
550 wake_up_interruptible(&tty->write_wait);
551 #ifdef SERIAL_HAVE_POLL_WAIT
552 wake_up_interruptible(&tty->poll_wait);
556 static int rfcomm_tty_open(struct tty_struct *tty, struct file *filp)
558 DECLARE_WAITQUEUE(wait, current);
559 struct rfcomm_dev *dev;
560 struct rfcomm_dlc *dlc;
565 BT_DBG("tty %p id %d", tty, id);
567 /* We don't leak this refcount. For reasons which are not entirely
568 clear, the TTY layer will call our ->close() method even if the
569 open fails. We decrease the refcount there, and decreasing it
570 here too would cause breakage. */
571 dev = rfcomm_dev_get(id);
575 BT_DBG("dev %p dst %s channel %d opened %d", dev, batostr(&dev->dst), dev->channel, dev->opened);
577 if (dev->opened++ != 0)
582 /* Attach TTY and open DLC */
584 rfcomm_dlc_lock(dlc);
585 tty->driver_data = dev;
587 rfcomm_dlc_unlock(dlc);
588 set_bit(RFCOMM_TTY_ATTACHED, &dev->flags);
590 err = rfcomm_dlc_open(dlc, &dev->src, &dev->dst, dev->channel);
594 /* Wait for DLC to connect */
595 add_wait_queue(&dev->wait, &wait);
597 set_current_state(TASK_INTERRUPTIBLE);
599 if (dlc->state == BT_CLOSED) {
604 if (dlc->state == BT_CONNECTED)
607 if (signal_pending(current)) {
614 set_current_state(TASK_RUNNING);
615 remove_wait_queue(&dev->wait, &wait);
620 static void rfcomm_tty_close(struct tty_struct *tty, struct file *filp)
622 struct rfcomm_dev *dev = (struct rfcomm_dev *) tty->driver_data;
626 BT_DBG("tty %p dev %p dlc %p opened %d", tty, dev, dev->dlc, dev->opened);
628 if (--dev->opened == 0) {
629 /* Close DLC and dettach TTY */
630 rfcomm_dlc_close(dev->dlc, 0);
632 clear_bit(RFCOMM_TTY_ATTACHED, &dev->flags);
633 tasklet_kill(&dev->wakeup_task);
635 rfcomm_dlc_lock(dev->dlc);
636 tty->driver_data = NULL;
638 rfcomm_dlc_unlock(dev->dlc);
644 static int rfcomm_tty_write(struct tty_struct *tty, const unsigned char *buf, int count)
646 struct rfcomm_dev *dev = (struct rfcomm_dev *) tty->driver_data;
647 struct rfcomm_dlc *dlc = dev->dlc;
649 int err = 0, sent = 0, size;
651 BT_DBG("tty %p count %d", tty, count);
654 size = min_t(uint, count, dlc->mtu);
656 skb = rfcomm_wmalloc(dev, size + RFCOMM_SKB_RESERVE, GFP_ATOMIC);
661 skb_reserve(skb, RFCOMM_SKB_HEAD_RESERVE);
663 memcpy(skb_put(skb, size), buf + sent, size);
665 if ((err = rfcomm_dlc_send(dlc, skb)) < 0) {
674 return sent ? sent : err;
677 static int rfcomm_tty_write_room(struct tty_struct *tty)
679 struct rfcomm_dev *dev = (struct rfcomm_dev *) tty->driver_data;
682 BT_DBG("tty %p", tty);
684 room = rfcomm_room(dev->dlc) - atomic_read(&dev->wmem_alloc);
690 static int rfcomm_tty_ioctl(struct tty_struct *tty, struct file *filp, unsigned int cmd, unsigned long arg)
692 BT_DBG("tty %p cmd 0x%02x", tty, cmd);
696 BT_DBG("TCGETS is not supported");
700 BT_DBG("TCSETS is not supported");
704 BT_DBG("TIOCMIWAIT");
708 BT_DBG("TIOCGICOUNT");
712 BT_ERR("TIOCGSERIAL is not supported");
716 BT_ERR("TIOCSSERIAL is not supported");
720 BT_ERR("TIOCSERGSTRUCT is not supported");
724 BT_ERR("TIOCSERGETLSR is not supported");
728 BT_ERR("TIOCSERCONFIG is not supported");
732 return -ENOIOCTLCMD; /* ioctls which we must ignore */
739 static void rfcomm_tty_set_termios(struct tty_struct *tty, struct termios *old)
741 struct termios *new = (struct termios *) tty->termios;
742 int old_baud_rate = tty_termios_baud_rate(old);
743 int new_baud_rate = tty_termios_baud_rate(new);
745 u8 baud, data_bits, stop_bits, parity, x_on, x_off;
748 struct rfcomm_dev *dev = (struct rfcomm_dev *) tty->driver_data;
750 BT_DBG("tty %p termios %p", tty, old);
752 /* Handle turning off CRTSCTS */
753 if ((old->c_cflag & CRTSCTS) && !(new->c_cflag & CRTSCTS))
754 BT_DBG("Turning off CRTSCTS unsupported");
756 /* Parity on/off and when on, odd/even */
757 if (((old->c_cflag & PARENB) != (new->c_cflag & PARENB)) ||
758 ((old->c_cflag & PARODD) != (new->c_cflag & PARODD)) ) {
759 changes |= RFCOMM_RPN_PM_PARITY;
760 BT_DBG("Parity change detected.");
763 /* Mark and space parity are not supported! */
764 if (new->c_cflag & PARENB) {
765 if (new->c_cflag & PARODD) {
766 BT_DBG("Parity is ODD");
767 parity = RFCOMM_RPN_PARITY_ODD;
769 BT_DBG("Parity is EVEN");
770 parity = RFCOMM_RPN_PARITY_EVEN;
773 BT_DBG("Parity is OFF");
774 parity = RFCOMM_RPN_PARITY_NONE;
777 /* Setting the x_on / x_off characters */
778 if (old->c_cc[VSTOP] != new->c_cc[VSTOP]) {
779 BT_DBG("XOFF custom");
780 x_on = new->c_cc[VSTOP];
781 changes |= RFCOMM_RPN_PM_XON;
783 BT_DBG("XOFF default");
784 x_on = RFCOMM_RPN_XON_CHAR;
787 if (old->c_cc[VSTART] != new->c_cc[VSTART]) {
788 BT_DBG("XON custom");
789 x_off = new->c_cc[VSTART];
790 changes |= RFCOMM_RPN_PM_XOFF;
792 BT_DBG("XON default");
793 x_off = RFCOMM_RPN_XOFF_CHAR;
796 /* Handle setting of stop bits */
797 if ((old->c_cflag & CSTOPB) != (new->c_cflag & CSTOPB))
798 changes |= RFCOMM_RPN_PM_STOP;
800 /* POSIX does not support 1.5 stop bits and RFCOMM does not
801 * support 2 stop bits. So a request for 2 stop bits gets
802 * translated to 1.5 stop bits */
803 if (new->c_cflag & CSTOPB) {
804 stop_bits = RFCOMM_RPN_STOP_15;
806 stop_bits = RFCOMM_RPN_STOP_1;
809 /* Handle number of data bits [5-8] */
810 if ((old->c_cflag & CSIZE) != (new->c_cflag & CSIZE))
811 changes |= RFCOMM_RPN_PM_DATA;
813 switch (new->c_cflag & CSIZE) {
815 data_bits = RFCOMM_RPN_DATA_5;
818 data_bits = RFCOMM_RPN_DATA_6;
821 data_bits = RFCOMM_RPN_DATA_7;
824 data_bits = RFCOMM_RPN_DATA_8;
827 data_bits = RFCOMM_RPN_DATA_8;
831 /* Handle baudrate settings */
832 if (old_baud_rate != new_baud_rate)
833 changes |= RFCOMM_RPN_PM_BITRATE;
835 switch (new_baud_rate) {
837 baud = RFCOMM_RPN_BR_2400;
840 baud = RFCOMM_RPN_BR_4800;
843 baud = RFCOMM_RPN_BR_7200;
846 baud = RFCOMM_RPN_BR_9600;
849 baud = RFCOMM_RPN_BR_19200;
852 baud = RFCOMM_RPN_BR_38400;
855 baud = RFCOMM_RPN_BR_57600;
858 baud = RFCOMM_RPN_BR_115200;
861 baud = RFCOMM_RPN_BR_230400;
864 /* 9600 is standard accordinag to the RFCOMM specification */
865 baud = RFCOMM_RPN_BR_9600;
871 rfcomm_send_rpn(dev->dlc->session, 1, dev->dlc->dlci, baud,
872 data_bits, stop_bits, parity,
873 RFCOMM_RPN_FLOW_NONE, x_on, x_off, changes);
878 static void rfcomm_tty_throttle(struct tty_struct *tty)
880 struct rfcomm_dev *dev = (struct rfcomm_dev *) tty->driver_data;
882 BT_DBG("tty %p dev %p", tty, dev);
884 rfcomm_dlc_throttle(dev->dlc);
887 static void rfcomm_tty_unthrottle(struct tty_struct *tty)
889 struct rfcomm_dev *dev = (struct rfcomm_dev *) tty->driver_data;
891 BT_DBG("tty %p dev %p", tty, dev);
893 rfcomm_dlc_unthrottle(dev->dlc);
896 static int rfcomm_tty_chars_in_buffer(struct tty_struct *tty)
898 struct rfcomm_dev *dev = (struct rfcomm_dev *) tty->driver_data;
899 struct rfcomm_dlc *dlc = dev->dlc;
901 BT_DBG("tty %p dev %p", tty, dev);
903 if (!skb_queue_empty(&dlc->tx_queue))
909 static void rfcomm_tty_flush_buffer(struct tty_struct *tty)
911 struct rfcomm_dev *dev = (struct rfcomm_dev *) tty->driver_data;
915 BT_DBG("tty %p dev %p", tty, dev);
917 skb_queue_purge(&dev->dlc->tx_queue);
919 if (test_bit(TTY_DO_WRITE_WAKEUP, &tty->flags) && tty->ldisc.write_wakeup)
920 tty->ldisc.write_wakeup(tty);
923 static void rfcomm_tty_send_xchar(struct tty_struct *tty, char ch)
925 BT_DBG("tty %p ch %c", tty, ch);
928 static void rfcomm_tty_wait_until_sent(struct tty_struct *tty, int timeout)
930 BT_DBG("tty %p timeout %d", tty, timeout);
933 static void rfcomm_tty_hangup(struct tty_struct *tty)
935 struct rfcomm_dev *dev = (struct rfcomm_dev *) tty->driver_data;
939 BT_DBG("tty %p dev %p", tty, dev);
941 rfcomm_tty_flush_buffer(tty);
943 if (test_bit(RFCOMM_RELEASE_ONHUP, &dev->flags))
947 static int rfcomm_tty_read_proc(char *buf, char **start, off_t offset, int len, int *eof, void *unused)
952 static int rfcomm_tty_tiocmget(struct tty_struct *tty, struct file *filp)
954 struct rfcomm_dev *dev = (struct rfcomm_dev *) tty->driver_data;
956 BT_DBG("tty %p dev %p", tty, dev);
958 return dev->modem_status;
961 static int rfcomm_tty_tiocmset(struct tty_struct *tty, struct file *filp, unsigned int set, unsigned int clear)
963 struct rfcomm_dev *dev = (struct rfcomm_dev *) tty->driver_data;
964 struct rfcomm_dlc *dlc = dev->dlc;
967 BT_DBG("tty %p dev %p set 0x%02x clear 0x%02x", tty, dev, set, clear);
969 rfcomm_dlc_get_modem_status(dlc, &v24_sig);
971 if (set & TIOCM_DSR || set & TIOCM_DTR)
972 v24_sig |= RFCOMM_V24_RTC;
973 if (set & TIOCM_RTS || set & TIOCM_CTS)
974 v24_sig |= RFCOMM_V24_RTR;
976 v24_sig |= RFCOMM_V24_IC;
978 v24_sig |= RFCOMM_V24_DV;
980 if (clear & TIOCM_DSR || clear & TIOCM_DTR)
981 v24_sig &= ~RFCOMM_V24_RTC;
982 if (clear & TIOCM_RTS || clear & TIOCM_CTS)
983 v24_sig &= ~RFCOMM_V24_RTR;
984 if (clear & TIOCM_RI)
985 v24_sig &= ~RFCOMM_V24_IC;
986 if (clear & TIOCM_CD)
987 v24_sig &= ~RFCOMM_V24_DV;
989 rfcomm_dlc_set_modem_status(dlc, v24_sig);
994 /* ---- TTY structure ---- */
996 static struct tty_operations rfcomm_ops = {
997 .open = rfcomm_tty_open,
998 .close = rfcomm_tty_close,
999 .write = rfcomm_tty_write,
1000 .write_room = rfcomm_tty_write_room,
1001 .chars_in_buffer = rfcomm_tty_chars_in_buffer,
1002 .flush_buffer = rfcomm_tty_flush_buffer,
1003 .ioctl = rfcomm_tty_ioctl,
1004 .throttle = rfcomm_tty_throttle,
1005 .unthrottle = rfcomm_tty_unthrottle,
1006 .set_termios = rfcomm_tty_set_termios,
1007 .send_xchar = rfcomm_tty_send_xchar,
1008 .hangup = rfcomm_tty_hangup,
1009 .wait_until_sent = rfcomm_tty_wait_until_sent,
1010 .read_proc = rfcomm_tty_read_proc,
1011 .tiocmget = rfcomm_tty_tiocmget,
1012 .tiocmset = rfcomm_tty_tiocmset,
1015 int rfcomm_init_ttys(void)
1017 rfcomm_tty_driver = alloc_tty_driver(RFCOMM_TTY_PORTS);
1018 if (!rfcomm_tty_driver)
1021 rfcomm_tty_driver->owner = THIS_MODULE;
1022 rfcomm_tty_driver->driver_name = "rfcomm";
1023 rfcomm_tty_driver->name = "rfcomm";
1024 rfcomm_tty_driver->major = RFCOMM_TTY_MAJOR;
1025 rfcomm_tty_driver->minor_start = RFCOMM_TTY_MINOR;
1026 rfcomm_tty_driver->type = TTY_DRIVER_TYPE_SERIAL;
1027 rfcomm_tty_driver->subtype = SERIAL_TYPE_NORMAL;
1028 rfcomm_tty_driver->flags = TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV;
1029 rfcomm_tty_driver->init_termios = tty_std_termios;
1030 rfcomm_tty_driver->init_termios.c_cflag = B9600 | CS8 | CREAD | HUPCL | CLOCAL;
1031 tty_set_operations(rfcomm_tty_driver, &rfcomm_ops);
1033 if (tty_register_driver(rfcomm_tty_driver)) {
1034 BT_ERR("Can't register RFCOMM TTY driver");
1035 put_tty_driver(rfcomm_tty_driver);
1039 BT_INFO("RFCOMM TTY layer initialized");
1044 void rfcomm_cleanup_ttys(void)
1046 tty_unregister_driver(rfcomm_tty_driver);
1047 put_tty_driver(rfcomm_tty_driver);