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 address family and sockets. */
27 #include <linux/module.h>
28 #include <linux/debugfs.h>
29 #include <linux/stringify.h>
30 #include <linux/sched/signal.h>
32 #include <asm/ioctls.h>
34 #include <net/bluetooth/bluetooth.h>
35 #include <linux/proc_fs.h>
40 /* Bluetooth sockets */
41 #define BT_MAX_PROTO 8
42 static const struct net_proto_family
*bt_proto
[BT_MAX_PROTO
];
43 static DEFINE_RWLOCK(bt_proto_lock
);
45 static struct lock_class_key bt_lock_key
[BT_MAX_PROTO
];
46 static const char *const bt_key_strings
[BT_MAX_PROTO
] = {
47 "sk_lock-AF_BLUETOOTH-BTPROTO_L2CAP",
48 "sk_lock-AF_BLUETOOTH-BTPROTO_HCI",
49 "sk_lock-AF_BLUETOOTH-BTPROTO_SCO",
50 "sk_lock-AF_BLUETOOTH-BTPROTO_RFCOMM",
51 "sk_lock-AF_BLUETOOTH-BTPROTO_BNEP",
52 "sk_lock-AF_BLUETOOTH-BTPROTO_CMTP",
53 "sk_lock-AF_BLUETOOTH-BTPROTO_HIDP",
54 "sk_lock-AF_BLUETOOTH-BTPROTO_AVDTP",
57 static struct lock_class_key bt_slock_key
[BT_MAX_PROTO
];
58 static const char *const bt_slock_key_strings
[BT_MAX_PROTO
] = {
59 "slock-AF_BLUETOOTH-BTPROTO_L2CAP",
60 "slock-AF_BLUETOOTH-BTPROTO_HCI",
61 "slock-AF_BLUETOOTH-BTPROTO_SCO",
62 "slock-AF_BLUETOOTH-BTPROTO_RFCOMM",
63 "slock-AF_BLUETOOTH-BTPROTO_BNEP",
64 "slock-AF_BLUETOOTH-BTPROTO_CMTP",
65 "slock-AF_BLUETOOTH-BTPROTO_HIDP",
66 "slock-AF_BLUETOOTH-BTPROTO_AVDTP",
69 void bt_sock_reclassify_lock(struct sock
*sk
, int proto
)
72 BUG_ON(!sock_allow_reclassification(sk
));
74 sock_lock_init_class_and_name(sk
,
75 bt_slock_key_strings
[proto
], &bt_slock_key
[proto
],
76 bt_key_strings
[proto
], &bt_lock_key
[proto
]);
78 EXPORT_SYMBOL(bt_sock_reclassify_lock
);
80 int bt_sock_register(int proto
, const struct net_proto_family
*ops
)
84 if (proto
< 0 || proto
>= BT_MAX_PROTO
)
87 write_lock(&bt_proto_lock
);
92 bt_proto
[proto
] = ops
;
94 write_unlock(&bt_proto_lock
);
98 EXPORT_SYMBOL(bt_sock_register
);
100 void bt_sock_unregister(int proto
)
102 if (proto
< 0 || proto
>= BT_MAX_PROTO
)
105 write_lock(&bt_proto_lock
);
106 bt_proto
[proto
] = NULL
;
107 write_unlock(&bt_proto_lock
);
109 EXPORT_SYMBOL(bt_sock_unregister
);
111 static int bt_sock_create(struct net
*net
, struct socket
*sock
, int proto
,
116 if (net
!= &init_net
)
117 return -EAFNOSUPPORT
;
119 if (proto
< 0 || proto
>= BT_MAX_PROTO
)
122 if (!bt_proto
[proto
])
123 request_module("bt-proto-%d", proto
);
125 err
= -EPROTONOSUPPORT
;
127 read_lock(&bt_proto_lock
);
129 if (bt_proto
[proto
] && try_module_get(bt_proto
[proto
]->owner
)) {
130 err
= bt_proto
[proto
]->create(net
, sock
, proto
, kern
);
132 bt_sock_reclassify_lock(sock
->sk
, proto
);
133 module_put(bt_proto
[proto
]->owner
);
136 read_unlock(&bt_proto_lock
);
141 void bt_sock_link(struct bt_sock_list
*l
, struct sock
*sk
)
143 write_lock(&l
->lock
);
144 sk_add_node(sk
, &l
->head
);
145 write_unlock(&l
->lock
);
147 EXPORT_SYMBOL(bt_sock_link
);
149 void bt_sock_unlink(struct bt_sock_list
*l
, struct sock
*sk
)
151 write_lock(&l
->lock
);
152 sk_del_node_init(sk
);
153 write_unlock(&l
->lock
);
155 EXPORT_SYMBOL(bt_sock_unlink
);
157 void bt_accept_enqueue(struct sock
*parent
, struct sock
*sk
, bool bh
)
159 BT_DBG("parent %p, sk %p", parent
, sk
);
164 bh_lock_sock_nested(sk
);
166 lock_sock_nested(sk
, SINGLE_DEPTH_NESTING
);
168 list_add_tail(&bt_sk(sk
)->accept_q
, &bt_sk(parent
)->accept_q
);
169 bt_sk(sk
)->parent
= parent
;
176 sk_acceptq_added(parent
);
178 EXPORT_SYMBOL(bt_accept_enqueue
);
180 /* Calling function must hold the sk lock.
181 * bt_sk(sk)->parent must be non-NULL meaning sk is in the parent list.
183 void bt_accept_unlink(struct sock
*sk
)
185 BT_DBG("sk %p state %d", sk
, sk
->sk_state
);
187 list_del_init(&bt_sk(sk
)->accept_q
);
188 sk_acceptq_removed(bt_sk(sk
)->parent
);
189 bt_sk(sk
)->parent
= NULL
;
192 EXPORT_SYMBOL(bt_accept_unlink
);
194 struct sock
*bt_accept_dequeue(struct sock
*parent
, struct socket
*newsock
)
196 struct bt_sock
*s
, *n
;
199 BT_DBG("parent %p", parent
);
202 list_for_each_entry_safe(s
, n
, &bt_sk(parent
)->accept_q
, accept_q
) {
203 sk
= (struct sock
*)s
;
205 /* Prevent early freeing of sk due to unlink and sock_kill */
209 /* Check sk has not already been unlinked via
210 * bt_accept_unlink() due to serialisation caused by sk locking
212 if (!bt_sk(sk
)->parent
) {
213 BT_DBG("sk %p, already unlinked", sk
);
217 /* Restart the loop as sk is no longer in the list
218 * and also avoid a potential infinite loop because
219 * list_for_each_entry_safe() is not thread safe.
224 /* sk is safely in the parent list so reduce reference count */
227 /* FIXME: Is this check still needed */
228 if (sk
->sk_state
== BT_CLOSED
) {
229 bt_accept_unlink(sk
);
234 if (sk
->sk_state
== BT_CONNECTED
|| !newsock
||
235 test_bit(BT_SK_DEFER_SETUP
, &bt_sk(parent
)->flags
)) {
236 bt_accept_unlink(sk
);
238 sock_graft(sk
, newsock
);
249 EXPORT_SYMBOL(bt_accept_dequeue
);
251 int bt_sock_recvmsg(struct socket
*sock
, struct msghdr
*msg
, size_t len
,
254 int noblock
= flags
& MSG_DONTWAIT
;
255 struct sock
*sk
= sock
->sk
;
261 BT_DBG("sock %p sk %p len %zu", sock
, sk
, len
);
266 skb
= skb_recv_datagram(sk
, flags
, noblock
, &err
);
268 if (sk
->sk_shutdown
& RCV_SHUTDOWN
)
277 msg
->msg_flags
|= MSG_TRUNC
;
281 skb_reset_transport_header(skb
);
282 err
= skb_copy_datagram_msg(skb
, 0, msg
, copied
);
284 sock_recv_ts_and_drops(msg
, sk
, skb
);
286 if (msg
->msg_name
&& bt_sk(sk
)->skb_msg_name
)
287 bt_sk(sk
)->skb_msg_name(skb
, msg
->msg_name
,
291 skb_free_datagram(sk
, skb
);
293 if (flags
& MSG_TRUNC
)
296 return err
? : copied
;
298 EXPORT_SYMBOL(bt_sock_recvmsg
);
300 static long bt_sock_data_wait(struct sock
*sk
, long timeo
)
302 DECLARE_WAITQUEUE(wait
, current
);
304 add_wait_queue(sk_sleep(sk
), &wait
);
306 set_current_state(TASK_INTERRUPTIBLE
);
308 if (!skb_queue_empty(&sk
->sk_receive_queue
))
311 if (sk
->sk_err
|| (sk
->sk_shutdown
& RCV_SHUTDOWN
))
314 if (signal_pending(current
) || !timeo
)
317 sk_set_bit(SOCKWQ_ASYNC_WAITDATA
, sk
);
319 timeo
= schedule_timeout(timeo
);
321 sk_clear_bit(SOCKWQ_ASYNC_WAITDATA
, sk
);
324 __set_current_state(TASK_RUNNING
);
325 remove_wait_queue(sk_sleep(sk
), &wait
);
329 int bt_sock_stream_recvmsg(struct socket
*sock
, struct msghdr
*msg
,
330 size_t size
, int flags
)
332 struct sock
*sk
= sock
->sk
;
334 size_t target
, copied
= 0;
340 BT_DBG("sk %p size %zu", sk
, size
);
344 target
= sock_rcvlowat(sk
, flags
& MSG_WAITALL
, size
);
345 timeo
= sock_rcvtimeo(sk
, flags
& MSG_DONTWAIT
);
351 skb
= skb_dequeue(&sk
->sk_receive_queue
);
353 if (copied
>= target
)
356 err
= sock_error(sk
);
359 if (sk
->sk_shutdown
& RCV_SHUTDOWN
)
366 timeo
= bt_sock_data_wait(sk
, timeo
);
368 if (signal_pending(current
)) {
369 err
= sock_intr_errno(timeo
);
375 chunk
= min_t(unsigned int, skb
->len
, size
);
376 if (skb_copy_datagram_msg(skb
, 0, msg
, chunk
)) {
377 skb_queue_head(&sk
->sk_receive_queue
, skb
);
385 sock_recv_ts_and_drops(msg
, sk
, skb
);
387 if (!(flags
& MSG_PEEK
)) {
388 int skb_len
= skb_headlen(skb
);
390 if (chunk
<= skb_len
) {
391 __skb_pull(skb
, chunk
);
393 struct sk_buff
*frag
;
395 __skb_pull(skb
, skb_len
);
398 skb_walk_frags(skb
, frag
) {
399 if (chunk
<= frag
->len
) {
400 /* Pulling partial data */
402 skb
->data_len
-= chunk
;
403 __skb_pull(frag
, chunk
);
405 } else if (frag
->len
) {
406 /* Pulling all frag data */
408 skb
->len
-= frag
->len
;
409 skb
->data_len
-= frag
->len
;
410 __skb_pull(frag
, frag
->len
);
416 skb_queue_head(&sk
->sk_receive_queue
, skb
);
422 /* put message back and return */
423 skb_queue_head(&sk
->sk_receive_queue
, skb
);
430 return copied
? : err
;
432 EXPORT_SYMBOL(bt_sock_stream_recvmsg
);
434 static inline __poll_t
bt_accept_poll(struct sock
*parent
)
436 struct bt_sock
*s
, *n
;
439 list_for_each_entry_safe(s
, n
, &bt_sk(parent
)->accept_q
, accept_q
) {
440 sk
= (struct sock
*)s
;
441 if (sk
->sk_state
== BT_CONNECTED
||
442 (test_bit(BT_SK_DEFER_SETUP
, &bt_sk(parent
)->flags
) &&
443 sk
->sk_state
== BT_CONNECT2
))
444 return EPOLLIN
| EPOLLRDNORM
;
450 __poll_t
bt_sock_poll(struct file
*file
, struct socket
*sock
,
453 struct sock
*sk
= sock
->sk
;
456 BT_DBG("sock %p, sk %p", sock
, sk
);
458 poll_wait(file
, sk_sleep(sk
), wait
);
460 if (sk
->sk_state
== BT_LISTEN
)
461 return bt_accept_poll(sk
);
463 if (sk
->sk_err
|| !skb_queue_empty_lockless(&sk
->sk_error_queue
))
465 (sock_flag(sk
, SOCK_SELECT_ERR_QUEUE
) ? EPOLLPRI
: 0);
467 if (sk
->sk_shutdown
& RCV_SHUTDOWN
)
468 mask
|= EPOLLRDHUP
| EPOLLIN
| EPOLLRDNORM
;
470 if (sk
->sk_shutdown
== SHUTDOWN_MASK
)
473 if (!skb_queue_empty_lockless(&sk
->sk_receive_queue
))
474 mask
|= EPOLLIN
| EPOLLRDNORM
;
476 if (sk
->sk_state
== BT_CLOSED
)
479 if (sk
->sk_state
== BT_CONNECT
||
480 sk
->sk_state
== BT_CONNECT2
||
481 sk
->sk_state
== BT_CONFIG
)
484 if (!test_bit(BT_SK_SUSPEND
, &bt_sk(sk
)->flags
) && sock_writeable(sk
))
485 mask
|= EPOLLOUT
| EPOLLWRNORM
| EPOLLWRBAND
;
487 sk_set_bit(SOCKWQ_ASYNC_NOSPACE
, sk
);
491 EXPORT_SYMBOL(bt_sock_poll
);
493 int bt_sock_ioctl(struct socket
*sock
, unsigned int cmd
, unsigned long arg
)
495 struct sock
*sk
= sock
->sk
;
500 BT_DBG("sk %p cmd %x arg %lx", sk
, cmd
, arg
);
504 if (sk
->sk_state
== BT_LISTEN
)
507 amount
= sk
->sk_sndbuf
- sk_wmem_alloc_get(sk
);
510 err
= put_user(amount
, (int __user
*) arg
);
514 if (sk
->sk_state
== BT_LISTEN
)
518 skb
= skb_peek(&sk
->sk_receive_queue
);
519 amount
= skb
? skb
->len
: 0;
521 err
= put_user(amount
, (int __user
*) arg
);
531 EXPORT_SYMBOL(bt_sock_ioctl
);
533 /* This function expects the sk lock to be held when called */
534 int bt_sock_wait_state(struct sock
*sk
, int state
, unsigned long timeo
)
536 DECLARE_WAITQUEUE(wait
, current
);
541 add_wait_queue(sk_sleep(sk
), &wait
);
542 set_current_state(TASK_INTERRUPTIBLE
);
543 while (sk
->sk_state
!= state
) {
549 if (signal_pending(current
)) {
550 err
= sock_intr_errno(timeo
);
555 timeo
= schedule_timeout(timeo
);
557 set_current_state(TASK_INTERRUPTIBLE
);
559 err
= sock_error(sk
);
563 __set_current_state(TASK_RUNNING
);
564 remove_wait_queue(sk_sleep(sk
), &wait
);
567 EXPORT_SYMBOL(bt_sock_wait_state
);
569 /* This function expects the sk lock to be held when called */
570 int bt_sock_wait_ready(struct sock
*sk
, unsigned long flags
)
572 DECLARE_WAITQUEUE(wait
, current
);
578 timeo
= sock_sndtimeo(sk
, flags
& O_NONBLOCK
);
580 add_wait_queue(sk_sleep(sk
), &wait
);
581 set_current_state(TASK_INTERRUPTIBLE
);
582 while (test_bit(BT_SK_SUSPEND
, &bt_sk(sk
)->flags
)) {
588 if (signal_pending(current
)) {
589 err
= sock_intr_errno(timeo
);
594 timeo
= schedule_timeout(timeo
);
596 set_current_state(TASK_INTERRUPTIBLE
);
598 err
= sock_error(sk
);
602 __set_current_state(TASK_RUNNING
);
603 remove_wait_queue(sk_sleep(sk
), &wait
);
607 EXPORT_SYMBOL(bt_sock_wait_ready
);
609 #ifdef CONFIG_PROC_FS
610 static void *bt_seq_start(struct seq_file
*seq
, loff_t
*pos
)
611 __acquires(seq
->private->l
->lock
)
613 struct bt_sock_list
*l
= PDE_DATA(file_inode(seq
->file
));
616 return seq_hlist_start_head(&l
->head
, *pos
);
619 static void *bt_seq_next(struct seq_file
*seq
, void *v
, loff_t
*pos
)
621 struct bt_sock_list
*l
= PDE_DATA(file_inode(seq
->file
));
623 return seq_hlist_next(v
, &l
->head
, pos
);
626 static void bt_seq_stop(struct seq_file
*seq
, void *v
)
627 __releases(seq
->private->l
->lock
)
629 struct bt_sock_list
*l
= PDE_DATA(file_inode(seq
->file
));
631 read_unlock(&l
->lock
);
634 static int bt_seq_show(struct seq_file
*seq
, void *v
)
636 struct bt_sock_list
*l
= PDE_DATA(file_inode(seq
->file
));
638 if (v
== SEQ_START_TOKEN
) {
639 seq_puts(seq
,"sk RefCnt Rmem Wmem User Inode Parent");
641 if (l
->custom_seq_show
) {
643 l
->custom_seq_show(seq
, v
);
648 struct sock
*sk
= sk_entry(v
);
649 struct bt_sock
*bt
= bt_sk(sk
);
652 "%pK %-6d %-6u %-6u %-6u %-6lu %-6lu",
654 refcount_read(&sk
->sk_refcnt
),
655 sk_rmem_alloc_get(sk
),
656 sk_wmem_alloc_get(sk
),
657 from_kuid(seq_user_ns(seq
), sock_i_uid(sk
)),
659 bt
->parent
? sock_i_ino(bt
->parent
): 0LU);
661 if (l
->custom_seq_show
) {
663 l
->custom_seq_show(seq
, v
);
671 static const struct seq_operations bt_seq_ops
= {
672 .start
= bt_seq_start
,
678 int bt_procfs_init(struct net
*net
, const char *name
,
679 struct bt_sock_list
*sk_list
,
680 int (* seq_show
)(struct seq_file
*, void *))
682 sk_list
->custom_seq_show
= seq_show
;
684 if (!proc_create_seq_data(name
, 0, net
->proc_net
, &bt_seq_ops
, sk_list
))
689 void bt_procfs_cleanup(struct net
*net
, const char *name
)
691 remove_proc_entry(name
, net
->proc_net
);
694 int bt_procfs_init(struct net
*net
, const char *name
,
695 struct bt_sock_list
*sk_list
,
696 int (* seq_show
)(struct seq_file
*, void *))
701 void bt_procfs_cleanup(struct net
*net
, const char *name
)
705 EXPORT_SYMBOL(bt_procfs_init
);
706 EXPORT_SYMBOL(bt_procfs_cleanup
);
708 static const struct net_proto_family bt_sock_family_ops
= {
709 .owner
= THIS_MODULE
,
710 .family
= PF_BLUETOOTH
,
711 .create
= bt_sock_create
,
714 struct dentry
*bt_debugfs
;
715 EXPORT_SYMBOL_GPL(bt_debugfs
);
717 #define VERSION __stringify(BT_SUBSYS_VERSION) "." \
718 __stringify(BT_SUBSYS_REVISION)
720 static int __init
bt_init(void)
724 sock_skb_cb_check_size(sizeof(struct bt_skb_cb
));
726 BT_INFO("Core ver %s", VERSION
);
732 bt_debugfs
= debugfs_create_dir("bluetooth", NULL
);
736 err
= bt_sysfs_init();
740 err
= sock_register(&bt_sock_family_ops
);
744 BT_INFO("HCI device and connection manager initialized");
746 err
= hci_sock_init();
748 goto unregister_socket
;
771 sock_unregister(PF_BLUETOOTH
);
777 static void __exit
bt_exit(void)
787 sock_unregister(PF_BLUETOOTH
);
793 debugfs_remove_recursive(bt_debugfs
);
796 subsys_initcall(bt_init
);
797 module_exit(bt_exit
);
799 MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>");
800 MODULE_DESCRIPTION("Bluetooth Core ver " VERSION
);
801 MODULE_VERSION(VERSION
);
802 MODULE_LICENSE("GPL");
803 MODULE_ALIAS_NETPROTO(PF_BLUETOOTH
);