blob: 14991323c273a15793823107e25d79af5403f58e [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
52#ifndef CONFIG_BT_HCI_SOCK_DEBUG
53#undef BT_DBG
54#define BT_DBG(D...)
55#endif
56
57/* ----- HCI socket interface ----- */
58
59static inline int hci_test_bit(int nr, void *addr)
60{
61 return *((__u32 *) addr + (nr >> 5)) & ((__u32) 1 << (nr & 31));
62}
63
64/* Security filter */
65static struct hci_sec_filter hci_sec_filter = {
66 /* Packet types */
67 0x10,
68 /* Events */
Marcel Holtmanndd7f5522005-10-28 19:20:53 +020069 { 0x1000d9fe, 0x0000b00c },
Linus Torvalds1da177e2005-04-16 15:20:36 -070070 /* Commands */
71 {
72 { 0x0 },
73 /* OGF_LINK_CTL */
Marcel Holtmann7c631a62007-09-09 08:39:43 +020074 { 0xbe000006, 0x00000001, 0x00000000, 0x00 },
Linus Torvalds1da177e2005-04-16 15:20:36 -070075 /* OGF_LINK_POLICY */
Marcel Holtmann7c631a62007-09-09 08:39:43 +020076 { 0x00005200, 0x00000000, 0x00000000, 0x00 },
Linus Torvalds1da177e2005-04-16 15:20:36 -070077 /* OGF_HOST_CTL */
Marcel Holtmann7c631a62007-09-09 08:39:43 +020078 { 0xaab00200, 0x2b402aaa, 0x05220154, 0x00 },
Linus Torvalds1da177e2005-04-16 15:20:36 -070079 /* OGF_INFO_PARAM */
Marcel Holtmann7c631a62007-09-09 08:39:43 +020080 { 0x000002be, 0x00000000, 0x00000000, 0x00 },
Linus Torvalds1da177e2005-04-16 15:20:36 -070081 /* OGF_STATUS_PARAM */
Marcel Holtmann7c631a62007-09-09 08:39:43 +020082 { 0x000000ea, 0x00000000, 0x00000000, 0x00 }
Linus Torvalds1da177e2005-04-16 15:20:36 -070083 }
84};
85
86static struct bt_sock_list hci_sk_list = {
87 .lock = RW_LOCK_UNLOCKED
88};
89
90/* Send frame to RAW socket */
91void hci_send_to_sock(struct hci_dev *hdev, struct sk_buff *skb)
92{
93 struct sock *sk;
94 struct hlist_node *node;
95
96 BT_DBG("hdev %p len %d", hdev, skb->len);
97
98 read_lock(&hci_sk_list.lock);
99 sk_for_each(sk, node, &hci_sk_list.head) {
100 struct hci_filter *flt;
101 struct sk_buff *nskb;
102
103 if (sk->sk_state != BT_BOUND || hci_pi(sk)->hdev != hdev)
104 continue;
105
106 /* Don't send frame to the socket it came from */
107 if (skb->sk == sk)
108 continue;
109
110 /* Apply filter */
111 flt = &hci_pi(sk)->filter;
112
Marcel Holtmann0d48d932005-08-09 20:30:28 -0700113 if (!test_bit((bt_cb(skb)->pkt_type == HCI_VENDOR_PKT) ?
114 0 : (bt_cb(skb)->pkt_type & HCI_FLT_TYPE_BITS), &flt->type_mask))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700115 continue;
116
Marcel Holtmann0d48d932005-08-09 20:30:28 -0700117 if (bt_cb(skb)->pkt_type == HCI_EVENT_PKT) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700118 register int evt = (*(__u8 *)skb->data & HCI_FLT_EVENT_BITS);
119
120 if (!hci_test_bit(evt, &flt->event_mask))
121 continue;
122
David S. Miller4498c802006-11-21 16:17:41 -0800123 if (flt->opcode &&
124 ((evt == HCI_EV_CMD_COMPLETE &&
125 flt->opcode !=
Al Viro905f3ed2006-12-13 00:35:01 -0800126 get_unaligned((__le16 *)(skb->data + 3))) ||
David S. Miller4498c802006-11-21 16:17:41 -0800127 (evt == HCI_EV_CMD_STATUS &&
128 flt->opcode !=
Al Viro905f3ed2006-12-13 00:35:01 -0800129 get_unaligned((__le16 *)(skb->data + 4)))))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700130 continue;
131 }
132
133 if (!(nskb = skb_clone(skb, GFP_ATOMIC)))
134 continue;
135
136 /* Put type byte before the data */
Marcel Holtmann0d48d932005-08-09 20:30:28 -0700137 memcpy(skb_push(nskb, 1), &bt_cb(nskb)->pkt_type, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700138
139 if (sock_queue_rcv_skb(sk, nskb))
140 kfree_skb(nskb);
141 }
142 read_unlock(&hci_sk_list.lock);
143}
144
145static int hci_sock_release(struct socket *sock)
146{
147 struct sock *sk = sock->sk;
Marcel Holtmann7b005bd2006-02-13 11:40:03 +0100148 struct hci_dev *hdev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700149
150 BT_DBG("sock %p sk %p", sock, sk);
151
152 if (!sk)
153 return 0;
154
Marcel Holtmann7b005bd2006-02-13 11:40:03 +0100155 hdev = hci_pi(sk)->hdev;
156
Linus Torvalds1da177e2005-04-16 15:20:36 -0700157 bt_sock_unlink(&hci_sk_list, sk);
158
159 if (hdev) {
160 atomic_dec(&hdev->promisc);
161 hci_dev_put(hdev);
162 }
163
164 sock_orphan(sk);
165
166 skb_queue_purge(&sk->sk_receive_queue);
167 skb_queue_purge(&sk->sk_write_queue);
168
169 sock_put(sk);
170 return 0;
171}
172
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900173/* Ioctls that require bound socket */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700174static inline int hci_sock_bound_ioctl(struct sock *sk, unsigned int cmd, unsigned long arg)
175{
176 struct hci_dev *hdev = hci_pi(sk)->hdev;
177
178 if (!hdev)
179 return -EBADFD;
180
181 switch (cmd) {
182 case HCISETRAW:
183 if (!capable(CAP_NET_ADMIN))
184 return -EACCES;
185
186 if (test_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks))
187 return -EPERM;
188
189 if (arg)
190 set_bit(HCI_RAW, &hdev->flags);
191 else
192 clear_bit(HCI_RAW, &hdev->flags);
193
194 return 0;
195
196 case HCISETSECMGR:
197 if (!capable(CAP_NET_ADMIN))
198 return -EACCES;
199
200 if (arg)
201 set_bit(HCI_SECMGR, &hdev->flags);
202 else
203 clear_bit(HCI_SECMGR, &hdev->flags);
204
205 return 0;
206
207 case HCIGETCONNINFO:
208 return hci_get_conn_info(hdev, (void __user *)arg);
209
210 default:
211 if (hdev->ioctl)
212 return hdev->ioctl(hdev, cmd, arg);
213 return -EINVAL;
214 }
215}
216
217static int hci_sock_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
218{
219 struct sock *sk = sock->sk;
220 void __user *argp = (void __user *)arg;
221 int err;
222
223 BT_DBG("cmd %x arg %lx", cmd, arg);
224
225 switch (cmd) {
226 case HCIGETDEVLIST:
227 return hci_get_dev_list(argp);
228
229 case HCIGETDEVINFO:
230 return hci_get_dev_info(argp);
231
232 case HCIGETCONNLIST:
233 return hci_get_conn_list(argp);
234
235 case HCIDEVUP:
236 if (!capable(CAP_NET_ADMIN))
237 return -EACCES;
238 return hci_dev_open(arg);
239
240 case HCIDEVDOWN:
241 if (!capable(CAP_NET_ADMIN))
242 return -EACCES;
243 return hci_dev_close(arg);
244
245 case HCIDEVRESET:
246 if (!capable(CAP_NET_ADMIN))
247 return -EACCES;
248 return hci_dev_reset(arg);
249
250 case HCIDEVRESTAT:
251 if (!capable(CAP_NET_ADMIN))
252 return -EACCES;
253 return hci_dev_reset_stat(arg);
254
255 case HCISETSCAN:
256 case HCISETAUTH:
257 case HCISETENCRYPT:
258 case HCISETPTYPE:
259 case HCISETLINKPOL:
260 case HCISETLINKMODE:
261 case HCISETACLMTU:
262 case HCISETSCOMTU:
263 if (!capable(CAP_NET_ADMIN))
264 return -EACCES;
265 return hci_dev_cmd(cmd, argp);
266
267 case HCIINQUIRY:
268 return hci_inquiry(argp);
269
270 default:
271 lock_sock(sk);
272 err = hci_sock_bound_ioctl(sk, cmd, arg);
273 release_sock(sk);
274 return err;
275 }
276}
277
278static int hci_sock_bind(struct socket *sock, struct sockaddr *addr, int addr_len)
279{
280 struct sockaddr_hci *haddr = (struct sockaddr_hci *) addr;
281 struct sock *sk = sock->sk;
282 struct hci_dev *hdev = NULL;
283 int err = 0;
284
285 BT_DBG("sock %p sk %p", sock, sk);
286
287 if (!haddr || haddr->hci_family != AF_BLUETOOTH)
288 return -EINVAL;
289
290 lock_sock(sk);
291
292 if (hci_pi(sk)->hdev) {
293 err = -EALREADY;
294 goto done;
295 }
296
297 if (haddr->hci_dev != HCI_DEV_NONE) {
298 if (!(hdev = hci_dev_get(haddr->hci_dev))) {
299 err = -ENODEV;
300 goto done;
301 }
302
303 atomic_inc(&hdev->promisc);
304 }
305
306 hci_pi(sk)->hdev = hdev;
307 sk->sk_state = BT_BOUND;
308
309done:
310 release_sock(sk);
311 return err;
312}
313
314static int hci_sock_getname(struct socket *sock, struct sockaddr *addr, int *addr_len, int peer)
315{
316 struct sockaddr_hci *haddr = (struct sockaddr_hci *) addr;
317 struct sock *sk = sock->sk;
Marcel Holtmann7b005bd2006-02-13 11:40:03 +0100318 struct hci_dev *hdev = hci_pi(sk)->hdev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700319
320 BT_DBG("sock %p sk %p", sock, sk);
321
Marcel Holtmann7b005bd2006-02-13 11:40:03 +0100322 if (!hdev)
323 return -EBADFD;
324
Linus Torvalds1da177e2005-04-16 15:20:36 -0700325 lock_sock(sk);
326
327 *addr_len = sizeof(*haddr);
328 haddr->hci_family = AF_BLUETOOTH;
Marcel Holtmann7b005bd2006-02-13 11:40:03 +0100329 haddr->hci_dev = hdev->id;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700330
331 release_sock(sk);
332 return 0;
333}
334
335static inline void hci_sock_cmsg(struct sock *sk, struct msghdr *msg, struct sk_buff *skb)
336{
337 __u32 mask = hci_pi(sk)->cmsg_mask;
338
Marcel Holtmann0d48d932005-08-09 20:30:28 -0700339 if (mask & HCI_CMSG_DIR) {
340 int incoming = bt_cb(skb)->incoming;
341 put_cmsg(msg, SOL_HCI, HCI_CMSG_DIR, sizeof(incoming), &incoming);
342 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700343
Patrick McHardya61bbcf2005-08-14 17:24:31 -0700344 if (mask & HCI_CMSG_TSTAMP) {
345 struct timeval tv;
Marcel Holtmann767c5eb2007-09-09 08:39:34 +0200346 void *data;
347 int len;
Patrick McHardya61bbcf2005-08-14 17:24:31 -0700348
349 skb_get_timestamp(skb, &tv);
Marcel Holtmann767c5eb2007-09-09 08:39:34 +0200350
David S. Miller1da97f82007-09-12 14:10:58 +0200351 data = &tv;
352 len = sizeof(tv);
353#ifdef CONFIG_COMPAT
Marcel Holtmann767c5eb2007-09-09 08:39:34 +0200354 if (msg->msg_flags & MSG_CMSG_COMPAT) {
355 struct compat_timeval ctv;
356 ctv.tv_sec = tv.tv_sec;
357 ctv.tv_usec = tv.tv_usec;
358 data = &ctv;
359 len = sizeof(ctv);
Marcel Holtmann767c5eb2007-09-09 08:39:34 +0200360 }
David S. Miller1da97f82007-09-12 14:10:58 +0200361#endif
Marcel Holtmann767c5eb2007-09-09 08:39:34 +0200362
363 put_cmsg(msg, SOL_HCI, HCI_CMSG_TSTAMP, len, data);
Patrick McHardya61bbcf2005-08-14 17:24:31 -0700364 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700365}
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900366
367static int hci_sock_recvmsg(struct kiocb *iocb, struct socket *sock,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700368 struct msghdr *msg, size_t len, int flags)
369{
370 int noblock = flags & MSG_DONTWAIT;
371 struct sock *sk = sock->sk;
372 struct sk_buff *skb;
373 int copied, err;
374
375 BT_DBG("sock %p, sk %p", sock, sk);
376
377 if (flags & (MSG_OOB))
378 return -EOPNOTSUPP;
379
380 if (sk->sk_state == BT_CLOSED)
381 return 0;
382
383 if (!(skb = skb_recv_datagram(sk, flags, noblock, &err)))
384 return err;
385
386 msg->msg_namelen = 0;
387
388 copied = skb->len;
389 if (len < copied) {
390 msg->msg_flags |= MSG_TRUNC;
391 copied = len;
392 }
393
Arnaldo Carvalho de Melobadff6d2007-03-13 13:06:52 -0300394 skb_reset_transport_header(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700395 err = skb_copy_datagram_iovec(skb, 0, msg->msg_iov, copied);
396
397 hci_sock_cmsg(sk, msg, skb);
398
399 skb_free_datagram(sk, skb);
400
401 return err ? : copied;
402}
403
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900404static int hci_sock_sendmsg(struct kiocb *iocb, struct socket *sock,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700405 struct msghdr *msg, size_t len)
406{
407 struct sock *sk = sock->sk;
408 struct hci_dev *hdev;
409 struct sk_buff *skb;
410 int err;
411
412 BT_DBG("sock %p sk %p", sock, sk);
413
414 if (msg->msg_flags & MSG_OOB)
415 return -EOPNOTSUPP;
416
417 if (msg->msg_flags & ~(MSG_DONTWAIT|MSG_NOSIGNAL|MSG_ERRQUEUE))
418 return -EINVAL;
419
420 if (len < 4 || len > HCI_MAX_FRAME_SIZE)
421 return -EINVAL;
422
423 lock_sock(sk);
424
425 if (!(hdev = hci_pi(sk)->hdev)) {
426 err = -EBADFD;
427 goto done;
428 }
429
430 if (!(skb = bt_skb_send_alloc(sk, len, msg->msg_flags & MSG_DONTWAIT, &err)))
431 goto done;
432
433 if (memcpy_fromiovec(skb_put(skb, len), msg->msg_iov, len)) {
434 err = -EFAULT;
435 goto drop;
436 }
437
Marcel Holtmann0d48d932005-08-09 20:30:28 -0700438 bt_cb(skb)->pkt_type = *((unsigned char *) skb->data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700439 skb_pull(skb, 1);
440 skb->dev = (void *) hdev;
441
Marcel Holtmann0d48d932005-08-09 20:30:28 -0700442 if (bt_cb(skb)->pkt_type == HCI_COMMAND_PKT) {
Marcel Holtmann1ebb9252005-11-08 09:57:21 -0800443 u16 opcode = __le16_to_cpu(get_unaligned((__le16 *) skb->data));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700444 u16 ogf = hci_opcode_ogf(opcode);
445 u16 ocf = hci_opcode_ocf(opcode);
446
447 if (((ogf > HCI_SFLT_MAX_OGF) ||
448 !hci_test_bit(ocf & HCI_FLT_OCF_BITS, &hci_sec_filter.ocf_mask[ogf])) &&
449 !capable(CAP_NET_RAW)) {
450 err = -EPERM;
451 goto drop;
452 }
453
Marcel Holtmanna9de9242007-10-20 13:33:56 +0200454 if (test_bit(HCI_RAW, &hdev->flags) || (ogf == 0x3f)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700455 skb_queue_tail(&hdev->raw_q, skb);
456 hci_sched_tx(hdev);
457 } else {
458 skb_queue_tail(&hdev->cmd_q, skb);
459 hci_sched_cmd(hdev);
460 }
461 } else {
462 if (!capable(CAP_NET_RAW)) {
463 err = -EPERM;
464 goto drop;
465 }
466
467 skb_queue_tail(&hdev->raw_q, skb);
468 hci_sched_tx(hdev);
469 }
470
471 err = len;
472
473done:
474 release_sock(sk);
475 return err;
476
477drop:
478 kfree_skb(skb);
479 goto done;
480}
481
482static int hci_sock_setsockopt(struct socket *sock, int level, int optname, char __user *optval, int len)
483{
484 struct hci_ufilter uf = { .opcode = 0 };
485 struct sock *sk = sock->sk;
486 int err = 0, opt = 0;
487
488 BT_DBG("sk %p, opt %d", sk, optname);
489
490 lock_sock(sk);
491
492 switch (optname) {
493 case HCI_DATA_DIR:
494 if (get_user(opt, (int __user *)optval)) {
495 err = -EFAULT;
496 break;
497 }
498
499 if (opt)
500 hci_pi(sk)->cmsg_mask |= HCI_CMSG_DIR;
501 else
502 hci_pi(sk)->cmsg_mask &= ~HCI_CMSG_DIR;
503 break;
504
505 case HCI_TIME_STAMP:
506 if (get_user(opt, (int __user *)optval)) {
507 err = -EFAULT;
508 break;
509 }
510
511 if (opt)
512 hci_pi(sk)->cmsg_mask |= HCI_CMSG_TSTAMP;
513 else
514 hci_pi(sk)->cmsg_mask &= ~HCI_CMSG_TSTAMP;
515 break;
516
517 case HCI_FILTER:
Marcel Holtmann0878b662007-05-05 00:35:59 +0200518 {
519 struct hci_filter *f = &hci_pi(sk)->filter;
520
521 uf.type_mask = f->type_mask;
522 uf.opcode = f->opcode;
523 uf.event_mask[0] = *((u32 *) f->event_mask + 0);
524 uf.event_mask[1] = *((u32 *) f->event_mask + 1);
525 }
526
Linus Torvalds1da177e2005-04-16 15:20:36 -0700527 len = min_t(unsigned int, len, sizeof(uf));
528 if (copy_from_user(&uf, optval, len)) {
529 err = -EFAULT;
530 break;
531 }
532
533 if (!capable(CAP_NET_RAW)) {
534 uf.type_mask &= hci_sec_filter.type_mask;
535 uf.event_mask[0] &= *((u32 *) hci_sec_filter.event_mask + 0);
536 uf.event_mask[1] &= *((u32 *) hci_sec_filter.event_mask + 1);
537 }
538
539 {
540 struct hci_filter *f = &hci_pi(sk)->filter;
541
542 f->type_mask = uf.type_mask;
543 f->opcode = uf.opcode;
544 *((u32 *) f->event_mask + 0) = uf.event_mask[0];
545 *((u32 *) f->event_mask + 1) = uf.event_mask[1];
546 }
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900547 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700548
549 default:
550 err = -ENOPROTOOPT;
551 break;
552 }
553
554 release_sock(sk);
555 return err;
556}
557
558static int hci_sock_getsockopt(struct socket *sock, int level, int optname, char __user *optval, int __user *optlen)
559{
560 struct hci_ufilter uf;
561 struct sock *sk = sock->sk;
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900562 int len, opt;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700563
564 if (get_user(len, optlen))
565 return -EFAULT;
566
567 switch (optname) {
568 case HCI_DATA_DIR:
569 if (hci_pi(sk)->cmsg_mask & HCI_CMSG_DIR)
570 opt = 1;
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900571 else
Linus Torvalds1da177e2005-04-16 15:20:36 -0700572 opt = 0;
573
574 if (put_user(opt, optval))
575 return -EFAULT;
576 break;
577
578 case HCI_TIME_STAMP:
579 if (hci_pi(sk)->cmsg_mask & HCI_CMSG_TSTAMP)
580 opt = 1;
YOSHIFUJI Hideaki8e87d142007-02-09 23:24:33 +0900581 else
Linus Torvalds1da177e2005-04-16 15:20:36 -0700582 opt = 0;
583
584 if (put_user(opt, optval))
585 return -EFAULT;
586 break;
587
588 case HCI_FILTER:
589 {
590 struct hci_filter *f = &hci_pi(sk)->filter;
591
592 uf.type_mask = f->type_mask;
593 uf.opcode = f->opcode;
594 uf.event_mask[0] = *((u32 *) f->event_mask + 0);
595 uf.event_mask[1] = *((u32 *) f->event_mask + 1);
596 }
597
598 len = min_t(unsigned int, len, sizeof(uf));
599 if (copy_to_user(optval, &uf, len))
600 return -EFAULT;
601 break;
602
603 default:
604 return -ENOPROTOOPT;
605 break;
606 }
607
608 return 0;
609}
610
Eric Dumazet90ddc4f2005-12-22 12:49:22 -0800611static const struct proto_ops hci_sock_ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700612 .family = PF_BLUETOOTH,
613 .owner = THIS_MODULE,
614 .release = hci_sock_release,
615 .bind = hci_sock_bind,
616 .getname = hci_sock_getname,
617 .sendmsg = hci_sock_sendmsg,
618 .recvmsg = hci_sock_recvmsg,
619 .ioctl = hci_sock_ioctl,
620 .poll = datagram_poll,
621 .listen = sock_no_listen,
622 .shutdown = sock_no_shutdown,
623 .setsockopt = hci_sock_setsockopt,
624 .getsockopt = hci_sock_getsockopt,
625 .connect = sock_no_connect,
626 .socketpair = sock_no_socketpair,
627 .accept = sock_no_accept,
628 .mmap = sock_no_mmap
629};
630
631static struct proto hci_sk_proto = {
632 .name = "HCI",
633 .owner = THIS_MODULE,
634 .obj_size = sizeof(struct hci_pinfo)
635};
636
Eric W. Biederman1b8d7ae2007-10-08 23:24:22 -0700637static int hci_sock_create(struct net *net, struct socket *sock, int protocol)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700638{
639 struct sock *sk;
640
641 BT_DBG("sock %p", sock);
642
643 if (sock->type != SOCK_RAW)
644 return -ESOCKTNOSUPPORT;
645
646 sock->ops = &hci_sock_ops;
647
Pavel Emelyanov6257ff22007-11-01 00:39:31 -0700648 sk = sk_alloc(net, PF_BLUETOOTH, GFP_ATOMIC, &hci_sk_proto);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700649 if (!sk)
650 return -ENOMEM;
651
652 sock_init_data(sock, sk);
653
654 sock_reset_flag(sk, SOCK_ZAPPED);
655
656 sk->sk_protocol = protocol;
657
658 sock->state = SS_UNCONNECTED;
659 sk->sk_state = BT_OPEN;
660
661 bt_sock_link(&hci_sk_list, sk);
662 return 0;
663}
664
665static int hci_sock_dev_event(struct notifier_block *this, unsigned long event, void *ptr)
666{
667 struct hci_dev *hdev = (struct hci_dev *) ptr;
668 struct hci_ev_si_device ev;
669
670 BT_DBG("hdev %s event %ld", hdev->name, event);
671
672 /* Send event to sockets */
673 ev.event = event;
674 ev.dev_id = hdev->id;
675 hci_si_event(NULL, HCI_EV_SI_DEVICE, sizeof(ev), &ev);
676
677 if (event == HCI_DEV_UNREG) {
678 struct sock *sk;
679 struct hlist_node *node;
680
681 /* Detach sockets from device */
682 read_lock(&hci_sk_list.lock);
683 sk_for_each(sk, node, &hci_sk_list.head) {
Satyam Sharma4ce61d12007-05-16 23:50:16 -0700684 local_bh_disable();
685 bh_lock_sock_nested(sk);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700686 if (hci_pi(sk)->hdev == hdev) {
687 hci_pi(sk)->hdev = NULL;
688 sk->sk_err = EPIPE;
689 sk->sk_state = BT_OPEN;
690 sk->sk_state_change(sk);
691
692 hci_dev_put(hdev);
693 }
Satyam Sharma4ce61d12007-05-16 23:50:16 -0700694 bh_unlock_sock(sk);
695 local_bh_enable();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700696 }
697 read_unlock(&hci_sk_list.lock);
698 }
699
700 return NOTIFY_DONE;
701}
702
703static struct net_proto_family hci_sock_family_ops = {
704 .family = PF_BLUETOOTH,
705 .owner = THIS_MODULE,
706 .create = hci_sock_create,
707};
708
709static struct notifier_block hci_sock_nblock = {
710 .notifier_call = hci_sock_dev_event
711};
712
713int __init hci_sock_init(void)
714{
715 int err;
716
717 err = proto_register(&hci_sk_proto, 0);
718 if (err < 0)
719 return err;
720
721 err = bt_sock_register(BTPROTO_HCI, &hci_sock_family_ops);
722 if (err < 0)
723 goto error;
724
725 hci_register_notifier(&hci_sock_nblock);
726
727 BT_INFO("HCI socket layer initialized");
728
729 return 0;
730
731error:
732 BT_ERR("HCI socket registration failed");
733 proto_unregister(&hci_sk_proto);
734 return err;
735}
736
737int __exit hci_sock_cleanup(void)
738{
739 if (bt_sock_unregister(BTPROTO_HCI) < 0)
740 BT_ERR("HCI socket unregistration failed");
741
742 hci_unregister_notifier(&hci_sock_nblock);
743
744 proto_unregister(&hci_sk_proto);
745
746 return 0;
747}