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 <asm/ioctls.h>
30 #include <net/bluetooth/bluetooth.h>
31 #include <linux/proc_fs.h>
33 #define VERSION "2.16"
35 /* Bluetooth sockets */
36 #define BT_MAX_PROTO 8
37 static const struct net_proto_family
*bt_proto
[BT_MAX_PROTO
];
38 static DEFINE_RWLOCK(bt_proto_lock
);
40 static struct lock_class_key bt_lock_key
[BT_MAX_PROTO
];
41 static const char *const bt_key_strings
[BT_MAX_PROTO
] = {
42 "sk_lock-AF_BLUETOOTH-BTPROTO_L2CAP",
43 "sk_lock-AF_BLUETOOTH-BTPROTO_HCI",
44 "sk_lock-AF_BLUETOOTH-BTPROTO_SCO",
45 "sk_lock-AF_BLUETOOTH-BTPROTO_RFCOMM",
46 "sk_lock-AF_BLUETOOTH-BTPROTO_BNEP",
47 "sk_lock-AF_BLUETOOTH-BTPROTO_CMTP",
48 "sk_lock-AF_BLUETOOTH-BTPROTO_HIDP",
49 "sk_lock-AF_BLUETOOTH-BTPROTO_AVDTP",
52 static struct lock_class_key bt_slock_key
[BT_MAX_PROTO
];
53 static const char *const bt_slock_key_strings
[BT_MAX_PROTO
] = {
54 "slock-AF_BLUETOOTH-BTPROTO_L2CAP",
55 "slock-AF_BLUETOOTH-BTPROTO_HCI",
56 "slock-AF_BLUETOOTH-BTPROTO_SCO",
57 "slock-AF_BLUETOOTH-BTPROTO_RFCOMM",
58 "slock-AF_BLUETOOTH-BTPROTO_BNEP",
59 "slock-AF_BLUETOOTH-BTPROTO_CMTP",
60 "slock-AF_BLUETOOTH-BTPROTO_HIDP",
61 "slock-AF_BLUETOOTH-BTPROTO_AVDTP",
64 void bt_sock_reclassify_lock(struct sock
*sk
, int proto
)
67 BUG_ON(sock_owned_by_user(sk
));
69 sock_lock_init_class_and_name(sk
,
70 bt_slock_key_strings
[proto
], &bt_slock_key
[proto
],
71 bt_key_strings
[proto
], &bt_lock_key
[proto
]);
73 EXPORT_SYMBOL(bt_sock_reclassify_lock
);
75 int bt_sock_register(int proto
, const struct net_proto_family
*ops
)
79 if (proto
< 0 || proto
>= BT_MAX_PROTO
)
82 write_lock(&bt_proto_lock
);
87 bt_proto
[proto
] = ops
;
89 write_unlock(&bt_proto_lock
);
93 EXPORT_SYMBOL(bt_sock_register
);
95 void bt_sock_unregister(int proto
)
97 if (proto
< 0 || proto
>= BT_MAX_PROTO
)
100 write_lock(&bt_proto_lock
);
101 bt_proto
[proto
] = NULL
;
102 write_unlock(&bt_proto_lock
);
104 EXPORT_SYMBOL(bt_sock_unregister
);
106 static int bt_sock_create(struct net
*net
, struct socket
*sock
, int proto
,
111 if (net
!= &init_net
)
112 return -EAFNOSUPPORT
;
114 if (proto
< 0 || proto
>= BT_MAX_PROTO
)
117 if (!bt_proto
[proto
])
118 request_module("bt-proto-%d", proto
);
120 err
= -EPROTONOSUPPORT
;
122 read_lock(&bt_proto_lock
);
124 if (bt_proto
[proto
] && try_module_get(bt_proto
[proto
]->owner
)) {
125 err
= bt_proto
[proto
]->create(net
, sock
, proto
, kern
);
127 bt_sock_reclassify_lock(sock
->sk
, proto
);
128 module_put(bt_proto
[proto
]->owner
);
131 read_unlock(&bt_proto_lock
);
136 void bt_sock_link(struct bt_sock_list
*l
, struct sock
*sk
)
138 write_lock(&l
->lock
);
139 sk_add_node(sk
, &l
->head
);
140 write_unlock(&l
->lock
);
142 EXPORT_SYMBOL(bt_sock_link
);
144 void bt_sock_unlink(struct bt_sock_list
*l
, struct sock
*sk
)
146 write_lock(&l
->lock
);
147 sk_del_node_init(sk
);
148 write_unlock(&l
->lock
);
150 EXPORT_SYMBOL(bt_sock_unlink
);
152 void bt_accept_enqueue(struct sock
*parent
, struct sock
*sk
)
154 BT_DBG("parent %p, sk %p", parent
, sk
);
157 list_add_tail(&bt_sk(sk
)->accept_q
, &bt_sk(parent
)->accept_q
);
158 bt_sk(sk
)->parent
= parent
;
159 parent
->sk_ack_backlog
++;
161 EXPORT_SYMBOL(bt_accept_enqueue
);
163 void bt_accept_unlink(struct sock
*sk
)
165 BT_DBG("sk %p state %d", sk
, sk
->sk_state
);
167 list_del_init(&bt_sk(sk
)->accept_q
);
168 bt_sk(sk
)->parent
->sk_ack_backlog
--;
169 bt_sk(sk
)->parent
= NULL
;
172 EXPORT_SYMBOL(bt_accept_unlink
);
174 struct sock
*bt_accept_dequeue(struct sock
*parent
, struct socket
*newsock
)
176 struct list_head
*p
, *n
;
179 BT_DBG("parent %p", parent
);
181 list_for_each_safe(p
, n
, &bt_sk(parent
)->accept_q
) {
182 sk
= (struct sock
*) list_entry(p
, struct bt_sock
, accept_q
);
186 /* FIXME: Is this check still needed */
187 if (sk
->sk_state
== BT_CLOSED
) {
189 bt_accept_unlink(sk
);
193 if (sk
->sk_state
== BT_CONNECTED
|| !newsock
||
194 test_bit(BT_SK_DEFER_SETUP
, &bt_sk(parent
)->flags
)) {
195 bt_accept_unlink(sk
);
197 sock_graft(sk
, newsock
);
208 EXPORT_SYMBOL(bt_accept_dequeue
);
210 int bt_sock_recvmsg(struct kiocb
*iocb
, struct socket
*sock
,
211 struct msghdr
*msg
, size_t len
, int flags
)
213 int noblock
= flags
& MSG_DONTWAIT
;
214 struct sock
*sk
= sock
->sk
;
219 BT_DBG("sock %p sk %p len %zu", sock
, sk
, len
);
221 if (flags
& (MSG_OOB
))
224 skb
= skb_recv_datagram(sk
, flags
, noblock
, &err
);
226 if (sk
->sk_shutdown
& RCV_SHUTDOWN
)
233 msg
->msg_flags
|= MSG_TRUNC
;
237 skb_reset_transport_header(skb
);
238 err
= skb_copy_datagram_iovec(skb
, 0, msg
->msg_iov
, copied
);
240 sock_recv_ts_and_drops(msg
, sk
, skb
);
242 skb_free_datagram(sk
, skb
);
244 return err
? : copied
;
246 EXPORT_SYMBOL(bt_sock_recvmsg
);
248 static long bt_sock_data_wait(struct sock
*sk
, long timeo
)
250 DECLARE_WAITQUEUE(wait
, current
);
252 add_wait_queue(sk_sleep(sk
), &wait
);
254 set_current_state(TASK_INTERRUPTIBLE
);
256 if (!skb_queue_empty(&sk
->sk_receive_queue
))
259 if (sk
->sk_err
|| (sk
->sk_shutdown
& RCV_SHUTDOWN
))
262 if (signal_pending(current
) || !timeo
)
265 set_bit(SOCK_ASYNC_WAITDATA
, &sk
->sk_socket
->flags
);
267 timeo
= schedule_timeout(timeo
);
269 clear_bit(SOCK_ASYNC_WAITDATA
, &sk
->sk_socket
->flags
);
272 __set_current_state(TASK_RUNNING
);
273 remove_wait_queue(sk_sleep(sk
), &wait
);
277 int bt_sock_stream_recvmsg(struct kiocb
*iocb
, struct socket
*sock
,
278 struct msghdr
*msg
, size_t size
, int flags
)
280 struct sock
*sk
= sock
->sk
;
282 size_t target
, copied
= 0;
288 BT_DBG("sk %p size %zu", sk
, size
);
292 target
= sock_rcvlowat(sk
, flags
& MSG_WAITALL
, size
);
293 timeo
= sock_rcvtimeo(sk
, flags
& MSG_DONTWAIT
);
299 skb
= skb_dequeue(&sk
->sk_receive_queue
);
301 if (copied
>= target
)
304 err
= sock_error(sk
);
307 if (sk
->sk_shutdown
& RCV_SHUTDOWN
)
314 timeo
= bt_sock_data_wait(sk
, timeo
);
316 if (signal_pending(current
)) {
317 err
= sock_intr_errno(timeo
);
323 chunk
= min_t(unsigned int, skb
->len
, size
);
324 if (skb_copy_datagram_iovec(skb
, 0, msg
->msg_iov
, chunk
)) {
325 skb_queue_head(&sk
->sk_receive_queue
, skb
);
333 sock_recv_ts_and_drops(msg
, sk
, skb
);
335 if (!(flags
& MSG_PEEK
)) {
336 int skb_len
= skb_headlen(skb
);
338 if (chunk
<= skb_len
) {
339 __skb_pull(skb
, chunk
);
341 struct sk_buff
*frag
;
343 __skb_pull(skb
, skb_len
);
346 skb_walk_frags(skb
, frag
) {
347 if (chunk
<= frag
->len
) {
348 /* Pulling partial data */
350 skb
->data_len
-= chunk
;
351 __skb_pull(frag
, chunk
);
353 } else if (frag
->len
) {
354 /* Pulling all frag data */
356 skb
->len
-= frag
->len
;
357 skb
->data_len
-= frag
->len
;
358 __skb_pull(frag
, frag
->len
);
364 skb_queue_head(&sk
->sk_receive_queue
, skb
);
370 /* put message back and return */
371 skb_queue_head(&sk
->sk_receive_queue
, skb
);
378 return copied
? : err
;
380 EXPORT_SYMBOL(bt_sock_stream_recvmsg
);
382 static inline unsigned int bt_accept_poll(struct sock
*parent
)
384 struct list_head
*p
, *n
;
387 list_for_each_safe(p
, n
, &bt_sk(parent
)->accept_q
) {
388 sk
= (struct sock
*) list_entry(p
, struct bt_sock
, accept_q
);
389 if (sk
->sk_state
== BT_CONNECTED
||
390 (test_bit(BT_SK_DEFER_SETUP
, &bt_sk(parent
)->flags
) &&
391 sk
->sk_state
== BT_CONNECT2
))
392 return POLLIN
| POLLRDNORM
;
398 unsigned int bt_sock_poll(struct file
*file
, struct socket
*sock
,
401 struct sock
*sk
= sock
->sk
;
402 unsigned int mask
= 0;
404 BT_DBG("sock %p, sk %p", sock
, sk
);
406 poll_wait(file
, sk_sleep(sk
), wait
);
408 if (sk
->sk_state
== BT_LISTEN
)
409 return bt_accept_poll(sk
);
411 if (sk
->sk_err
|| !skb_queue_empty(&sk
->sk_error_queue
))
413 (sock_flag(sk
, SOCK_SELECT_ERR_QUEUE
) ? POLLPRI
: 0);
415 if (sk
->sk_shutdown
& RCV_SHUTDOWN
)
416 mask
|= POLLRDHUP
| POLLIN
| POLLRDNORM
;
418 if (sk
->sk_shutdown
== SHUTDOWN_MASK
)
421 if (!skb_queue_empty(&sk
->sk_receive_queue
))
422 mask
|= POLLIN
| POLLRDNORM
;
424 if (sk
->sk_state
== BT_CLOSED
)
427 if (sk
->sk_state
== BT_CONNECT
||
428 sk
->sk_state
== BT_CONNECT2
||
429 sk
->sk_state
== BT_CONFIG
)
432 if (!test_bit(BT_SK_SUSPEND
, &bt_sk(sk
)->flags
) && sock_writeable(sk
))
433 mask
|= POLLOUT
| POLLWRNORM
| POLLWRBAND
;
435 set_bit(SOCK_ASYNC_NOSPACE
, &sk
->sk_socket
->flags
);
439 EXPORT_SYMBOL(bt_sock_poll
);
441 int bt_sock_ioctl(struct socket
*sock
, unsigned int cmd
, unsigned long arg
)
443 struct sock
*sk
= sock
->sk
;
448 BT_DBG("sk %p cmd %x arg %lx", sk
, cmd
, arg
);
452 if (sk
->sk_state
== BT_LISTEN
)
455 amount
= sk
->sk_sndbuf
- sk_wmem_alloc_get(sk
);
458 err
= put_user(amount
, (int __user
*) arg
);
462 if (sk
->sk_state
== BT_LISTEN
)
466 skb
= skb_peek(&sk
->sk_receive_queue
);
467 amount
= skb
? skb
->len
: 0;
469 err
= put_user(amount
, (int __user
*) arg
);
473 err
= sock_get_timestamp(sk
, (struct timeval __user
*) arg
);
477 err
= sock_get_timestampns(sk
, (struct timespec __user
*) arg
);
487 EXPORT_SYMBOL(bt_sock_ioctl
);
489 int bt_sock_wait_state(struct sock
*sk
, int state
, unsigned long timeo
)
491 DECLARE_WAITQUEUE(wait
, current
);
496 add_wait_queue(sk_sleep(sk
), &wait
);
497 set_current_state(TASK_INTERRUPTIBLE
);
498 while (sk
->sk_state
!= state
) {
504 if (signal_pending(current
)) {
505 err
= sock_intr_errno(timeo
);
510 timeo
= schedule_timeout(timeo
);
512 set_current_state(TASK_INTERRUPTIBLE
);
514 err
= sock_error(sk
);
518 __set_current_state(TASK_RUNNING
);
519 remove_wait_queue(sk_sleep(sk
), &wait
);
522 EXPORT_SYMBOL(bt_sock_wait_state
);
524 #ifdef CONFIG_PROC_FS
525 struct bt_seq_state
{
526 struct bt_sock_list
*l
;
529 static void *bt_seq_start(struct seq_file
*seq
, loff_t
*pos
)
530 __acquires(seq
->private->l
->lock
)
532 struct bt_seq_state
*s
= seq
->private;
533 struct bt_sock_list
*l
= s
->l
;
536 return seq_hlist_start_head(&l
->head
, *pos
);
539 static void *bt_seq_next(struct seq_file
*seq
, void *v
, loff_t
*pos
)
541 struct bt_seq_state
*s
= seq
->private;
542 struct bt_sock_list
*l
= s
->l
;
544 return seq_hlist_next(v
, &l
->head
, pos
);
547 static void bt_seq_stop(struct seq_file
*seq
, void *v
)
548 __releases(seq
->private->l
->lock
)
550 struct bt_seq_state
*s
= seq
->private;
551 struct bt_sock_list
*l
= s
->l
;
553 read_unlock(&l
->lock
);
556 static int bt_seq_show(struct seq_file
*seq
, void *v
)
558 struct bt_seq_state
*s
= seq
->private;
559 struct bt_sock_list
*l
= s
->l
;
561 if (v
== SEQ_START_TOKEN
) {
562 seq_puts(seq
,"sk RefCnt Rmem Wmem User Inode Src Dst Parent");
564 if (l
->custom_seq_show
) {
566 l
->custom_seq_show(seq
, v
);
571 struct sock
*sk
= sk_entry(v
);
572 struct bt_sock
*bt
= bt_sk(sk
);
575 "%pK %-6d %-6u %-6u %-6u %-6lu %pMR %pMR %-6lu",
577 atomic_read(&sk
->sk_refcnt
),
578 sk_rmem_alloc_get(sk
),
579 sk_wmem_alloc_get(sk
),
580 from_kuid(seq_user_ns(seq
), sock_i_uid(sk
)),
584 bt
->parent
? sock_i_ino(bt
->parent
): 0LU);
586 if (l
->custom_seq_show
) {
588 l
->custom_seq_show(seq
, v
);
596 static struct seq_operations bt_seq_ops
= {
597 .start
= bt_seq_start
,
603 static int bt_seq_open(struct inode
*inode
, struct file
*file
)
605 struct bt_sock_list
*sk_list
;
606 struct bt_seq_state
*s
;
608 sk_list
= PDE_DATA(inode
);
609 s
= __seq_open_private(file
, &bt_seq_ops
,
610 sizeof(struct bt_seq_state
));
618 static const struct file_operations bt_fops
= {
622 .release
= seq_release_private
625 int bt_procfs_init(struct net
*net
, const char *name
,
626 struct bt_sock_list
* sk_list
,
627 int (* seq_show
)(struct seq_file
*, void *))
629 sk_list
->custom_seq_show
= seq_show
;
631 if (!proc_create_data(name
, 0, net
->proc_net
, &bt_fops
, sk_list
))
636 void bt_procfs_cleanup(struct net
*net
, const char *name
)
638 remove_proc_entry(name
, net
->proc_net
);
641 int bt_procfs_init(struct net
*net
, const char *name
,
642 struct bt_sock_list
* sk_list
,
643 int (* seq_show
)(struct seq_file
*, void *))
648 void bt_procfs_cleanup(struct net
*net
, const char *name
)
652 EXPORT_SYMBOL(bt_procfs_init
);
653 EXPORT_SYMBOL(bt_procfs_cleanup
);
655 static struct net_proto_family bt_sock_family_ops
= {
656 .owner
= THIS_MODULE
,
657 .family
= PF_BLUETOOTH
,
658 .create
= bt_sock_create
,
661 static int __init
bt_init(void)
665 BT_INFO("Core ver %s", VERSION
);
667 err
= bt_sysfs_init();
671 err
= sock_register(&bt_sock_family_ops
);
677 BT_INFO("HCI device and connection manager initialized");
679 err
= hci_sock_init();
699 sock_unregister(PF_BLUETOOTH
);
705 static void __exit
bt_exit(void)
714 sock_unregister(PF_BLUETOOTH
);
719 subsys_initcall(bt_init
);
720 module_exit(bt_exit
);
722 MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>");
723 MODULE_DESCRIPTION("Bluetooth Core ver " VERSION
);
724 MODULE_VERSION(VERSION
);
725 MODULE_LICENSE("GPL");
726 MODULE_ALIAS_NETPROTO(PF_BLUETOOTH
);