[PARISC] irq_affinityp[] only available for SMP builds
[linux-2.6.22.y-op.git] / net / bluetooth / sco.c
blob9cb00dc6c08c6d18b4cf1031a4405e144d1f69c0
1 /*
2 BlueZ - Bluetooth protocol stack for Linux
3 Copyright (C) 2000-2001 Qualcomm Incorporated
5 Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com>
7 This program is free software; you can redistribute it and/or modify
8 it under the terms of the GNU General Public License version 2 as
9 published by the Free Software Foundation;
11 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
12 OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
13 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
14 IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
15 CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
16 WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
17 ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
18 OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
20 ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
21 COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
22 SOFTWARE IS DISCLAIMED.
25 /* Bluetooth SCO sockets. */
27 #include <linux/config.h>
28 #include <linux/module.h>
30 #include <linux/types.h>
31 #include <linux/errno.h>
32 #include <linux/kernel.h>
33 #include <linux/sched.h>
34 #include <linux/slab.h>
35 #include <linux/poll.h>
36 #include <linux/fcntl.h>
37 #include <linux/init.h>
38 #include <linux/interrupt.h>
39 #include <linux/socket.h>
40 #include <linux/skbuff.h>
41 #include <linux/device.h>
42 #include <linux/list.h>
43 #include <net/sock.h>
45 #include <asm/system.h>
46 #include <asm/uaccess.h>
48 #include <net/bluetooth/bluetooth.h>
49 #include <net/bluetooth/hci_core.h>
50 #include <net/bluetooth/sco.h>
52 #ifndef CONFIG_BT_SCO_DEBUG
53 #undef BT_DBG
54 #define BT_DBG(D...)
55 #endif
57 #define VERSION "0.5"
59 static struct proto_ops sco_sock_ops;
61 static struct bt_sock_list sco_sk_list = {
62 .lock = RW_LOCK_UNLOCKED
65 static void __sco_chan_add(struct sco_conn *conn, struct sock *sk, struct sock *parent);
66 static void sco_chan_del(struct sock *sk, int err);
68 static int sco_conn_del(struct hci_conn *conn, int err);
70 static void sco_sock_close(struct sock *sk);
71 static void sco_sock_kill(struct sock *sk);
73 /* ---- SCO timers ---- */
74 static void sco_sock_timeout(unsigned long arg)
76 struct sock *sk = (struct sock *) arg;
78 BT_DBG("sock %p state %d", sk, sk->sk_state);
80 bh_lock_sock(sk);
81 sk->sk_err = ETIMEDOUT;
82 sk->sk_state_change(sk);
83 bh_unlock_sock(sk);
85 sco_sock_kill(sk);
86 sock_put(sk);
89 static void sco_sock_set_timer(struct sock *sk, long timeout)
91 BT_DBG("sock %p state %d timeout %ld", sk, sk->sk_state, timeout);
92 sk_reset_timer(sk, &sk->sk_timer, jiffies + timeout);
95 static void sco_sock_clear_timer(struct sock *sk)
97 BT_DBG("sock %p state %d", sk, sk->sk_state);
98 sk_stop_timer(sk, &sk->sk_timer);
101 static void sco_sock_init_timer(struct sock *sk)
103 init_timer(&sk->sk_timer);
104 sk->sk_timer.function = sco_sock_timeout;
105 sk->sk_timer.data = (unsigned long)sk;
108 /* ---- SCO connections ---- */
109 static struct sco_conn *sco_conn_add(struct hci_conn *hcon, __u8 status)
111 struct hci_dev *hdev = hcon->hdev;
112 struct sco_conn *conn;
114 if ((conn = hcon->sco_data))
115 return conn;
117 if (status)
118 return conn;
120 if (!(conn = kmalloc(sizeof(struct sco_conn), GFP_ATOMIC)))
121 return NULL;
122 memset(conn, 0, sizeof(struct sco_conn));
124 spin_lock_init(&conn->lock);
126 hcon->sco_data = conn;
127 conn->hcon = hcon;
129 conn->src = &hdev->bdaddr;
130 conn->dst = &hcon->dst;
132 if (hdev->sco_mtu > 0)
133 conn->mtu = hdev->sco_mtu;
134 else
135 conn->mtu = 60;
137 BT_DBG("hcon %p conn %p", hcon, conn);
138 return conn;
141 static inline struct sock *sco_chan_get(struct sco_conn *conn)
143 struct sock *sk = NULL;
144 sco_conn_lock(conn);
145 sk = conn->sk;
146 sco_conn_unlock(conn);
147 return sk;
150 static int sco_conn_del(struct hci_conn *hcon, int err)
152 struct sco_conn *conn;
153 struct sock *sk;
155 if (!(conn = hcon->sco_data))
156 return 0;
158 BT_DBG("hcon %p conn %p, err %d", hcon, conn, err);
160 /* Kill socket */
161 if ((sk = sco_chan_get(conn))) {
162 bh_lock_sock(sk);
163 sco_sock_clear_timer(sk);
164 sco_chan_del(sk, err);
165 bh_unlock_sock(sk);
166 sco_sock_kill(sk);
169 hcon->sco_data = NULL;
170 kfree(conn);
171 return 0;
174 static inline int sco_chan_add(struct sco_conn *conn, struct sock *sk, struct sock *parent)
176 int err = 0;
178 sco_conn_lock(conn);
179 if (conn->sk) {
180 err = -EBUSY;
181 } else {
182 __sco_chan_add(conn, sk, parent);
184 sco_conn_unlock(conn);
185 return err;
188 static int sco_connect(struct sock *sk)
190 bdaddr_t *src = &bt_sk(sk)->src;
191 bdaddr_t *dst = &bt_sk(sk)->dst;
192 struct sco_conn *conn;
193 struct hci_conn *hcon;
194 struct hci_dev *hdev;
195 int err = 0;
197 BT_DBG("%s -> %s", batostr(src), batostr(dst));
199 if (!(hdev = hci_get_route(dst, src)))
200 return -EHOSTUNREACH;
202 hci_dev_lock_bh(hdev);
204 err = -ENOMEM;
206 hcon = hci_connect(hdev, SCO_LINK, dst);
207 if (!hcon)
208 goto done;
210 conn = sco_conn_add(hcon, 0);
211 if (!conn) {
212 hci_conn_put(hcon);
213 goto done;
216 /* Update source addr of the socket */
217 bacpy(src, conn->src);
219 err = sco_chan_add(conn, sk, NULL);
220 if (err)
221 goto done;
223 if (hcon->state == BT_CONNECTED) {
224 sco_sock_clear_timer(sk);
225 sk->sk_state = BT_CONNECTED;
226 } else {
227 sk->sk_state = BT_CONNECT;
228 sco_sock_set_timer(sk, sk->sk_sndtimeo);
230 done:
231 hci_dev_unlock_bh(hdev);
232 hci_dev_put(hdev);
233 return err;
236 static inline int sco_send_frame(struct sock *sk, struct msghdr *msg, int len)
238 struct sco_conn *conn = sco_pi(sk)->conn;
239 struct sk_buff *skb;
240 int err, count;
242 /* Check outgoing MTU */
243 if (len > conn->mtu)
244 return -EINVAL;
246 BT_DBG("sk %p len %d", sk, len);
248 count = min_t(unsigned int, conn->mtu, len);
249 if (!(skb = bt_skb_send_alloc(sk, count, msg->msg_flags & MSG_DONTWAIT, &err)))
250 return err;
252 if (memcpy_fromiovec(skb_put(skb, count), msg->msg_iov, count)) {
253 err = -EFAULT;
254 goto fail;
257 if ((err = hci_send_sco(conn->hcon, skb)) < 0)
258 goto fail;
260 return count;
262 fail:
263 kfree_skb(skb);
264 return err;
267 static inline void sco_recv_frame(struct sco_conn *conn, struct sk_buff *skb)
269 struct sock *sk = sco_chan_get(conn);
271 if (!sk)
272 goto drop;
274 BT_DBG("sk %p len %d", sk, skb->len);
276 if (sk->sk_state != BT_CONNECTED)
277 goto drop;
279 if (!sock_queue_rcv_skb(sk, skb))
280 return;
282 drop:
283 kfree_skb(skb);
284 return;
287 /* -------- Socket interface ---------- */
288 static struct sock *__sco_get_sock_by_addr(bdaddr_t *ba)
290 struct sock *sk;
291 struct hlist_node *node;
293 sk_for_each(sk, node, &sco_sk_list.head)
294 if (!bacmp(&bt_sk(sk)->src, ba))
295 goto found;
296 sk = NULL;
297 found:
298 return sk;
301 /* Find socket listening on source bdaddr.
302 * Returns closest match.
304 static struct sock *sco_get_sock_listen(bdaddr_t *src)
306 struct sock *sk = NULL, *sk1 = NULL;
307 struct hlist_node *node;
309 read_lock(&sco_sk_list.lock);
311 sk_for_each(sk, node, &sco_sk_list.head) {
312 if (sk->sk_state != BT_LISTEN)
313 continue;
315 /* Exact match. */
316 if (!bacmp(&bt_sk(sk)->src, src))
317 break;
319 /* Closest match */
320 if (!bacmp(&bt_sk(sk)->src, BDADDR_ANY))
321 sk1 = sk;
324 read_unlock(&sco_sk_list.lock);
326 return node ? sk : sk1;
329 static void sco_sock_destruct(struct sock *sk)
331 BT_DBG("sk %p", sk);
333 skb_queue_purge(&sk->sk_receive_queue);
334 skb_queue_purge(&sk->sk_write_queue);
337 static void sco_sock_cleanup_listen(struct sock *parent)
339 struct sock *sk;
341 BT_DBG("parent %p", parent);
343 /* Close not yet accepted channels */
344 while ((sk = bt_accept_dequeue(parent, NULL))) {
345 sco_sock_close(sk);
346 sco_sock_kill(sk);
349 parent->sk_state = BT_CLOSED;
350 sock_set_flag(parent, SOCK_ZAPPED);
353 /* Kill socket (only if zapped and orphan)
354 * Must be called on unlocked socket.
356 static void sco_sock_kill(struct sock *sk)
358 if (!sock_flag(sk, SOCK_ZAPPED) || sk->sk_socket)
359 return;
361 BT_DBG("sk %p state %d", sk, sk->sk_state);
363 /* Kill poor orphan */
364 bt_sock_unlink(&sco_sk_list, sk);
365 sock_set_flag(sk, SOCK_DEAD);
366 sock_put(sk);
369 /* Close socket.
370 * Must be called on unlocked socket.
372 static void sco_sock_close(struct sock *sk)
374 struct sco_conn *conn;
376 sco_sock_clear_timer(sk);
378 lock_sock(sk);
380 conn = sco_pi(sk)->conn;
382 BT_DBG("sk %p state %d conn %p socket %p", sk, sk->sk_state, conn, sk->sk_socket);
384 switch (sk->sk_state) {
385 case BT_LISTEN:
386 sco_sock_cleanup_listen(sk);
387 break;
389 case BT_CONNECTED:
390 case BT_CONFIG:
391 case BT_CONNECT:
392 case BT_DISCONN:
393 sco_chan_del(sk, ECONNRESET);
394 break;
396 default:
397 sock_set_flag(sk, SOCK_ZAPPED);
398 break;
401 release_sock(sk);
403 sco_sock_kill(sk);
406 static void sco_sock_init(struct sock *sk, struct sock *parent)
408 BT_DBG("sk %p", sk);
410 if (parent)
411 sk->sk_type = parent->sk_type;
414 static struct proto sco_proto = {
415 .name = "SCO",
416 .owner = THIS_MODULE,
417 .obj_size = sizeof(struct sco_pinfo)
420 static struct sock *sco_sock_alloc(struct socket *sock, int proto, gfp_t prio)
422 struct sock *sk;
424 sk = sk_alloc(PF_BLUETOOTH, prio, &sco_proto, 1);
425 if (!sk)
426 return NULL;
428 sock_init_data(sock, sk);
429 INIT_LIST_HEAD(&bt_sk(sk)->accept_q);
431 sk->sk_destruct = sco_sock_destruct;
432 sk->sk_sndtimeo = SCO_CONN_TIMEOUT;
434 sock_reset_flag(sk, SOCK_ZAPPED);
436 sk->sk_protocol = proto;
437 sk->sk_state = BT_OPEN;
439 sco_sock_init_timer(sk);
441 bt_sock_link(&sco_sk_list, sk);
442 return sk;
445 static int sco_sock_create(struct socket *sock, int protocol)
447 struct sock *sk;
449 BT_DBG("sock %p", sock);
451 sock->state = SS_UNCONNECTED;
453 if (sock->type != SOCK_SEQPACKET)
454 return -ESOCKTNOSUPPORT;
456 sock->ops = &sco_sock_ops;
458 if (!(sk = sco_sock_alloc(sock, protocol, GFP_KERNEL)))
459 return -ENOMEM;
461 sco_sock_init(sk, NULL);
462 return 0;
465 static int sco_sock_bind(struct socket *sock, struct sockaddr *addr, int addr_len)
467 struct sockaddr_sco *sa = (struct sockaddr_sco *) addr;
468 struct sock *sk = sock->sk;
469 bdaddr_t *src = &sa->sco_bdaddr;
470 int err = 0;
472 BT_DBG("sk %p %s", sk, batostr(&sa->sco_bdaddr));
474 if (!addr || addr->sa_family != AF_BLUETOOTH)
475 return -EINVAL;
477 lock_sock(sk);
479 if (sk->sk_state != BT_OPEN) {
480 err = -EBADFD;
481 goto done;
484 write_lock_bh(&sco_sk_list.lock);
486 if (bacmp(src, BDADDR_ANY) && __sco_get_sock_by_addr(src)) {
487 err = -EADDRINUSE;
488 } else {
489 /* Save source address */
490 bacpy(&bt_sk(sk)->src, &sa->sco_bdaddr);
491 sk->sk_state = BT_BOUND;
494 write_unlock_bh(&sco_sk_list.lock);
496 done:
497 release_sock(sk);
498 return err;
501 static int sco_sock_connect(struct socket *sock, struct sockaddr *addr, int alen, int flags)
503 struct sockaddr_sco *sa = (struct sockaddr_sco *) addr;
504 struct sock *sk = sock->sk;
505 int err = 0;
508 BT_DBG("sk %p", sk);
510 if (addr->sa_family != AF_BLUETOOTH || alen < sizeof(struct sockaddr_sco))
511 return -EINVAL;
513 if (sk->sk_state != BT_OPEN && sk->sk_state != BT_BOUND)
514 return -EBADFD;
516 if (sk->sk_type != SOCK_SEQPACKET)
517 return -EINVAL;
519 lock_sock(sk);
521 /* Set destination address and psm */
522 bacpy(&bt_sk(sk)->dst, &sa->sco_bdaddr);
524 if ((err = sco_connect(sk)))
525 goto done;
527 err = bt_sock_wait_state(sk, BT_CONNECTED,
528 sock_sndtimeo(sk, flags & O_NONBLOCK));
530 done:
531 release_sock(sk);
532 return err;
535 static int sco_sock_listen(struct socket *sock, int backlog)
537 struct sock *sk = sock->sk;
538 int err = 0;
540 BT_DBG("sk %p backlog %d", sk, backlog);
542 lock_sock(sk);
544 if (sk->sk_state != BT_BOUND || sock->type != SOCK_SEQPACKET) {
545 err = -EBADFD;
546 goto done;
549 sk->sk_max_ack_backlog = backlog;
550 sk->sk_ack_backlog = 0;
551 sk->sk_state = BT_LISTEN;
553 done:
554 release_sock(sk);
555 return err;
558 static int sco_sock_accept(struct socket *sock, struct socket *newsock, int flags)
560 DECLARE_WAITQUEUE(wait, current);
561 struct sock *sk = sock->sk, *ch;
562 long timeo;
563 int err = 0;
565 lock_sock(sk);
567 if (sk->sk_state != BT_LISTEN) {
568 err = -EBADFD;
569 goto done;
572 timeo = sock_rcvtimeo(sk, flags & O_NONBLOCK);
574 BT_DBG("sk %p timeo %ld", sk, timeo);
576 /* Wait for an incoming connection. (wake-one). */
577 add_wait_queue_exclusive(sk->sk_sleep, &wait);
578 while (!(ch = bt_accept_dequeue(sk, newsock))) {
579 set_current_state(TASK_INTERRUPTIBLE);
580 if (!timeo) {
581 err = -EAGAIN;
582 break;
585 release_sock(sk);
586 timeo = schedule_timeout(timeo);
587 lock_sock(sk);
589 if (sk->sk_state != BT_LISTEN) {
590 err = -EBADFD;
591 break;
594 if (signal_pending(current)) {
595 err = sock_intr_errno(timeo);
596 break;
599 set_current_state(TASK_RUNNING);
600 remove_wait_queue(sk->sk_sleep, &wait);
602 if (err)
603 goto done;
605 newsock->state = SS_CONNECTED;
607 BT_DBG("new socket %p", ch);
609 done:
610 release_sock(sk);
611 return err;
614 static int sco_sock_getname(struct socket *sock, struct sockaddr *addr, int *len, int peer)
616 struct sockaddr_sco *sa = (struct sockaddr_sco *) addr;
617 struct sock *sk = sock->sk;
619 BT_DBG("sock %p, sk %p", sock, sk);
621 addr->sa_family = AF_BLUETOOTH;
622 *len = sizeof(struct sockaddr_sco);
624 if (peer)
625 bacpy(&sa->sco_bdaddr, &bt_sk(sk)->dst);
626 else
627 bacpy(&sa->sco_bdaddr, &bt_sk(sk)->src);
629 return 0;
632 static int sco_sock_sendmsg(struct kiocb *iocb, struct socket *sock,
633 struct msghdr *msg, size_t len)
635 struct sock *sk = sock->sk;
636 int err = 0;
638 BT_DBG("sock %p, sk %p", sock, sk);
640 if (sk->sk_err)
641 return sock_error(sk);
643 if (msg->msg_flags & MSG_OOB)
644 return -EOPNOTSUPP;
646 lock_sock(sk);
648 if (sk->sk_state == BT_CONNECTED)
649 err = sco_send_frame(sk, msg, len);
650 else
651 err = -ENOTCONN;
653 release_sock(sk);
654 return err;
657 static int sco_sock_setsockopt(struct socket *sock, int level, int optname, char __user *optval, int optlen)
659 struct sock *sk = sock->sk;
660 int err = 0;
662 BT_DBG("sk %p", sk);
664 lock_sock(sk);
666 switch (optname) {
667 default:
668 err = -ENOPROTOOPT;
669 break;
672 release_sock(sk);
673 return err;
676 static int sco_sock_getsockopt(struct socket *sock, int level, int optname, char __user *optval, int __user *optlen)
678 struct sock *sk = sock->sk;
679 struct sco_options opts;
680 struct sco_conninfo cinfo;
681 int len, err = 0;
683 BT_DBG("sk %p", sk);
685 if (get_user(len, optlen))
686 return -EFAULT;
688 lock_sock(sk);
690 switch (optname) {
691 case SCO_OPTIONS:
692 if (sk->sk_state != BT_CONNECTED) {
693 err = -ENOTCONN;
694 break;
697 opts.mtu = sco_pi(sk)->conn->mtu;
699 BT_DBG("mtu %d", opts.mtu);
701 len = min_t(unsigned int, len, sizeof(opts));
702 if (copy_to_user(optval, (char *)&opts, len))
703 err = -EFAULT;
705 break;
707 case SCO_CONNINFO:
708 if (sk->sk_state != BT_CONNECTED) {
709 err = -ENOTCONN;
710 break;
713 cinfo.hci_handle = sco_pi(sk)->conn->hcon->handle;
714 memcpy(cinfo.dev_class, sco_pi(sk)->conn->hcon->dev_class, 3);
716 len = min_t(unsigned int, len, sizeof(cinfo));
717 if (copy_to_user(optval, (char *)&cinfo, len))
718 err = -EFAULT;
720 break;
722 default:
723 err = -ENOPROTOOPT;
724 break;
727 release_sock(sk);
728 return err;
731 static int sco_sock_release(struct socket *sock)
733 struct sock *sk = sock->sk;
734 int err = 0;
736 BT_DBG("sock %p, sk %p", sock, sk);
738 if (!sk)
739 return 0;
741 sco_sock_close(sk);
743 if (sock_flag(sk, SOCK_LINGER) && sk->sk_lingertime) {
744 lock_sock(sk);
745 err = bt_sock_wait_state(sk, BT_CLOSED, sk->sk_lingertime);
746 release_sock(sk);
749 sock_orphan(sk);
750 sco_sock_kill(sk);
751 return err;
754 static void __sco_chan_add(struct sco_conn *conn, struct sock *sk, struct sock *parent)
756 BT_DBG("conn %p", conn);
758 sco_pi(sk)->conn = conn;
759 conn->sk = sk;
761 if (parent)
762 bt_accept_enqueue(parent, sk);
765 /* Delete channel.
766 * Must be called on the locked socket. */
767 static void sco_chan_del(struct sock *sk, int err)
769 struct sco_conn *conn;
771 conn = sco_pi(sk)->conn;
773 BT_DBG("sk %p, conn %p, err %d", sk, conn, err);
775 if (conn) {
776 sco_conn_lock(conn);
777 conn->sk = NULL;
778 sco_pi(sk)->conn = NULL;
779 sco_conn_unlock(conn);
780 hci_conn_put(conn->hcon);
783 sk->sk_state = BT_CLOSED;
784 sk->sk_err = err;
785 sk->sk_state_change(sk);
787 sock_set_flag(sk, SOCK_ZAPPED);
790 static void sco_conn_ready(struct sco_conn *conn)
792 struct sock *parent, *sk;
794 BT_DBG("conn %p", conn);
796 sco_conn_lock(conn);
798 if ((sk = conn->sk)) {
799 sco_sock_clear_timer(sk);
800 bh_lock_sock(sk);
801 sk->sk_state = BT_CONNECTED;
802 sk->sk_state_change(sk);
803 bh_unlock_sock(sk);
804 } else {
805 parent = sco_get_sock_listen(conn->src);
806 if (!parent)
807 goto done;
809 bh_lock_sock(parent);
811 sk = sco_sock_alloc(NULL, BTPROTO_SCO, GFP_ATOMIC);
812 if (!sk) {
813 bh_unlock_sock(parent);
814 goto done;
817 sco_sock_init(sk, parent);
819 bacpy(&bt_sk(sk)->src, conn->src);
820 bacpy(&bt_sk(sk)->dst, conn->dst);
822 hci_conn_hold(conn->hcon);
823 __sco_chan_add(conn, sk, parent);
825 sk->sk_state = BT_CONNECTED;
827 /* Wake up parent */
828 parent->sk_data_ready(parent, 1);
830 bh_unlock_sock(parent);
833 done:
834 sco_conn_unlock(conn);
837 /* ----- SCO interface with lower layer (HCI) ----- */
838 static int sco_connect_ind(struct hci_dev *hdev, bdaddr_t *bdaddr, __u8 type)
840 BT_DBG("hdev %s, bdaddr %s", hdev->name, batostr(bdaddr));
842 /* Always accept connection */
843 return HCI_LM_ACCEPT;
846 static int sco_connect_cfm(struct hci_conn *hcon, __u8 status)
848 BT_DBG("hcon %p bdaddr %s status %d", hcon, batostr(&hcon->dst), status);
850 if (hcon->type != SCO_LINK)
851 return 0;
853 if (!status) {
854 struct sco_conn *conn;
856 conn = sco_conn_add(hcon, status);
857 if (conn)
858 sco_conn_ready(conn);
859 } else
860 sco_conn_del(hcon, bt_err(status));
862 return 0;
865 static int sco_disconn_ind(struct hci_conn *hcon, __u8 reason)
867 BT_DBG("hcon %p reason %d", hcon, reason);
869 if (hcon->type != SCO_LINK)
870 return 0;
872 sco_conn_del(hcon, bt_err(reason));
873 return 0;
876 static int sco_recv_scodata(struct hci_conn *hcon, struct sk_buff *skb)
878 struct sco_conn *conn = hcon->sco_data;
880 if (!conn)
881 goto drop;
883 BT_DBG("conn %p len %d", conn, skb->len);
885 if (skb->len) {
886 sco_recv_frame(conn, skb);
887 return 0;
890 drop:
891 kfree_skb(skb);
892 return 0;
895 static ssize_t sco_sysfs_show(struct class *dev, char *buf)
897 struct sock *sk;
898 struct hlist_node *node;
899 char *str = buf;
901 read_lock_bh(&sco_sk_list.lock);
903 sk_for_each(sk, node, &sco_sk_list.head) {
904 str += sprintf(str, "%s %s %d\n",
905 batostr(&bt_sk(sk)->src), batostr(&bt_sk(sk)->dst),
906 sk->sk_state);
909 read_unlock_bh(&sco_sk_list.lock);
911 return (str - buf);
914 static CLASS_ATTR(sco, S_IRUGO, sco_sysfs_show, NULL);
916 static struct proto_ops sco_sock_ops = {
917 .family = PF_BLUETOOTH,
918 .owner = THIS_MODULE,
919 .release = sco_sock_release,
920 .bind = sco_sock_bind,
921 .connect = sco_sock_connect,
922 .listen = sco_sock_listen,
923 .accept = sco_sock_accept,
924 .getname = sco_sock_getname,
925 .sendmsg = sco_sock_sendmsg,
926 .recvmsg = bt_sock_recvmsg,
927 .poll = bt_sock_poll,
928 .ioctl = sock_no_ioctl,
929 .mmap = sock_no_mmap,
930 .socketpair = sock_no_socketpair,
931 .shutdown = sock_no_shutdown,
932 .setsockopt = sco_sock_setsockopt,
933 .getsockopt = sco_sock_getsockopt
936 static struct net_proto_family sco_sock_family_ops = {
937 .family = PF_BLUETOOTH,
938 .owner = THIS_MODULE,
939 .create = sco_sock_create,
942 static struct hci_proto sco_hci_proto = {
943 .name = "SCO",
944 .id = HCI_PROTO_SCO,
945 .connect_ind = sco_connect_ind,
946 .connect_cfm = sco_connect_cfm,
947 .disconn_ind = sco_disconn_ind,
948 .recv_scodata = sco_recv_scodata
951 static int __init sco_init(void)
953 int err;
955 err = proto_register(&sco_proto, 0);
956 if (err < 0)
957 return err;
959 err = bt_sock_register(BTPROTO_SCO, &sco_sock_family_ops);
960 if (err < 0) {
961 BT_ERR("SCO socket registration failed");
962 goto error;
965 err = hci_register_proto(&sco_hci_proto);
966 if (err < 0) {
967 BT_ERR("SCO protocol registration failed");
968 bt_sock_unregister(BTPROTO_SCO);
969 goto error;
972 class_create_file(&bt_class, &class_attr_sco);
974 BT_INFO("SCO (Voice Link) ver %s", VERSION);
975 BT_INFO("SCO socket layer initialized");
977 return 0;
979 error:
980 proto_unregister(&sco_proto);
981 return err;
984 static void __exit sco_exit(void)
986 class_remove_file(&bt_class, &class_attr_sco);
988 if (bt_sock_unregister(BTPROTO_SCO) < 0)
989 BT_ERR("SCO socket unregistration failed");
991 if (hci_unregister_proto(&sco_hci_proto) < 0)
992 BT_ERR("SCO protocol unregistration failed");
994 proto_unregister(&sco_proto);
997 module_init(sco_init);
998 module_exit(sco_exit);
1000 MODULE_AUTHOR("Maxim Krasnyansky <maxk@qualcomm.com>, Marcel Holtmann <marcel@holtmann.org>");
1001 MODULE_DESCRIPTION("Bluetooth SCO ver " VERSION);
1002 MODULE_VERSION(VERSION);
1003 MODULE_LICENSE("GPL");
1004 MODULE_ALIAS("bt-proto-2");