11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds BlueZ - Bluetooth protocol stack for Linux 31da177e4SLinus Torvalds Copyright (C) 2000-2001 Qualcomm Incorporated 41da177e4SLinus Torvalds 51da177e4SLinus Torvalds Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com> 61da177e4SLinus Torvalds 71da177e4SLinus Torvalds This program is free software; you can redistribute it and/or modify 81da177e4SLinus Torvalds it under the terms of the GNU General Public License version 2 as 91da177e4SLinus Torvalds published by the Free Software Foundation; 101da177e4SLinus Torvalds 111da177e4SLinus Torvalds THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS 121da177e4SLinus Torvalds OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 131da177e4SLinus Torvalds FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS. 141da177e4SLinus Torvalds IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY 151da177e4SLinus Torvalds CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES 161da177e4SLinus Torvalds WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 171da177e4SLinus Torvalds ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 181da177e4SLinus Torvalds OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 191da177e4SLinus Torvalds 201da177e4SLinus Torvalds ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS, 211da177e4SLinus Torvalds COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS 221da177e4SLinus Torvalds SOFTWARE IS DISCLAIMED. 231da177e4SLinus Torvalds */ 241da177e4SLinus Torvalds 251da177e4SLinus Torvalds /* Bluetooth HCI sockets. */ 261da177e4SLinus Torvalds 271da177e4SLinus Torvalds #include <linux/module.h> 281da177e4SLinus Torvalds 291da177e4SLinus Torvalds #include <linux/types.h> 304fc268d2SRandy Dunlap #include <linux/capability.h> 311da177e4SLinus Torvalds #include <linux/errno.h> 321da177e4SLinus Torvalds #include <linux/kernel.h> 331da177e4SLinus Torvalds #include <linux/slab.h> 341da177e4SLinus Torvalds #include <linux/poll.h> 351da177e4SLinus Torvalds #include <linux/fcntl.h> 361da177e4SLinus Torvalds #include <linux/init.h> 371da177e4SLinus Torvalds #include <linux/skbuff.h> 381da177e4SLinus Torvalds #include <linux/workqueue.h> 391da177e4SLinus Torvalds #include <linux/interrupt.h> 40767c5eb5SMarcel Holtmann #include <linux/compat.h> 411da177e4SLinus Torvalds #include <linux/socket.h> 421da177e4SLinus Torvalds #include <linux/ioctl.h> 431da177e4SLinus Torvalds #include <net/sock.h> 441da177e4SLinus Torvalds 451da177e4SLinus Torvalds #include <asm/system.h> 4670f23020SAndrei Emeltchenko #include <linux/uaccess.h> 471da177e4SLinus Torvalds #include <asm/unaligned.h> 481da177e4SLinus Torvalds 491da177e4SLinus Torvalds #include <net/bluetooth/bluetooth.h> 501da177e4SLinus Torvalds #include <net/bluetooth/hci_core.h> 511da177e4SLinus Torvalds 520381101fSJohan Hedberg static int enable_mgmt; 530381101fSJohan Hedberg 541da177e4SLinus Torvalds /* ----- HCI socket interface ----- */ 551da177e4SLinus Torvalds 561da177e4SLinus Torvalds static inline int hci_test_bit(int nr, void *addr) 571da177e4SLinus Torvalds { 581da177e4SLinus Torvalds return *((__u32 *) addr + (nr >> 5)) & ((__u32) 1 << (nr & 31)); 591da177e4SLinus Torvalds } 601da177e4SLinus Torvalds 611da177e4SLinus Torvalds /* Security filter */ 621da177e4SLinus Torvalds static struct hci_sec_filter hci_sec_filter = { 631da177e4SLinus Torvalds /* Packet types */ 641da177e4SLinus Torvalds 0x10, 651da177e4SLinus Torvalds /* Events */ 66dd7f5527SMarcel Holtmann { 0x1000d9fe, 0x0000b00c }, 671da177e4SLinus Torvalds /* Commands */ 681da177e4SLinus Torvalds { 691da177e4SLinus Torvalds { 0x0 }, 701da177e4SLinus Torvalds /* OGF_LINK_CTL */ 717c631a67SMarcel Holtmann { 0xbe000006, 0x00000001, 0x00000000, 0x00 }, 721da177e4SLinus Torvalds /* OGF_LINK_POLICY */ 737c631a67SMarcel Holtmann { 0x00005200, 0x00000000, 0x00000000, 0x00 }, 741da177e4SLinus Torvalds /* OGF_HOST_CTL */ 757c631a67SMarcel Holtmann { 0xaab00200, 0x2b402aaa, 0x05220154, 0x00 }, 761da177e4SLinus Torvalds /* OGF_INFO_PARAM */ 777c631a67SMarcel Holtmann { 0x000002be, 0x00000000, 0x00000000, 0x00 }, 781da177e4SLinus Torvalds /* OGF_STATUS_PARAM */ 797c631a67SMarcel Holtmann { 0x000000ea, 0x00000000, 0x00000000, 0x00 } 801da177e4SLinus Torvalds } 811da177e4SLinus Torvalds }; 821da177e4SLinus Torvalds 831da177e4SLinus Torvalds static struct bt_sock_list hci_sk_list = { 84d5fb2962SRobert P. J. Day .lock = __RW_LOCK_UNLOCKED(hci_sk_list.lock) 851da177e4SLinus Torvalds }; 861da177e4SLinus Torvalds 871da177e4SLinus Torvalds /* Send frame to RAW socket */ 881da177e4SLinus Torvalds void hci_send_to_sock(struct hci_dev *hdev, struct sk_buff *skb) 891da177e4SLinus Torvalds { 901da177e4SLinus Torvalds struct sock *sk; 911da177e4SLinus Torvalds struct hlist_node *node; 921da177e4SLinus Torvalds 931da177e4SLinus Torvalds BT_DBG("hdev %p len %d", hdev, skb->len); 941da177e4SLinus Torvalds 951da177e4SLinus Torvalds read_lock(&hci_sk_list.lock); 961da177e4SLinus Torvalds sk_for_each(sk, node, &hci_sk_list.head) { 971da177e4SLinus Torvalds struct hci_filter *flt; 981da177e4SLinus Torvalds struct sk_buff *nskb; 991da177e4SLinus Torvalds 1001da177e4SLinus Torvalds if (sk->sk_state != BT_BOUND || hci_pi(sk)->hdev != hdev) 1011da177e4SLinus Torvalds continue; 1021da177e4SLinus Torvalds 1031da177e4SLinus Torvalds /* Don't send frame to the socket it came from */ 1041da177e4SLinus Torvalds if (skb->sk == sk) 1051da177e4SLinus Torvalds continue; 1061da177e4SLinus Torvalds 107a40c406cSJohan Hedberg if (bt_cb(skb)->channel != hci_pi(sk)->channel) 108a40c406cSJohan Hedberg continue; 109a40c406cSJohan Hedberg 110a40c406cSJohan Hedberg if (bt_cb(skb)->channel == HCI_CHANNEL_CONTROL) 111a40c406cSJohan Hedberg goto clone; 112a40c406cSJohan Hedberg 1131da177e4SLinus Torvalds /* Apply filter */ 1141da177e4SLinus Torvalds flt = &hci_pi(sk)->filter; 1151da177e4SLinus Torvalds 1160d48d939SMarcel Holtmann if (!test_bit((bt_cb(skb)->pkt_type == HCI_VENDOR_PKT) ? 1170d48d939SMarcel Holtmann 0 : (bt_cb(skb)->pkt_type & HCI_FLT_TYPE_BITS), &flt->type_mask)) 1181da177e4SLinus Torvalds continue; 1191da177e4SLinus Torvalds 1200d48d939SMarcel Holtmann if (bt_cb(skb)->pkt_type == HCI_EVENT_PKT) { 1211da177e4SLinus Torvalds register int evt = (*(__u8 *)skb->data & HCI_FLT_EVENT_BITS); 1221da177e4SLinus Torvalds 1231da177e4SLinus Torvalds if (!hci_test_bit(evt, &flt->event_mask)) 1241da177e4SLinus Torvalds continue; 1251da177e4SLinus Torvalds 1264498c80dSDavid S. Miller if (flt->opcode && 1274498c80dSDavid S. Miller ((evt == HCI_EV_CMD_COMPLETE && 1284498c80dSDavid S. Miller flt->opcode != 129905f3ed6SAl Viro get_unaligned((__le16 *)(skb->data + 3))) || 1301da177e4SLinus Torvalds (evt == HCI_EV_CMD_STATUS && 1314498c80dSDavid S. Miller flt->opcode != 132905f3ed6SAl Viro get_unaligned((__le16 *)(skb->data + 4))))) 1331da177e4SLinus Torvalds continue; 1341da177e4SLinus Torvalds } 1351da177e4SLinus Torvalds 136a40c406cSJohan Hedberg clone: 13770f23020SAndrei Emeltchenko nskb = skb_clone(skb, GFP_ATOMIC); 13870f23020SAndrei Emeltchenko if (!nskb) 1391da177e4SLinus Torvalds continue; 1401da177e4SLinus Torvalds 1411da177e4SLinus Torvalds /* Put type byte before the data */ 142a40c406cSJohan Hedberg if (bt_cb(skb)->channel == HCI_CHANNEL_RAW) 1430d48d939SMarcel Holtmann memcpy(skb_push(nskb, 1), &bt_cb(nskb)->pkt_type, 1); 1441da177e4SLinus Torvalds 1451da177e4SLinus Torvalds if (sock_queue_rcv_skb(sk, nskb)) 1461da177e4SLinus Torvalds kfree_skb(nskb); 1471da177e4SLinus Torvalds } 1481da177e4SLinus Torvalds read_unlock(&hci_sk_list.lock); 1491da177e4SLinus Torvalds } 1501da177e4SLinus Torvalds 1511da177e4SLinus Torvalds static int hci_sock_release(struct socket *sock) 1521da177e4SLinus Torvalds { 1531da177e4SLinus Torvalds struct sock *sk = sock->sk; 1547b005bd3SMarcel Holtmann struct hci_dev *hdev; 1551da177e4SLinus Torvalds 1561da177e4SLinus Torvalds BT_DBG("sock %p sk %p", sock, sk); 1571da177e4SLinus Torvalds 1581da177e4SLinus Torvalds if (!sk) 1591da177e4SLinus Torvalds return 0; 1601da177e4SLinus Torvalds 1617b005bd3SMarcel Holtmann hdev = hci_pi(sk)->hdev; 1627b005bd3SMarcel Holtmann 1631da177e4SLinus Torvalds bt_sock_unlink(&hci_sk_list, sk); 1641da177e4SLinus Torvalds 1651da177e4SLinus Torvalds if (hdev) { 1661da177e4SLinus Torvalds atomic_dec(&hdev->promisc); 1671da177e4SLinus Torvalds hci_dev_put(hdev); 1681da177e4SLinus Torvalds } 1691da177e4SLinus Torvalds 1701da177e4SLinus Torvalds sock_orphan(sk); 1711da177e4SLinus Torvalds 1721da177e4SLinus Torvalds skb_queue_purge(&sk->sk_receive_queue); 1731da177e4SLinus Torvalds skb_queue_purge(&sk->sk_write_queue); 1741da177e4SLinus Torvalds 1751da177e4SLinus Torvalds sock_put(sk); 1761da177e4SLinus Torvalds return 0; 1771da177e4SLinus Torvalds } 1781da177e4SLinus Torvalds 179f0358568SJohan Hedberg struct bdaddr_list *hci_blacklist_lookup(struct hci_dev *hdev, bdaddr_t *bdaddr) 180f0358568SJohan Hedberg { 181f0358568SJohan Hedberg struct list_head *p; 182f0358568SJohan Hedberg 183ea4bd8baSDavid Miller list_for_each(p, &hdev->blacklist) { 184f0358568SJohan Hedberg struct bdaddr_list *b; 185f0358568SJohan Hedberg 186f0358568SJohan Hedberg b = list_entry(p, struct bdaddr_list, list); 187f0358568SJohan Hedberg 188f0358568SJohan Hedberg if (bacmp(bdaddr, &b->bdaddr) == 0) 189f0358568SJohan Hedberg return b; 190f0358568SJohan Hedberg } 191f0358568SJohan Hedberg 192f0358568SJohan Hedberg return NULL; 193f0358568SJohan Hedberg } 194f0358568SJohan Hedberg 195f0358568SJohan Hedberg static int hci_blacklist_add(struct hci_dev *hdev, void __user *arg) 196f0358568SJohan Hedberg { 197f0358568SJohan Hedberg bdaddr_t bdaddr; 198f0358568SJohan Hedberg struct bdaddr_list *entry; 199f0358568SJohan Hedberg 200f0358568SJohan Hedberg if (copy_from_user(&bdaddr, arg, sizeof(bdaddr))) 201f0358568SJohan Hedberg return -EFAULT; 202f0358568SJohan Hedberg 203f0358568SJohan Hedberg if (bacmp(&bdaddr, BDADDR_ANY) == 0) 204f0358568SJohan Hedberg return -EBADF; 205f0358568SJohan Hedberg 206f0358568SJohan Hedberg if (hci_blacklist_lookup(hdev, &bdaddr)) 207f0358568SJohan Hedberg return -EEXIST; 208f0358568SJohan Hedberg 209f0358568SJohan Hedberg entry = kzalloc(sizeof(struct bdaddr_list), GFP_KERNEL); 210f0358568SJohan Hedberg if (!entry) 211f0358568SJohan Hedberg return -ENOMEM; 212f0358568SJohan Hedberg 213f0358568SJohan Hedberg bacpy(&entry->bdaddr, &bdaddr); 214f0358568SJohan Hedberg 215ea4bd8baSDavid Miller list_add(&entry->list, &hdev->blacklist); 216f0358568SJohan Hedberg 217f0358568SJohan Hedberg return 0; 218f0358568SJohan Hedberg } 219f0358568SJohan Hedberg 220f0358568SJohan Hedberg int hci_blacklist_clear(struct hci_dev *hdev) 221f0358568SJohan Hedberg { 222f0358568SJohan Hedberg struct list_head *p, *n; 223f0358568SJohan Hedberg 224ea4bd8baSDavid Miller list_for_each_safe(p, n, &hdev->blacklist) { 225f0358568SJohan Hedberg struct bdaddr_list *b; 226f0358568SJohan Hedberg 227f0358568SJohan Hedberg b = list_entry(p, struct bdaddr_list, list); 228f0358568SJohan Hedberg 229f0358568SJohan Hedberg list_del(p); 230f0358568SJohan Hedberg kfree(b); 231f0358568SJohan Hedberg } 232f0358568SJohan Hedberg 233f0358568SJohan Hedberg return 0; 234f0358568SJohan Hedberg } 235f0358568SJohan Hedberg 236f0358568SJohan Hedberg static int hci_blacklist_del(struct hci_dev *hdev, void __user *arg) 237f0358568SJohan Hedberg { 238f0358568SJohan Hedberg bdaddr_t bdaddr; 239f0358568SJohan Hedberg struct bdaddr_list *entry; 240f0358568SJohan Hedberg 241f0358568SJohan Hedberg if (copy_from_user(&bdaddr, arg, sizeof(bdaddr))) 242f0358568SJohan Hedberg return -EFAULT; 243f0358568SJohan Hedberg 244f0358568SJohan Hedberg if (bacmp(&bdaddr, BDADDR_ANY) == 0) 245f0358568SJohan Hedberg return hci_blacklist_clear(hdev); 246f0358568SJohan Hedberg 247f0358568SJohan Hedberg entry = hci_blacklist_lookup(hdev, &bdaddr); 248f0358568SJohan Hedberg if (!entry) 249f0358568SJohan Hedberg return -ENOENT; 250f0358568SJohan Hedberg 251f0358568SJohan Hedberg list_del(&entry->list); 252f0358568SJohan Hedberg kfree(entry); 253f0358568SJohan Hedberg 254f0358568SJohan Hedberg return 0; 255f0358568SJohan Hedberg } 256f0358568SJohan Hedberg 2571da177e4SLinus Torvalds /* Ioctls that require bound socket */ 2581da177e4SLinus Torvalds static inline int hci_sock_bound_ioctl(struct sock *sk, unsigned int cmd, unsigned long arg) 2591da177e4SLinus Torvalds { 2601da177e4SLinus Torvalds struct hci_dev *hdev = hci_pi(sk)->hdev; 2611da177e4SLinus Torvalds 2621da177e4SLinus Torvalds if (!hdev) 2631da177e4SLinus Torvalds return -EBADFD; 2641da177e4SLinus Torvalds 2651da177e4SLinus Torvalds switch (cmd) { 2661da177e4SLinus Torvalds case HCISETRAW: 2671da177e4SLinus Torvalds if (!capable(CAP_NET_ADMIN)) 2681da177e4SLinus Torvalds return -EACCES; 2691da177e4SLinus Torvalds 2701da177e4SLinus Torvalds if (test_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks)) 2711da177e4SLinus Torvalds return -EPERM; 2721da177e4SLinus Torvalds 2731da177e4SLinus Torvalds if (arg) 2741da177e4SLinus Torvalds set_bit(HCI_RAW, &hdev->flags); 2751da177e4SLinus Torvalds else 2761da177e4SLinus Torvalds clear_bit(HCI_RAW, &hdev->flags); 2771da177e4SLinus Torvalds 2781da177e4SLinus Torvalds return 0; 2791da177e4SLinus Torvalds 2801da177e4SLinus Torvalds case HCIGETCONNINFO: 2811da177e4SLinus Torvalds return hci_get_conn_info(hdev, (void __user *) arg); 2821da177e4SLinus Torvalds 28340be492fSMarcel Holtmann case HCIGETAUTHINFO: 28440be492fSMarcel Holtmann return hci_get_auth_info(hdev, (void __user *) arg); 28540be492fSMarcel Holtmann 286f0358568SJohan Hedberg case HCIBLOCKADDR: 287f0358568SJohan Hedberg if (!capable(CAP_NET_ADMIN)) 288f0358568SJohan Hedberg return -EACCES; 289f0358568SJohan Hedberg return hci_blacklist_add(hdev, (void __user *) arg); 290f0358568SJohan Hedberg 291f0358568SJohan Hedberg case HCIUNBLOCKADDR: 292f0358568SJohan Hedberg if (!capable(CAP_NET_ADMIN)) 293f0358568SJohan Hedberg return -EACCES; 294f0358568SJohan Hedberg return hci_blacklist_del(hdev, (void __user *) arg); 295f0358568SJohan Hedberg 2961da177e4SLinus Torvalds default: 2971da177e4SLinus Torvalds if (hdev->ioctl) 2981da177e4SLinus Torvalds return hdev->ioctl(hdev, cmd, arg); 2991da177e4SLinus Torvalds return -EINVAL; 3001da177e4SLinus Torvalds } 3011da177e4SLinus Torvalds } 3021da177e4SLinus Torvalds 3031da177e4SLinus Torvalds static int hci_sock_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg) 3041da177e4SLinus Torvalds { 3051da177e4SLinus Torvalds struct sock *sk = sock->sk; 3061da177e4SLinus Torvalds void __user *argp = (void __user *) arg; 3071da177e4SLinus Torvalds int err; 3081da177e4SLinus Torvalds 3091da177e4SLinus Torvalds BT_DBG("cmd %x arg %lx", cmd, arg); 3101da177e4SLinus Torvalds 3111da177e4SLinus Torvalds switch (cmd) { 3121da177e4SLinus Torvalds case HCIGETDEVLIST: 3131da177e4SLinus Torvalds return hci_get_dev_list(argp); 3141da177e4SLinus Torvalds 3151da177e4SLinus Torvalds case HCIGETDEVINFO: 3161da177e4SLinus Torvalds return hci_get_dev_info(argp); 3171da177e4SLinus Torvalds 3181da177e4SLinus Torvalds case HCIGETCONNLIST: 3191da177e4SLinus Torvalds return hci_get_conn_list(argp); 3201da177e4SLinus Torvalds 3211da177e4SLinus Torvalds case HCIDEVUP: 3221da177e4SLinus Torvalds if (!capable(CAP_NET_ADMIN)) 3231da177e4SLinus Torvalds return -EACCES; 3241da177e4SLinus Torvalds return hci_dev_open(arg); 3251da177e4SLinus Torvalds 3261da177e4SLinus Torvalds case HCIDEVDOWN: 3271da177e4SLinus Torvalds if (!capable(CAP_NET_ADMIN)) 3281da177e4SLinus Torvalds return -EACCES; 3291da177e4SLinus Torvalds return hci_dev_close(arg); 3301da177e4SLinus Torvalds 3311da177e4SLinus Torvalds case HCIDEVRESET: 3321da177e4SLinus Torvalds if (!capable(CAP_NET_ADMIN)) 3331da177e4SLinus Torvalds return -EACCES; 3341da177e4SLinus Torvalds return hci_dev_reset(arg); 3351da177e4SLinus Torvalds 3361da177e4SLinus Torvalds case HCIDEVRESTAT: 3371da177e4SLinus Torvalds if (!capable(CAP_NET_ADMIN)) 3381da177e4SLinus Torvalds return -EACCES; 3391da177e4SLinus Torvalds return hci_dev_reset_stat(arg); 3401da177e4SLinus Torvalds 3411da177e4SLinus Torvalds case HCISETSCAN: 3421da177e4SLinus Torvalds case HCISETAUTH: 3431da177e4SLinus Torvalds case HCISETENCRYPT: 3441da177e4SLinus Torvalds case HCISETPTYPE: 3451da177e4SLinus Torvalds case HCISETLINKPOL: 3461da177e4SLinus Torvalds case HCISETLINKMODE: 3471da177e4SLinus Torvalds case HCISETACLMTU: 3481da177e4SLinus Torvalds case HCISETSCOMTU: 3491da177e4SLinus Torvalds if (!capable(CAP_NET_ADMIN)) 3501da177e4SLinus Torvalds return -EACCES; 3511da177e4SLinus Torvalds return hci_dev_cmd(cmd, argp); 3521da177e4SLinus Torvalds 3531da177e4SLinus Torvalds case HCIINQUIRY: 3541da177e4SLinus Torvalds return hci_inquiry(argp); 3551da177e4SLinus Torvalds 3561da177e4SLinus Torvalds default: 3571da177e4SLinus Torvalds lock_sock(sk); 3581da177e4SLinus Torvalds err = hci_sock_bound_ioctl(sk, cmd, arg); 3591da177e4SLinus Torvalds release_sock(sk); 3601da177e4SLinus Torvalds return err; 3611da177e4SLinus Torvalds } 3621da177e4SLinus Torvalds } 3631da177e4SLinus Torvalds 3641da177e4SLinus Torvalds static int hci_sock_bind(struct socket *sock, struct sockaddr *addr, int addr_len) 3651da177e4SLinus Torvalds { 3660381101fSJohan Hedberg struct sockaddr_hci haddr; 3671da177e4SLinus Torvalds struct sock *sk = sock->sk; 3681da177e4SLinus Torvalds struct hci_dev *hdev = NULL; 3690381101fSJohan Hedberg int len, err = 0; 3701da177e4SLinus Torvalds 3711da177e4SLinus Torvalds BT_DBG("sock %p sk %p", sock, sk); 3721da177e4SLinus Torvalds 3730381101fSJohan Hedberg if (!addr) 3740381101fSJohan Hedberg return -EINVAL; 3750381101fSJohan Hedberg 3760381101fSJohan Hedberg memset(&haddr, 0, sizeof(haddr)); 3770381101fSJohan Hedberg len = min_t(unsigned int, sizeof(haddr), addr_len); 3780381101fSJohan Hedberg memcpy(&haddr, addr, len); 3790381101fSJohan Hedberg 3800381101fSJohan Hedberg if (haddr.hci_family != AF_BLUETOOTH) 3810381101fSJohan Hedberg return -EINVAL; 3820381101fSJohan Hedberg 383*17f9cc31SGustavo F. Padovan if (haddr.hci_channel > HCI_CHANNEL_CONTROL) 384*17f9cc31SGustavo F. Padovan return -EINVAL; 385*17f9cc31SGustavo F. Padovan 386*17f9cc31SGustavo F. Padovan if (haddr.hci_channel == HCI_CHANNEL_CONTROL && !enable_mgmt) 3871da177e4SLinus Torvalds return -EINVAL; 3881da177e4SLinus Torvalds 3891da177e4SLinus Torvalds lock_sock(sk); 3901da177e4SLinus Torvalds 3910381101fSJohan Hedberg if (sk->sk_state == BT_BOUND || hci_pi(sk)->hdev) { 3921da177e4SLinus Torvalds err = -EALREADY; 3931da177e4SLinus Torvalds goto done; 3941da177e4SLinus Torvalds } 3951da177e4SLinus Torvalds 3960381101fSJohan Hedberg if (haddr.hci_dev != HCI_DEV_NONE) { 3970381101fSJohan Hedberg hdev = hci_dev_get(haddr.hci_dev); 39870f23020SAndrei Emeltchenko if (!hdev) { 3991da177e4SLinus Torvalds err = -ENODEV; 4001da177e4SLinus Torvalds goto done; 4011da177e4SLinus Torvalds } 4021da177e4SLinus Torvalds 4031da177e4SLinus Torvalds atomic_inc(&hdev->promisc); 4041da177e4SLinus Torvalds } 4051da177e4SLinus Torvalds 4060381101fSJohan Hedberg hci_pi(sk)->channel = haddr.hci_channel; 4071da177e4SLinus Torvalds hci_pi(sk)->hdev = hdev; 4081da177e4SLinus Torvalds sk->sk_state = BT_BOUND; 4091da177e4SLinus Torvalds 4101da177e4SLinus Torvalds done: 4111da177e4SLinus Torvalds release_sock(sk); 4121da177e4SLinus Torvalds return err; 4131da177e4SLinus Torvalds } 4141da177e4SLinus Torvalds 4151da177e4SLinus Torvalds static int hci_sock_getname(struct socket *sock, struct sockaddr *addr, int *addr_len, int peer) 4161da177e4SLinus Torvalds { 4171da177e4SLinus Torvalds struct sockaddr_hci *haddr = (struct sockaddr_hci *) addr; 4181da177e4SLinus Torvalds struct sock *sk = sock->sk; 4197b005bd3SMarcel Holtmann struct hci_dev *hdev = hci_pi(sk)->hdev; 4201da177e4SLinus Torvalds 4211da177e4SLinus Torvalds BT_DBG("sock %p sk %p", sock, sk); 4221da177e4SLinus Torvalds 4237b005bd3SMarcel Holtmann if (!hdev) 4247b005bd3SMarcel Holtmann return -EBADFD; 4257b005bd3SMarcel Holtmann 4261da177e4SLinus Torvalds lock_sock(sk); 4271da177e4SLinus Torvalds 4281da177e4SLinus Torvalds *addr_len = sizeof(*haddr); 4291da177e4SLinus Torvalds haddr->hci_family = AF_BLUETOOTH; 4307b005bd3SMarcel Holtmann haddr->hci_dev = hdev->id; 4311da177e4SLinus Torvalds 4321da177e4SLinus Torvalds release_sock(sk); 4331da177e4SLinus Torvalds return 0; 4341da177e4SLinus Torvalds } 4351da177e4SLinus Torvalds 4361da177e4SLinus Torvalds static inline void hci_sock_cmsg(struct sock *sk, struct msghdr *msg, struct sk_buff *skb) 4371da177e4SLinus Torvalds { 4381da177e4SLinus Torvalds __u32 mask = hci_pi(sk)->cmsg_mask; 4391da177e4SLinus Torvalds 4400d48d939SMarcel Holtmann if (mask & HCI_CMSG_DIR) { 4410d48d939SMarcel Holtmann int incoming = bt_cb(skb)->incoming; 4420d48d939SMarcel Holtmann put_cmsg(msg, SOL_HCI, HCI_CMSG_DIR, sizeof(incoming), &incoming); 4430d48d939SMarcel Holtmann } 4441da177e4SLinus Torvalds 445a61bbcf2SPatrick McHardy if (mask & HCI_CMSG_TSTAMP) { 446f6e623a6SJohann Felix Soden #ifdef CONFIG_COMPAT 447f6e623a6SJohann Felix Soden struct compat_timeval ctv; 448f6e623a6SJohann Felix Soden #endif 449a61bbcf2SPatrick McHardy struct timeval tv; 450767c5eb5SMarcel Holtmann void *data; 451767c5eb5SMarcel Holtmann int len; 452a61bbcf2SPatrick McHardy 453a61bbcf2SPatrick McHardy skb_get_timestamp(skb, &tv); 454767c5eb5SMarcel Holtmann 4551da97f83SDavid S. Miller data = &tv; 4561da97f83SDavid S. Miller len = sizeof(tv); 4571da97f83SDavid S. Miller #ifdef CONFIG_COMPAT 458767c5eb5SMarcel Holtmann if (msg->msg_flags & MSG_CMSG_COMPAT) { 459767c5eb5SMarcel Holtmann ctv.tv_sec = tv.tv_sec; 460767c5eb5SMarcel Holtmann ctv.tv_usec = tv.tv_usec; 461767c5eb5SMarcel Holtmann data = &ctv; 462767c5eb5SMarcel Holtmann len = sizeof(ctv); 463767c5eb5SMarcel Holtmann } 4641da97f83SDavid S. Miller #endif 465767c5eb5SMarcel Holtmann 466767c5eb5SMarcel Holtmann put_cmsg(msg, SOL_HCI, HCI_CMSG_TSTAMP, len, data); 467a61bbcf2SPatrick McHardy } 4681da177e4SLinus Torvalds } 4691da177e4SLinus Torvalds 4701da177e4SLinus Torvalds static int hci_sock_recvmsg(struct kiocb *iocb, struct socket *sock, 4711da177e4SLinus Torvalds struct msghdr *msg, size_t len, int flags) 4721da177e4SLinus Torvalds { 4731da177e4SLinus Torvalds int noblock = flags & MSG_DONTWAIT; 4741da177e4SLinus Torvalds struct sock *sk = sock->sk; 4751da177e4SLinus Torvalds struct sk_buff *skb; 4761da177e4SLinus Torvalds int copied, err; 4771da177e4SLinus Torvalds 4781da177e4SLinus Torvalds BT_DBG("sock %p, sk %p", sock, sk); 4791da177e4SLinus Torvalds 4801da177e4SLinus Torvalds if (flags & (MSG_OOB)) 4811da177e4SLinus Torvalds return -EOPNOTSUPP; 4821da177e4SLinus Torvalds 4831da177e4SLinus Torvalds if (sk->sk_state == BT_CLOSED) 4841da177e4SLinus Torvalds return 0; 4851da177e4SLinus Torvalds 48670f23020SAndrei Emeltchenko skb = skb_recv_datagram(sk, flags, noblock, &err); 48770f23020SAndrei Emeltchenko if (!skb) 4881da177e4SLinus Torvalds return err; 4891da177e4SLinus Torvalds 4901da177e4SLinus Torvalds msg->msg_namelen = 0; 4911da177e4SLinus Torvalds 4921da177e4SLinus Torvalds copied = skb->len; 4931da177e4SLinus Torvalds if (len < copied) { 4941da177e4SLinus Torvalds msg->msg_flags |= MSG_TRUNC; 4951da177e4SLinus Torvalds copied = len; 4961da177e4SLinus Torvalds } 4971da177e4SLinus Torvalds 498badff6d0SArnaldo Carvalho de Melo skb_reset_transport_header(skb); 4991da177e4SLinus Torvalds err = skb_copy_datagram_iovec(skb, 0, msg->msg_iov, copied); 5001da177e4SLinus Torvalds 5011da177e4SLinus Torvalds hci_sock_cmsg(sk, msg, skb); 5021da177e4SLinus Torvalds 5031da177e4SLinus Torvalds skb_free_datagram(sk, skb); 5041da177e4SLinus Torvalds 5051da177e4SLinus Torvalds return err ? : copied; 5061da177e4SLinus Torvalds } 5071da177e4SLinus Torvalds 5081da177e4SLinus Torvalds static int hci_sock_sendmsg(struct kiocb *iocb, struct socket *sock, 5091da177e4SLinus Torvalds struct msghdr *msg, size_t len) 5101da177e4SLinus Torvalds { 5111da177e4SLinus Torvalds struct sock *sk = sock->sk; 5121da177e4SLinus Torvalds struct hci_dev *hdev; 5131da177e4SLinus Torvalds struct sk_buff *skb; 5141da177e4SLinus Torvalds int err; 5151da177e4SLinus Torvalds 5161da177e4SLinus Torvalds BT_DBG("sock %p sk %p", sock, sk); 5171da177e4SLinus Torvalds 5181da177e4SLinus Torvalds if (msg->msg_flags & MSG_OOB) 5191da177e4SLinus Torvalds return -EOPNOTSUPP; 5201da177e4SLinus Torvalds 5211da177e4SLinus Torvalds if (msg->msg_flags & ~(MSG_DONTWAIT|MSG_NOSIGNAL|MSG_ERRQUEUE)) 5221da177e4SLinus Torvalds return -EINVAL; 5231da177e4SLinus Torvalds 5241da177e4SLinus Torvalds if (len < 4 || len > HCI_MAX_FRAME_SIZE) 5251da177e4SLinus Torvalds return -EINVAL; 5261da177e4SLinus Torvalds 5271da177e4SLinus Torvalds lock_sock(sk); 5281da177e4SLinus Torvalds 5290381101fSJohan Hedberg switch (hci_pi(sk)->channel) { 5300381101fSJohan Hedberg case HCI_CHANNEL_RAW: 5310381101fSJohan Hedberg break; 5320381101fSJohan Hedberg case HCI_CHANNEL_CONTROL: 5330381101fSJohan Hedberg err = mgmt_control(sk, msg, len); 5340381101fSJohan Hedberg goto done; 5350381101fSJohan Hedberg default: 5360381101fSJohan Hedberg err = -EINVAL; 5370381101fSJohan Hedberg goto done; 5380381101fSJohan Hedberg } 5390381101fSJohan Hedberg 54070f23020SAndrei Emeltchenko hdev = hci_pi(sk)->hdev; 54170f23020SAndrei Emeltchenko if (!hdev) { 5421da177e4SLinus Torvalds err = -EBADFD; 5431da177e4SLinus Torvalds goto done; 5441da177e4SLinus Torvalds } 5451da177e4SLinus Torvalds 5467e21addcSMarcel Holtmann if (!test_bit(HCI_UP, &hdev->flags)) { 5477e21addcSMarcel Holtmann err = -ENETDOWN; 5487e21addcSMarcel Holtmann goto done; 5497e21addcSMarcel Holtmann } 5507e21addcSMarcel Holtmann 55170f23020SAndrei Emeltchenko skb = bt_skb_send_alloc(sk, len, msg->msg_flags & MSG_DONTWAIT, &err); 55270f23020SAndrei Emeltchenko if (!skb) 5531da177e4SLinus Torvalds goto done; 5541da177e4SLinus Torvalds 5551da177e4SLinus Torvalds if (memcpy_fromiovec(skb_put(skb, len), msg->msg_iov, len)) { 5561da177e4SLinus Torvalds err = -EFAULT; 5571da177e4SLinus Torvalds goto drop; 5581da177e4SLinus Torvalds } 5591da177e4SLinus Torvalds 5600d48d939SMarcel Holtmann bt_cb(skb)->pkt_type = *((unsigned char *) skb->data); 5611da177e4SLinus Torvalds skb_pull(skb, 1); 5621da177e4SLinus Torvalds skb->dev = (void *) hdev; 5631da177e4SLinus Torvalds 5640d48d939SMarcel Holtmann if (bt_cb(skb)->pkt_type == HCI_COMMAND_PKT) { 56583985319SHarvey Harrison u16 opcode = get_unaligned_le16(skb->data); 5661da177e4SLinus Torvalds u16 ogf = hci_opcode_ogf(opcode); 5671da177e4SLinus Torvalds u16 ocf = hci_opcode_ocf(opcode); 5681da177e4SLinus Torvalds 5691da177e4SLinus Torvalds if (((ogf > HCI_SFLT_MAX_OGF) || 5701da177e4SLinus Torvalds !hci_test_bit(ocf & HCI_FLT_OCF_BITS, &hci_sec_filter.ocf_mask[ogf])) && 5711da177e4SLinus Torvalds !capable(CAP_NET_RAW)) { 5721da177e4SLinus Torvalds err = -EPERM; 5731da177e4SLinus Torvalds goto drop; 5741da177e4SLinus Torvalds } 5751da177e4SLinus Torvalds 576a9de9248SMarcel Holtmann if (test_bit(HCI_RAW, &hdev->flags) || (ogf == 0x3f)) { 5771da177e4SLinus Torvalds skb_queue_tail(&hdev->raw_q, skb); 578c78ae283SMarcel Holtmann tasklet_schedule(&hdev->tx_task); 5791da177e4SLinus Torvalds } else { 5801da177e4SLinus Torvalds skb_queue_tail(&hdev->cmd_q, skb); 581c78ae283SMarcel Holtmann tasklet_schedule(&hdev->cmd_task); 5821da177e4SLinus Torvalds } 5831da177e4SLinus Torvalds } else { 5841da177e4SLinus Torvalds if (!capable(CAP_NET_RAW)) { 5851da177e4SLinus Torvalds err = -EPERM; 5861da177e4SLinus Torvalds goto drop; 5871da177e4SLinus Torvalds } 5881da177e4SLinus Torvalds 5891da177e4SLinus Torvalds skb_queue_tail(&hdev->raw_q, skb); 590c78ae283SMarcel Holtmann tasklet_schedule(&hdev->tx_task); 5911da177e4SLinus Torvalds } 5921da177e4SLinus Torvalds 5931da177e4SLinus Torvalds err = len; 5941da177e4SLinus Torvalds 5951da177e4SLinus Torvalds done: 5961da177e4SLinus Torvalds release_sock(sk); 5971da177e4SLinus Torvalds return err; 5981da177e4SLinus Torvalds 5991da177e4SLinus Torvalds drop: 6001da177e4SLinus Torvalds kfree_skb(skb); 6011da177e4SLinus Torvalds goto done; 6021da177e4SLinus Torvalds } 6031da177e4SLinus Torvalds 604b7058842SDavid S. Miller static int hci_sock_setsockopt(struct socket *sock, int level, int optname, char __user *optval, unsigned int len) 6051da177e4SLinus Torvalds { 6061da177e4SLinus Torvalds struct hci_ufilter uf = { .opcode = 0 }; 6071da177e4SLinus Torvalds struct sock *sk = sock->sk; 6081da177e4SLinus Torvalds int err = 0, opt = 0; 6091da177e4SLinus Torvalds 6101da177e4SLinus Torvalds BT_DBG("sk %p, opt %d", sk, optname); 6111da177e4SLinus Torvalds 6121da177e4SLinus Torvalds lock_sock(sk); 6131da177e4SLinus Torvalds 6141da177e4SLinus Torvalds switch (optname) { 6151da177e4SLinus Torvalds case HCI_DATA_DIR: 6161da177e4SLinus Torvalds if (get_user(opt, (int __user *)optval)) { 6171da177e4SLinus Torvalds err = -EFAULT; 6181da177e4SLinus Torvalds break; 6191da177e4SLinus Torvalds } 6201da177e4SLinus Torvalds 6211da177e4SLinus Torvalds if (opt) 6221da177e4SLinus Torvalds hci_pi(sk)->cmsg_mask |= HCI_CMSG_DIR; 6231da177e4SLinus Torvalds else 6241da177e4SLinus Torvalds hci_pi(sk)->cmsg_mask &= ~HCI_CMSG_DIR; 6251da177e4SLinus Torvalds break; 6261da177e4SLinus Torvalds 6271da177e4SLinus Torvalds case HCI_TIME_STAMP: 6281da177e4SLinus Torvalds if (get_user(opt, (int __user *)optval)) { 6291da177e4SLinus Torvalds err = -EFAULT; 6301da177e4SLinus Torvalds break; 6311da177e4SLinus Torvalds } 6321da177e4SLinus Torvalds 6331da177e4SLinus Torvalds if (opt) 6341da177e4SLinus Torvalds hci_pi(sk)->cmsg_mask |= HCI_CMSG_TSTAMP; 6351da177e4SLinus Torvalds else 6361da177e4SLinus Torvalds hci_pi(sk)->cmsg_mask &= ~HCI_CMSG_TSTAMP; 6371da177e4SLinus Torvalds break; 6381da177e4SLinus Torvalds 6391da177e4SLinus Torvalds case HCI_FILTER: 6400878b666SMarcel Holtmann { 6410878b666SMarcel Holtmann struct hci_filter *f = &hci_pi(sk)->filter; 6420878b666SMarcel Holtmann 6430878b666SMarcel Holtmann uf.type_mask = f->type_mask; 6440878b666SMarcel Holtmann uf.opcode = f->opcode; 6450878b666SMarcel Holtmann uf.event_mask[0] = *((u32 *) f->event_mask + 0); 6460878b666SMarcel Holtmann uf.event_mask[1] = *((u32 *) f->event_mask + 1); 6470878b666SMarcel Holtmann } 6480878b666SMarcel Holtmann 6491da177e4SLinus Torvalds len = min_t(unsigned int, len, sizeof(uf)); 6501da177e4SLinus Torvalds if (copy_from_user(&uf, optval, len)) { 6511da177e4SLinus Torvalds err = -EFAULT; 6521da177e4SLinus Torvalds break; 6531da177e4SLinus Torvalds } 6541da177e4SLinus Torvalds 6551da177e4SLinus Torvalds if (!capable(CAP_NET_RAW)) { 6561da177e4SLinus Torvalds uf.type_mask &= hci_sec_filter.type_mask; 6571da177e4SLinus Torvalds uf.event_mask[0] &= *((u32 *) hci_sec_filter.event_mask + 0); 6581da177e4SLinus Torvalds uf.event_mask[1] &= *((u32 *) hci_sec_filter.event_mask + 1); 6591da177e4SLinus Torvalds } 6601da177e4SLinus Torvalds 6611da177e4SLinus Torvalds { 6621da177e4SLinus Torvalds struct hci_filter *f = &hci_pi(sk)->filter; 6631da177e4SLinus Torvalds 6641da177e4SLinus Torvalds f->type_mask = uf.type_mask; 6651da177e4SLinus Torvalds f->opcode = uf.opcode; 6661da177e4SLinus Torvalds *((u32 *) f->event_mask + 0) = uf.event_mask[0]; 6671da177e4SLinus Torvalds *((u32 *) f->event_mask + 1) = uf.event_mask[1]; 6681da177e4SLinus Torvalds } 6691da177e4SLinus Torvalds break; 6701da177e4SLinus Torvalds 6711da177e4SLinus Torvalds default: 6721da177e4SLinus Torvalds err = -ENOPROTOOPT; 6731da177e4SLinus Torvalds break; 6741da177e4SLinus Torvalds } 6751da177e4SLinus Torvalds 6761da177e4SLinus Torvalds release_sock(sk); 6771da177e4SLinus Torvalds return err; 6781da177e4SLinus Torvalds } 6791da177e4SLinus Torvalds 6801da177e4SLinus Torvalds static int hci_sock_getsockopt(struct socket *sock, int level, int optname, char __user *optval, int __user *optlen) 6811da177e4SLinus Torvalds { 6821da177e4SLinus Torvalds struct hci_ufilter uf; 6831da177e4SLinus Torvalds struct sock *sk = sock->sk; 6841da177e4SLinus Torvalds int len, opt; 6851da177e4SLinus Torvalds 6861da177e4SLinus Torvalds if (get_user(len, optlen)) 6871da177e4SLinus Torvalds return -EFAULT; 6881da177e4SLinus Torvalds 6891da177e4SLinus Torvalds switch (optname) { 6901da177e4SLinus Torvalds case HCI_DATA_DIR: 6911da177e4SLinus Torvalds if (hci_pi(sk)->cmsg_mask & HCI_CMSG_DIR) 6921da177e4SLinus Torvalds opt = 1; 6931da177e4SLinus Torvalds else 6941da177e4SLinus Torvalds opt = 0; 6951da177e4SLinus Torvalds 6961da177e4SLinus Torvalds if (put_user(opt, optval)) 6971da177e4SLinus Torvalds return -EFAULT; 6981da177e4SLinus Torvalds break; 6991da177e4SLinus Torvalds 7001da177e4SLinus Torvalds case HCI_TIME_STAMP: 7011da177e4SLinus Torvalds if (hci_pi(sk)->cmsg_mask & HCI_CMSG_TSTAMP) 7021da177e4SLinus Torvalds opt = 1; 7031da177e4SLinus Torvalds else 7041da177e4SLinus Torvalds opt = 0; 7051da177e4SLinus Torvalds 7061da177e4SLinus Torvalds if (put_user(opt, optval)) 7071da177e4SLinus Torvalds return -EFAULT; 7081da177e4SLinus Torvalds break; 7091da177e4SLinus Torvalds 7101da177e4SLinus Torvalds case HCI_FILTER: 7111da177e4SLinus Torvalds { 7121da177e4SLinus Torvalds struct hci_filter *f = &hci_pi(sk)->filter; 7131da177e4SLinus Torvalds 7141da177e4SLinus Torvalds uf.type_mask = f->type_mask; 7151da177e4SLinus Torvalds uf.opcode = f->opcode; 7161da177e4SLinus Torvalds uf.event_mask[0] = *((u32 *) f->event_mask + 0); 7171da177e4SLinus Torvalds uf.event_mask[1] = *((u32 *) f->event_mask + 1); 7181da177e4SLinus Torvalds } 7191da177e4SLinus Torvalds 7201da177e4SLinus Torvalds len = min_t(unsigned int, len, sizeof(uf)); 7211da177e4SLinus Torvalds if (copy_to_user(optval, &uf, len)) 7221da177e4SLinus Torvalds return -EFAULT; 7231da177e4SLinus Torvalds break; 7241da177e4SLinus Torvalds 7251da177e4SLinus Torvalds default: 7261da177e4SLinus Torvalds return -ENOPROTOOPT; 7271da177e4SLinus Torvalds break; 7281da177e4SLinus Torvalds } 7291da177e4SLinus Torvalds 7301da177e4SLinus Torvalds return 0; 7311da177e4SLinus Torvalds } 7321da177e4SLinus Torvalds 73390ddc4f0SEric Dumazet static const struct proto_ops hci_sock_ops = { 7341da177e4SLinus Torvalds .family = PF_BLUETOOTH, 7351da177e4SLinus Torvalds .owner = THIS_MODULE, 7361da177e4SLinus Torvalds .release = hci_sock_release, 7371da177e4SLinus Torvalds .bind = hci_sock_bind, 7381da177e4SLinus Torvalds .getname = hci_sock_getname, 7391da177e4SLinus Torvalds .sendmsg = hci_sock_sendmsg, 7401da177e4SLinus Torvalds .recvmsg = hci_sock_recvmsg, 7411da177e4SLinus Torvalds .ioctl = hci_sock_ioctl, 7421da177e4SLinus Torvalds .poll = datagram_poll, 7431da177e4SLinus Torvalds .listen = sock_no_listen, 7441da177e4SLinus Torvalds .shutdown = sock_no_shutdown, 7451da177e4SLinus Torvalds .setsockopt = hci_sock_setsockopt, 7461da177e4SLinus Torvalds .getsockopt = hci_sock_getsockopt, 7471da177e4SLinus Torvalds .connect = sock_no_connect, 7481da177e4SLinus Torvalds .socketpair = sock_no_socketpair, 7491da177e4SLinus Torvalds .accept = sock_no_accept, 7501da177e4SLinus Torvalds .mmap = sock_no_mmap 7511da177e4SLinus Torvalds }; 7521da177e4SLinus Torvalds 7531da177e4SLinus Torvalds static struct proto hci_sk_proto = { 7541da177e4SLinus Torvalds .name = "HCI", 7551da177e4SLinus Torvalds .owner = THIS_MODULE, 7561da177e4SLinus Torvalds .obj_size = sizeof(struct hci_pinfo) 7571da177e4SLinus Torvalds }; 7581da177e4SLinus Torvalds 7593f378b68SEric Paris static int hci_sock_create(struct net *net, struct socket *sock, int protocol, 7603f378b68SEric Paris int kern) 7611da177e4SLinus Torvalds { 7621da177e4SLinus Torvalds struct sock *sk; 7631da177e4SLinus Torvalds 7641da177e4SLinus Torvalds BT_DBG("sock %p", sock); 7651da177e4SLinus Torvalds 7661da177e4SLinus Torvalds if (sock->type != SOCK_RAW) 7671da177e4SLinus Torvalds return -ESOCKTNOSUPPORT; 7681da177e4SLinus Torvalds 7691da177e4SLinus Torvalds sock->ops = &hci_sock_ops; 7701da177e4SLinus Torvalds 7716257ff21SPavel Emelyanov sk = sk_alloc(net, PF_BLUETOOTH, GFP_ATOMIC, &hci_sk_proto); 7721da177e4SLinus Torvalds if (!sk) 7731da177e4SLinus Torvalds return -ENOMEM; 7741da177e4SLinus Torvalds 7751da177e4SLinus Torvalds sock_init_data(sock, sk); 7761da177e4SLinus Torvalds 7771da177e4SLinus Torvalds sock_reset_flag(sk, SOCK_ZAPPED); 7781da177e4SLinus Torvalds 7791da177e4SLinus Torvalds sk->sk_protocol = protocol; 7801da177e4SLinus Torvalds 7811da177e4SLinus Torvalds sock->state = SS_UNCONNECTED; 7821da177e4SLinus Torvalds sk->sk_state = BT_OPEN; 7831da177e4SLinus Torvalds 7841da177e4SLinus Torvalds bt_sock_link(&hci_sk_list, sk); 7851da177e4SLinus Torvalds return 0; 7861da177e4SLinus Torvalds } 7871da177e4SLinus Torvalds 7881da177e4SLinus Torvalds static int hci_sock_dev_event(struct notifier_block *this, unsigned long event, void *ptr) 7891da177e4SLinus Torvalds { 7901da177e4SLinus Torvalds struct hci_dev *hdev = (struct hci_dev *) ptr; 7911da177e4SLinus Torvalds struct hci_ev_si_device ev; 7921da177e4SLinus Torvalds 7931da177e4SLinus Torvalds BT_DBG("hdev %s event %ld", hdev->name, event); 7941da177e4SLinus Torvalds 7951da177e4SLinus Torvalds /* Send event to sockets */ 7961da177e4SLinus Torvalds ev.event = event; 7971da177e4SLinus Torvalds ev.dev_id = hdev->id; 7981da177e4SLinus Torvalds hci_si_event(NULL, HCI_EV_SI_DEVICE, sizeof(ev), &ev); 7991da177e4SLinus Torvalds 8001da177e4SLinus Torvalds if (event == HCI_DEV_UNREG) { 8011da177e4SLinus Torvalds struct sock *sk; 8021da177e4SLinus Torvalds struct hlist_node *node; 8031da177e4SLinus Torvalds 8041da177e4SLinus Torvalds /* Detach sockets from device */ 8051da177e4SLinus Torvalds read_lock(&hci_sk_list.lock); 8061da177e4SLinus Torvalds sk_for_each(sk, node, &hci_sk_list.head) { 8074ce61d1cSSatyam Sharma local_bh_disable(); 8084ce61d1cSSatyam Sharma bh_lock_sock_nested(sk); 8091da177e4SLinus Torvalds if (hci_pi(sk)->hdev == hdev) { 8101da177e4SLinus Torvalds hci_pi(sk)->hdev = NULL; 8111da177e4SLinus Torvalds sk->sk_err = EPIPE; 8121da177e4SLinus Torvalds sk->sk_state = BT_OPEN; 8131da177e4SLinus Torvalds sk->sk_state_change(sk); 8141da177e4SLinus Torvalds 8151da177e4SLinus Torvalds hci_dev_put(hdev); 8161da177e4SLinus Torvalds } 8174ce61d1cSSatyam Sharma bh_unlock_sock(sk); 8184ce61d1cSSatyam Sharma local_bh_enable(); 8191da177e4SLinus Torvalds } 8201da177e4SLinus Torvalds read_unlock(&hci_sk_list.lock); 8211da177e4SLinus Torvalds } 8221da177e4SLinus Torvalds 8231da177e4SLinus Torvalds return NOTIFY_DONE; 8241da177e4SLinus Torvalds } 8251da177e4SLinus Torvalds 826ec1b4cf7SStephen Hemminger static const struct net_proto_family hci_sock_family_ops = { 8271da177e4SLinus Torvalds .family = PF_BLUETOOTH, 8281da177e4SLinus Torvalds .owner = THIS_MODULE, 8291da177e4SLinus Torvalds .create = hci_sock_create, 8301da177e4SLinus Torvalds }; 8311da177e4SLinus Torvalds 8321da177e4SLinus Torvalds static struct notifier_block hci_sock_nblock = { 8331da177e4SLinus Torvalds .notifier_call = hci_sock_dev_event 8341da177e4SLinus Torvalds }; 8351da177e4SLinus Torvalds 8361da177e4SLinus Torvalds int __init hci_sock_init(void) 8371da177e4SLinus Torvalds { 8381da177e4SLinus Torvalds int err; 8391da177e4SLinus Torvalds 8401da177e4SLinus Torvalds err = proto_register(&hci_sk_proto, 0); 8411da177e4SLinus Torvalds if (err < 0) 8421da177e4SLinus Torvalds return err; 8431da177e4SLinus Torvalds 8441da177e4SLinus Torvalds err = bt_sock_register(BTPROTO_HCI, &hci_sock_family_ops); 8451da177e4SLinus Torvalds if (err < 0) 8461da177e4SLinus Torvalds goto error; 8471da177e4SLinus Torvalds 8481da177e4SLinus Torvalds hci_register_notifier(&hci_sock_nblock); 8491da177e4SLinus Torvalds 8501da177e4SLinus Torvalds BT_INFO("HCI socket layer initialized"); 8511da177e4SLinus Torvalds 8521da177e4SLinus Torvalds return 0; 8531da177e4SLinus Torvalds 8541da177e4SLinus Torvalds error: 8551da177e4SLinus Torvalds BT_ERR("HCI socket registration failed"); 8561da177e4SLinus Torvalds proto_unregister(&hci_sk_proto); 8571da177e4SLinus Torvalds return err; 8581da177e4SLinus Torvalds } 8591da177e4SLinus Torvalds 86004005dd9STobias Klauser void __exit hci_sock_cleanup(void) 8611da177e4SLinus Torvalds { 8621da177e4SLinus Torvalds if (bt_sock_unregister(BTPROTO_HCI) < 0) 8631da177e4SLinus Torvalds BT_ERR("HCI socket unregistration failed"); 8641da177e4SLinus Torvalds 8651da177e4SLinus Torvalds hci_unregister_notifier(&hci_sock_nblock); 8661da177e4SLinus Torvalds 8671da177e4SLinus Torvalds proto_unregister(&hci_sk_proto); 8681da177e4SLinus Torvalds } 8690381101fSJohan Hedberg 8700381101fSJohan Hedberg module_param(enable_mgmt, bool, 0644); 8710381101fSJohan Hedberg MODULE_PARM_DESC(enable_mgmt, "Enable Management interface"); 872