blob: 4f170a59593474ca174f4e266f39931de57e0212 [file] [log] [blame]
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +09001/*
Linus Torvalds1da177e2005-04-16 15:20:36 -07002 BlueZ - Bluetooth protocol stack for Linux
3 Copyright (C) 2000-2001 Qualcomm Incorporated
4
5 Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com>
6
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;
10
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
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +090015 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
Linus Torvalds1da177e2005-04-16 15:20:36 -070018 OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
19
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +090020 ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
21 COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
Linus Torvalds1da177e2005-04-16 15:20:36 -070022 SOFTWARE IS DISCLAIMED.
23*/
24
25/* Bluetooth HCI sockets. */
26
Linus Torvalds1da177e2005-04-16 15:20:36 -070027#include <linux/module.h>
28
29#include <linux/types.h>
Randy Dunlap4fc268d2006-01-11 12:17:47 -080030#include <linux/capability.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070031#include <linux/errno.h>
32#include <linux/kernel.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070033#include <linux/slab.h>
34#include <linux/poll.h>
35#include <linux/fcntl.h>
36#include <linux/init.h>
37#include <linux/skbuff.h>
38#include <linux/workqueue.h>
39#include <linux/interrupt.h>
Marcel Holtmann767c5eb2007-09-09 08:39:34 +020040#include <linux/compat.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070041#include <linux/socket.h>
42#include <linux/ioctl.h>
43#include <net/sock.h>
44
45#include <asm/system.h>
46#include <asm/uaccess.h>
47#include <asm/unaligned.h>
48
49#include <net/bluetooth/bluetooth.h>
50#include <net/bluetooth/hci_core.h>
51
Linus Torvalds1da177e2005-04-16 15:20:36 -070052/* ----- HCI socket interface ----- */
53
54static inline int hci_test_bit(int nr, void *addr)
55{
56 return *((__u32 *) addr + (nr >> 5)) & ((__u32) 1 << (nr & 31));
57}
58
59/* Security filter */
60static struct hci_sec_filter hci_sec_filter = {
61 /* Packet types */
62 0x10,
63 /* Events */
Marcel Holtmanndd7f5522005-10-28 19:20:53 +020064 { 0x1000d9fe, 0x0000b00c },
Linus Torvalds1da177e2005-04-16 15:20:36 -070065 /* Commands */
66 {
67 { 0x0 },
68 /* OGF_LINK_CTL */
Marcel Holtmann7c631a62007-09-09 08:39:43 +020069 { 0xbe000006, 0x00000001, 0x00000000, 0x00 },
Linus Torvalds1da177e2005-04-16 15:20:36 -070070 /* OGF_LINK_POLICY */
Marcel Holtmann7c631a62007-09-09 08:39:43 +020071 { 0x00005200, 0x00000000, 0x00000000, 0x00 },
Linus Torvalds1da177e2005-04-16 15:20:36 -070072 /* OGF_HOST_CTL */
Marcel Holtmann7c631a62007-09-09 08:39:43 +020073 { 0xaab00200, 0x2b402aaa, 0x05220154, 0x00 },
Linus Torvalds1da177e2005-04-16 15:20:36 -070074 /* OGF_INFO_PARAM */
Marcel Holtmann7c631a62007-09-09 08:39:43 +020075 { 0x000002be, 0x00000000, 0x00000000, 0x00 },
Linus Torvalds1da177e2005-04-16 15:20:36 -070076 /* OGF_STATUS_PARAM */
Marcel Holtmann7c631a62007-09-09 08:39:43 +020077 { 0x000000ea, 0x00000000, 0x00000000, 0x00 }
Linus Torvalds1da177e2005-04-16 15:20:36 -070078 }
79};
80
81static struct bt_sock_list hci_sk_list = {
Robert P. J. Dayd5fb2962008-03-28 16:17:38 -070082 .lock = __RW_LOCK_UNLOCKED(hci_sk_list.lock)
Linus Torvalds1da177e2005-04-16 15:20:36 -070083};
84
85/* Send frame to RAW socket */
86void hci_send_to_sock(struct hci_dev *hdev, struct sk_buff *skb)
87{
88 struct sock *sk;
89 struct hlist_node *node;
90
91 BT_DBG("hdev %p len %d", hdev, skb->len);
92
93 read_lock(&hci_sk_list.lock);
94 sk_for_each(sk, node, &hci_sk_list.head) {
95 struct hci_filter *flt;
96 struct sk_buff *nskb;
97
98 if (sk->sk_state != BT_BOUND || hci_pi(sk)->hdev != hdev)
99 continue;
100
101 /* Don't send frame to the socket it came from */
102 if (skb->sk == sk)
103 continue;
104
105 /* Apply filter */
106 flt = &hci_pi(sk)->filter;
107
Marcel Holtmann0d48d932005-08-09 20:30:28 -0700108 if (!test_bit((bt_cb(skb)->pkt_type == HCI_VENDOR_PKT) ?
109 0 : (bt_cb(skb)->pkt_type & HCI_FLT_TYPE_BITS), &flt->type_mask))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700110 continue;
111
Marcel Holtmann0d48d932005-08-09 20:30:28 -0700112 if (bt_cb(skb)->pkt_type == HCI_EVENT_PKT) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700113 register int evt = (*(__u8 *)skb->data & HCI_FLT_EVENT_BITS);
114
115 if (!hci_test_bit(evt, &flt->event_mask))
116 continue;
117
David S. Miller4498c802006-11-21 16:17:41 -0800118 if (flt->opcode &&
119 ((evt == HCI_EV_CMD_COMPLETE &&
120 flt->opcode !=
Al Viro905f3ed2006-12-13 00:35:01 -0800121 get_unaligned((__le16 *)(skb->data + 3))) ||
David S. Miller4498c802006-11-21 16:17:41 -0800122 (evt == HCI_EV_CMD_STATUS &&
123 flt->opcode !=
Al Viro905f3ed2006-12-13 00:35:01 -0800124 get_unaligned((__le16 *)(skb->data + 4)))))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700125 continue;
126 }
127
128 if (!(nskb = skb_clone(skb, GFP_ATOMIC)))
129 continue;
130
131 /* Put type byte before the data */
Marcel Holtmann0d48d932005-08-09 20:30:28 -0700132 memcpy(skb_push(nskb, 1), &bt_cb(nskb)->pkt_type, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700133
134 if (sock_queue_rcv_skb(sk, nskb))
135 kfree_skb(nskb);
136 }
137 read_unlock(&hci_sk_list.lock);
138}
139
140static int hci_sock_release(struct socket *sock)
141{
142 struct sock *sk = sock->sk;
Marcel Holtmann7b005bd2006-02-13 11:40:03 +0100143 struct hci_dev *hdev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700144
145 BT_DBG("sock %p sk %p", sock, sk);
146
147 if (!sk)
148 return 0;
149
Marcel Holtmann7b005bd2006-02-13 11:40:03 +0100150 hdev = hci_pi(sk)->hdev;
151
Linus Torvalds1da177e2005-04-16 15:20:36 -0700152 bt_sock_unlink(&hci_sk_list, sk);
153
154 if (hdev) {
155 atomic_dec(&hdev->promisc);
156 hci_dev_put(hdev);
157 }
158
159 sock_orphan(sk);
160
161 skb_queue_purge(&sk->sk_receive_queue);
162 skb_queue_purge(&sk->sk_write_queue);
163
164 sock_put(sk);
165 return 0;
166}
167
Johan Hedbergf0358562010-05-18 13:20:32 +0200168struct bdaddr_list *hci_blacklist_lookup(struct hci_dev *hdev, bdaddr_t *bdaddr)
169{
170 struct list_head *p;
171 struct bdaddr_list *blacklist = &hdev->blacklist;
172
173 list_for_each(p, &blacklist->list) {
174 struct bdaddr_list *b;
175
176 b = list_entry(p, struct bdaddr_list, list);
177
178 if (bacmp(bdaddr, &b->bdaddr) == 0)
179 return b;
180 }
181
182 return NULL;
183}
184
185static int hci_blacklist_add(struct hci_dev *hdev, void __user *arg)
186{
187 bdaddr_t bdaddr;
188 struct bdaddr_list *entry;
189
190 if (copy_from_user(&bdaddr, arg, sizeof(bdaddr)))
191 return -EFAULT;
192
193 if (bacmp(&bdaddr, BDADDR_ANY) == 0)
194 return -EBADF;
195
196 if (hci_blacklist_lookup(hdev, &bdaddr))
197 return -EEXIST;
198
199 entry = kzalloc(sizeof(struct bdaddr_list), GFP_KERNEL);
200 if (!entry)
201 return -ENOMEM;
202
203 bacpy(&entry->bdaddr, &bdaddr);
204
205 list_add(&entry->list, &hdev->blacklist.list);
206
207 return 0;
208}
209
210int hci_blacklist_clear(struct hci_dev *hdev)
211{
212 struct list_head *p, *n;
213 struct bdaddr_list *blacklist = &hdev->blacklist;
214
215 list_for_each_safe(p, n, &blacklist->list) {
216 struct bdaddr_list *b;
217
218 b = list_entry(p, struct bdaddr_list, list);
219
220 list_del(p);
221 kfree(b);
222 }
223
224 return 0;
225}
226
227static int hci_blacklist_del(struct hci_dev *hdev, void __user *arg)
228{
229 bdaddr_t bdaddr;
230 struct bdaddr_list *entry;
231
232 if (copy_from_user(&bdaddr, arg, sizeof(bdaddr)))
233 return -EFAULT;
234
235 if (bacmp(&bdaddr, BDADDR_ANY) == 0)
236 return hci_blacklist_clear(hdev);
237
238 entry = hci_blacklist_lookup(hdev, &bdaddr);
239 if (!entry)
240 return -ENOENT;
241
242 list_del(&entry->list);
243 kfree(entry);
244
245 return 0;
246}
247
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900248/* Ioctls that require bound socket */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700249static inline int hci_sock_bound_ioctl(struct sock *sk, unsigned int cmd, unsigned long arg)
250{
251 struct hci_dev *hdev = hci_pi(sk)->hdev;
252
253 if (!hdev)
254 return -EBADFD;
255
256 switch (cmd) {
257 case HCISETRAW:
258 if (!capable(CAP_NET_ADMIN))
259 return -EACCES;
260
261 if (test_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks))
262 return -EPERM;
263
264 if (arg)
265 set_bit(HCI_RAW, &hdev->flags);
266 else
267 clear_bit(HCI_RAW, &hdev->flags);
268
269 return 0;
270
Linus Torvalds1da177e2005-04-16 15:20:36 -0700271 case HCIGETCONNINFO:
Marcel Holtmann40be4922008-07-14 20:13:50 +0200272 return hci_get_conn_info(hdev, (void __user *) arg);
273
274 case HCIGETAUTHINFO:
275 return hci_get_auth_info(hdev, (void __user *) arg);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700276
Johan Hedbergf0358562010-05-18 13:20:32 +0200277 case HCIBLOCKADDR:
278 if (!capable(CAP_NET_ADMIN))
279 return -EACCES;
280 return hci_blacklist_add(hdev, (void __user *) arg);
281
282 case HCIUNBLOCKADDR:
283 if (!capable(CAP_NET_ADMIN))
284 return -EACCES;
285 return hci_blacklist_del(hdev, (void __user *) arg);
286
Linus Torvalds1da177e2005-04-16 15:20:36 -0700287 default:
288 if (hdev->ioctl)
289 return hdev->ioctl(hdev, cmd, arg);
290 return -EINVAL;
291 }
292}
293
294static int hci_sock_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
295{
296 struct sock *sk = sock->sk;
Marcel Holtmann40be4922008-07-14 20:13:50 +0200297 void __user *argp = (void __user *) arg;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700298 int err;
299
300 BT_DBG("cmd %x arg %lx", cmd, arg);
301
302 switch (cmd) {
303 case HCIGETDEVLIST:
304 return hci_get_dev_list(argp);
305
306 case HCIGETDEVINFO:
307 return hci_get_dev_info(argp);
308
309 case HCIGETCONNLIST:
310 return hci_get_conn_list(argp);
311
312 case HCIDEVUP:
313 if (!capable(CAP_NET_ADMIN))
314 return -EACCES;
315 return hci_dev_open(arg);
316
317 case HCIDEVDOWN:
318 if (!capable(CAP_NET_ADMIN))
319 return -EACCES;
320 return hci_dev_close(arg);
321
322 case HCIDEVRESET:
323 if (!capable(CAP_NET_ADMIN))
324 return -EACCES;
325 return hci_dev_reset(arg);
326
327 case HCIDEVRESTAT:
328 if (!capable(CAP_NET_ADMIN))
329 return -EACCES;
330 return hci_dev_reset_stat(arg);
331
332 case HCISETSCAN:
333 case HCISETAUTH:
334 case HCISETENCRYPT:
335 case HCISETPTYPE:
336 case HCISETLINKPOL:
337 case HCISETLINKMODE:
338 case HCISETACLMTU:
339 case HCISETSCOMTU:
340 if (!capable(CAP_NET_ADMIN))
341 return -EACCES;
342 return hci_dev_cmd(cmd, argp);
343
344 case HCIINQUIRY:
345 return hci_inquiry(argp);
346
347 default:
348 lock_sock(sk);
349 err = hci_sock_bound_ioctl(sk, cmd, arg);
350 release_sock(sk);
351 return err;
352 }
353}
354
355static int hci_sock_bind(struct socket *sock, struct sockaddr *addr, int addr_len)
356{
357 struct sockaddr_hci *haddr = (struct sockaddr_hci *) addr;
358 struct sock *sk = sock->sk;
359 struct hci_dev *hdev = NULL;
360 int err = 0;
361
362 BT_DBG("sock %p sk %p", sock, sk);
363
364 if (!haddr || haddr->hci_family != AF_BLUETOOTH)
365 return -EINVAL;
366
367 lock_sock(sk);
368
369 if (hci_pi(sk)->hdev) {
370 err = -EALREADY;
371 goto done;
372 }
373
374 if (haddr->hci_dev != HCI_DEV_NONE) {
375 if (!(hdev = hci_dev_get(haddr->hci_dev))) {
376 err = -ENODEV;
377 goto done;
378 }
379
380 atomic_inc(&hdev->promisc);
381 }
382
383 hci_pi(sk)->hdev = hdev;
384 sk->sk_state = BT_BOUND;
385
386done:
387 release_sock(sk);
388 return err;
389}
390
391static int hci_sock_getname(struct socket *sock, struct sockaddr *addr, int *addr_len, int peer)
392{
393 struct sockaddr_hci *haddr = (struct sockaddr_hci *) addr;
394 struct sock *sk = sock->sk;
Marcel Holtmann7b005bd2006-02-13 11:40:03 +0100395 struct hci_dev *hdev = hci_pi(sk)->hdev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700396
397 BT_DBG("sock %p sk %p", sock, sk);
398
Marcel Holtmann7b005bd2006-02-13 11:40:03 +0100399 if (!hdev)
400 return -EBADFD;
401
Linus Torvalds1da177e2005-04-16 15:20:36 -0700402 lock_sock(sk);
403
404 *addr_len = sizeof(*haddr);
405 haddr->hci_family = AF_BLUETOOTH;
Marcel Holtmann7b005bd2006-02-13 11:40:03 +0100406 haddr->hci_dev = hdev->id;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700407
408 release_sock(sk);
409 return 0;
410}
411
412static inline void hci_sock_cmsg(struct sock *sk, struct msghdr *msg, struct sk_buff *skb)
413{
414 __u32 mask = hci_pi(sk)->cmsg_mask;
415
Marcel Holtmann0d48d932005-08-09 20:30:28 -0700416 if (mask & HCI_CMSG_DIR) {
417 int incoming = bt_cb(skb)->incoming;
418 put_cmsg(msg, SOL_HCI, HCI_CMSG_DIR, sizeof(incoming), &incoming);
419 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700420
Patrick McHardya61bbcf2005-08-14 17:24:31 -0700421 if (mask & HCI_CMSG_TSTAMP) {
Johann Felix Sodenf6e623a2010-02-15 22:23:48 +0100422#ifdef CONFIG_COMPAT
423 struct compat_timeval ctv;
424#endif
Patrick McHardya61bbcf2005-08-14 17:24:31 -0700425 struct timeval tv;
Marcel Holtmann767c5eb2007-09-09 08:39:34 +0200426 void *data;
427 int len;
Patrick McHardya61bbcf2005-08-14 17:24:31 -0700428
429 skb_get_timestamp(skb, &tv);
Marcel Holtmann767c5eb2007-09-09 08:39:34 +0200430
David S. Miller1da97f82007-09-12 14:10:58 +0200431 data = &tv;
432 len = sizeof(tv);
433#ifdef CONFIG_COMPAT
Marcel Holtmann767c5eb2007-09-09 08:39:34 +0200434 if (msg->msg_flags & MSG_CMSG_COMPAT) {
Marcel Holtmann767c5eb2007-09-09 08:39:34 +0200435 ctv.tv_sec = tv.tv_sec;
436 ctv.tv_usec = tv.tv_usec;
437 data = &ctv;
438 len = sizeof(ctv);
Marcel Holtmann767c5eb2007-09-09 08:39:34 +0200439 }
David S. Miller1da97f82007-09-12 14:10:58 +0200440#endif
Marcel Holtmann767c5eb2007-09-09 08:39:34 +0200441
442 put_cmsg(msg, SOL_HCI, HCI_CMSG_TSTAMP, len, data);
Patrick McHardya61bbcf2005-08-14 17:24:31 -0700443 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700444}
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900445
446static int hci_sock_recvmsg(struct kiocb *iocb, struct socket *sock,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700447 struct msghdr *msg, size_t len, int flags)
448{
449 int noblock = flags & MSG_DONTWAIT;
450 struct sock *sk = sock->sk;
451 struct sk_buff *skb;
452 int copied, err;
453
454 BT_DBG("sock %p, sk %p", sock, sk);
455
456 if (flags & (MSG_OOB))
457 return -EOPNOTSUPP;
458
459 if (sk->sk_state == BT_CLOSED)
460 return 0;
461
462 if (!(skb = skb_recv_datagram(sk, flags, noblock, &err)))
463 return err;
464
465 msg->msg_namelen = 0;
466
467 copied = skb->len;
468 if (len < copied) {
469 msg->msg_flags |= MSG_TRUNC;
470 copied = len;
471 }
472
Arnaldo Carvalho de Melobadff6d2007-03-13 13:06:52 -0300473 skb_reset_transport_header(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700474 err = skb_copy_datagram_iovec(skb, 0, msg->msg_iov, copied);
475
476 hci_sock_cmsg(sk, msg, skb);
477
478 skb_free_datagram(sk, skb);
479
480 return err ? : copied;
481}
482
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900483static int hci_sock_sendmsg(struct kiocb *iocb, struct socket *sock,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700484 struct msghdr *msg, size_t len)
485{
486 struct sock *sk = sock->sk;
487 struct hci_dev *hdev;
488 struct sk_buff *skb;
489 int err;
490
491 BT_DBG("sock %p sk %p", sock, sk);
492
493 if (msg->msg_flags & MSG_OOB)
494 return -EOPNOTSUPP;
495
496 if (msg->msg_flags & ~(MSG_DONTWAIT|MSG_NOSIGNAL|MSG_ERRQUEUE))
497 return -EINVAL;
498
499 if (len < 4 || len > HCI_MAX_FRAME_SIZE)
500 return -EINVAL;
501
502 lock_sock(sk);
503
504 if (!(hdev = hci_pi(sk)->hdev)) {
505 err = -EBADFD;
506 goto done;
507 }
508
Marcel Holtmann7e21add2009-11-18 01:05:00 +0100509 if (!test_bit(HCI_UP, &hdev->flags)) {
510 err = -ENETDOWN;
511 goto done;
512 }
513
Linus Torvalds1da177e2005-04-16 15:20:36 -0700514 if (!(skb = bt_skb_send_alloc(sk, len, msg->msg_flags & MSG_DONTWAIT, &err)))
515 goto done;
516
517 if (memcpy_fromiovec(skb_put(skb, len), msg->msg_iov, len)) {
518 err = -EFAULT;
519 goto drop;
520 }
521
Marcel Holtmann0d48d932005-08-09 20:30:28 -0700522 bt_cb(skb)->pkt_type = *((unsigned char *) skb->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700523 skb_pull(skb, 1);
524 skb->dev = (void *) hdev;
525
Marcel Holtmann0d48d932005-08-09 20:30:28 -0700526 if (bt_cb(skb)->pkt_type == HCI_COMMAND_PKT) {
Harvey Harrison83985312008-05-02 16:25:46 -0700527 u16 opcode = get_unaligned_le16(skb->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700528 u16 ogf = hci_opcode_ogf(opcode);
529 u16 ocf = hci_opcode_ocf(opcode);
530
531 if (((ogf > HCI_SFLT_MAX_OGF) ||
532 !hci_test_bit(ocf & HCI_FLT_OCF_BITS, &hci_sec_filter.ocf_mask[ogf])) &&
533 !capable(CAP_NET_RAW)) {
534 err = -EPERM;
535 goto drop;
536 }
537
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200538 if (test_bit(HCI_RAW, &hdev->flags) || (ogf == 0x3f)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700539 skb_queue_tail(&hdev->raw_q, skb);
Marcel Holtmannc78ae282009-11-18 01:02:54 +0100540 tasklet_schedule(&hdev->tx_task);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700541 } else {
542 skb_queue_tail(&hdev->cmd_q, skb);
Marcel Holtmannc78ae282009-11-18 01:02:54 +0100543 tasklet_schedule(&hdev->cmd_task);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700544 }
545 } else {
546 if (!capable(CAP_NET_RAW)) {
547 err = -EPERM;
548 goto drop;
549 }
550
551 skb_queue_tail(&hdev->raw_q, skb);
Marcel Holtmannc78ae282009-11-18 01:02:54 +0100552 tasklet_schedule(&hdev->tx_task);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700553 }
554
555 err = len;
556
557done:
558 release_sock(sk);
559 return err;
560
561drop:
562 kfree_skb(skb);
563 goto done;
564}
565
David S. Millerb7058842009-09-30 16:12:20 -0700566static int hci_sock_setsockopt(struct socket *sock, int level, int optname, char __user *optval, unsigned int len)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700567{
568 struct hci_ufilter uf = { .opcode = 0 };
569 struct sock *sk = sock->sk;
570 int err = 0, opt = 0;
571
572 BT_DBG("sk %p, opt %d", sk, optname);
573
574 lock_sock(sk);
575
576 switch (optname) {
577 case HCI_DATA_DIR:
578 if (get_user(opt, (int __user *)optval)) {
579 err = -EFAULT;
580 break;
581 }
582
583 if (opt)
584 hci_pi(sk)->cmsg_mask |= HCI_CMSG_DIR;
585 else
586 hci_pi(sk)->cmsg_mask &= ~HCI_CMSG_DIR;
587 break;
588
589 case HCI_TIME_STAMP:
590 if (get_user(opt, (int __user *)optval)) {
591 err = -EFAULT;
592 break;
593 }
594
595 if (opt)
596 hci_pi(sk)->cmsg_mask |= HCI_CMSG_TSTAMP;
597 else
598 hci_pi(sk)->cmsg_mask &= ~HCI_CMSG_TSTAMP;
599 break;
600
601 case HCI_FILTER:
Marcel Holtmann0878b662007-05-05 00:35:59 +0200602 {
603 struct hci_filter *f = &hci_pi(sk)->filter;
604
605 uf.type_mask = f->type_mask;
606 uf.opcode = f->opcode;
607 uf.event_mask[0] = *((u32 *) f->event_mask + 0);
608 uf.event_mask[1] = *((u32 *) f->event_mask + 1);
609 }
610
Linus Torvalds1da177e2005-04-16 15:20:36 -0700611 len = min_t(unsigned int, len, sizeof(uf));
612 if (copy_from_user(&uf, optval, len)) {
613 err = -EFAULT;
614 break;
615 }
616
617 if (!capable(CAP_NET_RAW)) {
618 uf.type_mask &= hci_sec_filter.type_mask;
619 uf.event_mask[0] &= *((u32 *) hci_sec_filter.event_mask + 0);
620 uf.event_mask[1] &= *((u32 *) hci_sec_filter.event_mask + 1);
621 }
622
623 {
624 struct hci_filter *f = &hci_pi(sk)->filter;
625
626 f->type_mask = uf.type_mask;
627 f->opcode = uf.opcode;
628 *((u32 *) f->event_mask + 0) = uf.event_mask[0];
629 *((u32 *) f->event_mask + 1) = uf.event_mask[1];
630 }
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900631 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700632
633 default:
634 err = -ENOPROTOOPT;
635 break;
636 }
637
638 release_sock(sk);
639 return err;
640}
641
642static int hci_sock_getsockopt(struct socket *sock, int level, int optname, char __user *optval, int __user *optlen)
643{
644 struct hci_ufilter uf;
645 struct sock *sk = sock->sk;
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900646 int len, opt;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700647
648 if (get_user(len, optlen))
649 return -EFAULT;
650
651 switch (optname) {
652 case HCI_DATA_DIR:
653 if (hci_pi(sk)->cmsg_mask & HCI_CMSG_DIR)
654 opt = 1;
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900655 else
Linus Torvalds1da177e2005-04-16 15:20:36 -0700656 opt = 0;
657
658 if (put_user(opt, optval))
659 return -EFAULT;
660 break;
661
662 case HCI_TIME_STAMP:
663 if (hci_pi(sk)->cmsg_mask & HCI_CMSG_TSTAMP)
664 opt = 1;
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900665 else
Linus Torvalds1da177e2005-04-16 15:20:36 -0700666 opt = 0;
667
668 if (put_user(opt, optval))
669 return -EFAULT;
670 break;
671
672 case HCI_FILTER:
673 {
674 struct hci_filter *f = &hci_pi(sk)->filter;
675
676 uf.type_mask = f->type_mask;
677 uf.opcode = f->opcode;
678 uf.event_mask[0] = *((u32 *) f->event_mask + 0);
679 uf.event_mask[1] = *((u32 *) f->event_mask + 1);
680 }
681
682 len = min_t(unsigned int, len, sizeof(uf));
683 if (copy_to_user(optval, &uf, len))
684 return -EFAULT;
685 break;
686
687 default:
688 return -ENOPROTOOPT;
689 break;
690 }
691
692 return 0;
693}
694
Eric Dumazet90ddc4f2005-12-22 12:49:22 -0800695static const struct proto_ops hci_sock_ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700696 .family = PF_BLUETOOTH,
697 .owner = THIS_MODULE,
698 .release = hci_sock_release,
699 .bind = hci_sock_bind,
700 .getname = hci_sock_getname,
701 .sendmsg = hci_sock_sendmsg,
702 .recvmsg = hci_sock_recvmsg,
703 .ioctl = hci_sock_ioctl,
704 .poll = datagram_poll,
705 .listen = sock_no_listen,
706 .shutdown = sock_no_shutdown,
707 .setsockopt = hci_sock_setsockopt,
708 .getsockopt = hci_sock_getsockopt,
709 .connect = sock_no_connect,
710 .socketpair = sock_no_socketpair,
711 .accept = sock_no_accept,
712 .mmap = sock_no_mmap
713};
714
715static struct proto hci_sk_proto = {
716 .name = "HCI",
717 .owner = THIS_MODULE,
718 .obj_size = sizeof(struct hci_pinfo)
719};
720
Eric Paris3f378b62009-11-05 22:18:14 -0800721static int hci_sock_create(struct net *net, struct socket *sock, int protocol,
722 int kern)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700723{
724 struct sock *sk;
725
726 BT_DBG("sock %p", sock);
727
728 if (sock->type != SOCK_RAW)
729 return -ESOCKTNOSUPPORT;
730
731 sock->ops = &hci_sock_ops;
732
Pavel Emelyanov6257ff22007-11-01 00:39:31 -0700733 sk = sk_alloc(net, PF_BLUETOOTH, GFP_ATOMIC, &hci_sk_proto);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700734 if (!sk)
735 return -ENOMEM;
736
737 sock_init_data(sock, sk);
738
739 sock_reset_flag(sk, SOCK_ZAPPED);
740
741 sk->sk_protocol = protocol;
742
743 sock->state = SS_UNCONNECTED;
744 sk->sk_state = BT_OPEN;
745
746 bt_sock_link(&hci_sk_list, sk);
747 return 0;
748}
749
750static int hci_sock_dev_event(struct notifier_block *this, unsigned long event, void *ptr)
751{
752 struct hci_dev *hdev = (struct hci_dev *) ptr;
753 struct hci_ev_si_device ev;
754
755 BT_DBG("hdev %s event %ld", hdev->name, event);
756
757 /* Send event to sockets */
758 ev.event = event;
759 ev.dev_id = hdev->id;
760 hci_si_event(NULL, HCI_EV_SI_DEVICE, sizeof(ev), &ev);
761
762 if (event == HCI_DEV_UNREG) {
763 struct sock *sk;
764 struct hlist_node *node;
765
766 /* Detach sockets from device */
767 read_lock(&hci_sk_list.lock);
768 sk_for_each(sk, node, &hci_sk_list.head) {
Satyam Sharma4ce61d12007-05-16 23:50:16 -0700769 local_bh_disable();
770 bh_lock_sock_nested(sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700771 if (hci_pi(sk)->hdev == hdev) {
772 hci_pi(sk)->hdev = NULL;
773 sk->sk_err = EPIPE;
774 sk->sk_state = BT_OPEN;
775 sk->sk_state_change(sk);
776
777 hci_dev_put(hdev);
778 }
Satyam Sharma4ce61d12007-05-16 23:50:16 -0700779 bh_unlock_sock(sk);
780 local_bh_enable();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700781 }
782 read_unlock(&hci_sk_list.lock);
783 }
784
785 return NOTIFY_DONE;
786}
787
Stephen Hemmingerec1b4cf2009-10-05 05:58:39 +0000788static const struct net_proto_family hci_sock_family_ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700789 .family = PF_BLUETOOTH,
790 .owner = THIS_MODULE,
791 .create = hci_sock_create,
792};
793
794static struct notifier_block hci_sock_nblock = {
795 .notifier_call = hci_sock_dev_event
796};
797
798int __init hci_sock_init(void)
799{
800 int err;
801
802 err = proto_register(&hci_sk_proto, 0);
803 if (err < 0)
804 return err;
805
806 err = bt_sock_register(BTPROTO_HCI, &hci_sock_family_ops);
807 if (err < 0)
808 goto error;
809
810 hci_register_notifier(&hci_sock_nblock);
811
812 BT_INFO("HCI socket layer initialized");
813
814 return 0;
815
816error:
817 BT_ERR("HCI socket registration failed");
818 proto_unregister(&hci_sk_proto);
819 return err;
820}
821
Tobias Klauser04005dd2008-03-05 18:47:03 -0800822void __exit hci_sock_cleanup(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700823{
824 if (bt_sock_unregister(BTPROTO_HCI) < 0)
825 BT_ERR("HCI socket unregistration failed");
826
827 hci_unregister_notifier(&hci_sock_nblock);
828
829 proto_unregister(&hci_sk_proto);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700830}