net/bluetooth/af_bluetooth.c

   1 /*
   2    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
  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.
  19
  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.
  23 */
  24
  25 /* Bluetooth address family and sockets. */
  26
  27 #include <linux/module.h>
  28 #include <linux/debugfs.h>
  29 #include <linux/stringify.h>
  30 #include <linux/sched/signal.h>
  31
  32 #include <asm/ioctls.h>
  33
  34 #include <net/bluetooth/bluetooth.h>
  35 #include <linux/proc_fs.h>
  36
  37 #include "leds.h"
  38 #include "selftest.h"
  39
  40 /* Bluetooth sockets */
  41 #define BT_MAX_PROTO    (BTPROTO_LAST + 1)
  42 static const struct net_proto_family *bt_proto[BT_MAX_PROTO];
  43 static DEFINE_RWLOCK(bt_proto_lock);
  44
  45 static struct lock_class_key bt_lock_key[BT_MAX_PROTO];
  46 static const char *const bt_key_strings[BT_MAX_PROTO] = {
  47         "sk_lock-AF_BLUETOOTH-BTPROTO_L2CAP",
  48         "sk_lock-AF_BLUETOOTH-BTPROTO_HCI",
  49         "sk_lock-AF_BLUETOOTH-BTPROTO_SCO",
  50         "sk_lock-AF_BLUETOOTH-BTPROTO_RFCOMM",
  51         "sk_lock-AF_BLUETOOTH-BTPROTO_BNEP",
  52         "sk_lock-AF_BLUETOOTH-BTPROTO_CMTP",
  53         "sk_lock-AF_BLUETOOTH-BTPROTO_HIDP",
  54         "sk_lock-AF_BLUETOOTH-BTPROTO_AVDTP",
  55         "sk_lock-AF_BLUETOOTH-BTPROTO_ISO",
  56 };
  57
  58 static struct lock_class_key bt_slock_key[BT_MAX_PROTO];
  59 static const char *const bt_slock_key_strings[BT_MAX_PROTO] = {
  60         "slock-AF_BLUETOOTH-BTPROTO_L2CAP",
  61         "slock-AF_BLUETOOTH-BTPROTO_HCI",
  62         "slock-AF_BLUETOOTH-BTPROTO_SCO",
  63         "slock-AF_BLUETOOTH-BTPROTO_RFCOMM",
  64         "slock-AF_BLUETOOTH-BTPROTO_BNEP",
  65         "slock-AF_BLUETOOTH-BTPROTO_CMTP",
  66         "slock-AF_BLUETOOTH-BTPROTO_HIDP",
  67         "slock-AF_BLUETOOTH-BTPROTO_AVDTP",
  68         "slock-AF_BLUETOOTH-BTPROTO_ISO",
  69 };
  70
  71 void bt_sock_reclassify_lock(struct sock *sk, int proto)
  72 {
  73         BUG_ON(!sk);
  74         BUG_ON(!sock_allow_reclassification(sk));
  75
  76         sock_lock_init_class_and_name(sk,
  77                                       bt_slock_key_strings[proto], &bt_slock_key[proto],
  78                                       bt_key_strings[proto], &bt_lock_key[proto]);
  79 }
  80 EXPORT_SYMBOL(bt_sock_reclassify_lock);
  81
  82 int bt_sock_register(int proto, const struct net_proto_family *ops)
  83 {
  84         int err = 0;
  85
  86         if (proto < 0 || proto >= BT_MAX_PROTO)
  87                 return -EINVAL;
  88
  89         write_lock(&bt_proto_lock);
  90
  91         if (bt_proto[proto])
  92                 err = -EEXIST;
  93         else
  94                 bt_proto[proto] = ops;
  95
  96         write_unlock(&bt_proto_lock);
  97
  98         return err;
  99 }
 100 EXPORT_SYMBOL(bt_sock_register);
 101
 102 void bt_sock_unregister(int proto)
 103 {
 104         if (proto < 0 || proto >= BT_MAX_PROTO)
 105                 return;
 106
 107         write_lock(&bt_proto_lock);
 108         bt_proto[proto] = NULL;
 109         write_unlock(&bt_proto_lock);
 110 }
 111 EXPORT_SYMBOL(bt_sock_unregister);
 112
 113 static int bt_sock_create(struct net *net, struct socket *sock, int proto,
 114                           int kern)
 115 {
 116         int err;
 117
 118         if (net != &init_net)
 119                 return -EAFNOSUPPORT;
 120
 121         if (proto < 0 || proto >= BT_MAX_PROTO)
 122                 return -EINVAL;
 123
 124         if (!bt_proto[proto])
 125                 request_module("bt-proto-%d", proto);
 126
 127         err = -EPROTONOSUPPORT;
 128
 129         read_lock(&bt_proto_lock);
 130
 131         if (bt_proto[proto] && try_module_get(bt_proto[proto]->owner)) {
 132                 err = bt_proto[proto]->create(net, sock, proto, kern);
 133                 if (!err)
 134                         bt_sock_reclassify_lock(sock->sk, proto);
 135                 module_put(bt_proto[proto]->owner);
 136         }
 137
 138         read_unlock(&bt_proto_lock);
 139
 140         return err;
 141 }
 142
 143 struct sock *bt_sock_alloc(struct net *net, struct socket *sock,
 144                            struct proto *prot, int proto, gfp_t prio, int kern)
 145 {
 146         struct sock *sk;
 147
 148         sk = sk_alloc(net, PF_BLUETOOTH, prio, prot, kern);
 149         if (!sk)
 150                 return NULL;
 151
 152         sock_init_data(sock, sk);
 153         INIT_LIST_HEAD(&bt_sk(sk)->accept_q);
 154
 155         sock_reset_flag(sk, SOCK_ZAPPED);
 156
 157         sk->sk_protocol = proto;
 158         sk->sk_state    = BT_OPEN;
 159
 160         /* Init peer information so it can be properly monitored */
 161         if (!kern) {
 162                 spin_lock(&sk->sk_peer_lock);
 163                 sk->sk_peer_pid  = get_pid(task_tgid(current));
 164                 sk->sk_peer_cred = get_current_cred();
 165                 spin_unlock(&sk->sk_peer_lock);
 166         }
 167
 168         return sk;
 169 }
 170 EXPORT_SYMBOL(bt_sock_alloc);
 171
 172 void bt_sock_link(struct bt_sock_list *l, struct sock *sk)
 173 {
 174         write_lock(&l->lock);
 175         sk_add_node(sk, &l->head);
 176         write_unlock(&l->lock);
 177 }
 178 EXPORT_SYMBOL(bt_sock_link);
 179
 180 void bt_sock_unlink(struct bt_sock_list *l, struct sock *sk)
 181 {
 182         write_lock(&l->lock);
 183         sk_del_node_init(sk);
 184         write_unlock(&l->lock);
 185 }
 186 EXPORT_SYMBOL(bt_sock_unlink);
 187
 188 void bt_accept_enqueue(struct sock *parent, struct sock *sk, bool bh)
 189 {
 190         const struct cred *old_cred;
 191         struct pid *old_pid;
 192
 193         BT_DBG("parent %p, sk %p", parent, sk);
 194
 195         sock_hold(sk);
 196
 197         if (bh)
 198                 bh_lock_sock_nested(sk);
 199         else
 200                 lock_sock_nested(sk, SINGLE_DEPTH_NESTING);
 201
 202         list_add_tail(&bt_sk(sk)->accept_q, &bt_sk(parent)->accept_q);
 203         bt_sk(sk)->parent = parent;
 204
 205         /* Copy credentials from parent since for incoming connections the
 206          * socket is allocated by the kernel.
 207          */
 208         spin_lock(&sk->sk_peer_lock);
 209         old_pid = sk->sk_peer_pid;
 210         old_cred = sk->sk_peer_cred;
 211         sk->sk_peer_pid = get_pid(parent->sk_peer_pid);
 212         sk->sk_peer_cred = get_cred(parent->sk_peer_cred);
 213         spin_unlock(&sk->sk_peer_lock);
 214
 215         put_pid(old_pid);
 216         put_cred(old_cred);
 217
 218         if (bh)
 219                 bh_unlock_sock(sk);
 220         else
 221                 release_sock(sk);
 222
 223         sk_acceptq_added(parent);
 224 }
 225 EXPORT_SYMBOL(bt_accept_enqueue);
 226
 227 /* Calling function must hold the sk lock.
 228  * bt_sk(sk)->parent must be non-NULL meaning sk is in the parent list.
 229  */
 230 void bt_accept_unlink(struct sock *sk)
 231 {
 232         BT_DBG("sk %p state %d", sk, sk->sk_state);
 233
 234         list_del_init(&bt_sk(sk)->accept_q);
 235         sk_acceptq_removed(bt_sk(sk)->parent);
 236         bt_sk(sk)->parent = NULL;
 237         sock_put(sk);
 238 }
 239 EXPORT_SYMBOL(bt_accept_unlink);
 240
 241 struct sock *bt_accept_dequeue(struct sock *parent, struct socket *newsock)
 242 {
 243         struct bt_sock *s, *n;
 244         struct sock *sk;
 245
 246         BT_DBG("parent %p", parent);
 247
 248 restart:
 249         list_for_each_entry_safe(s, n, &bt_sk(parent)->accept_q, accept_q) {
 250                 sk = (struct sock *)s;
 251
 252                 /* Prevent early freeing of sk due to unlink and sock_kill */
 253                 sock_hold(sk);
 254                 lock_sock(sk);
 255
 256                 /* Check sk has not already been unlinked via
 257                  * bt_accept_unlink() due to serialisation caused by sk locking
 258                  */
 259                 if (!bt_sk(sk)->parent) {
 260                         BT_DBG("sk %p, already unlinked", sk);
 261                         release_sock(sk);
 262                         sock_put(sk);
 263
 264                         /* Restart the loop as sk is no longer in the list
 265                          * and also avoid a potential infinite loop because
 266                          * list_for_each_entry_safe() is not thread safe.
 267                          */
 268                         goto restart;
 269                 }
 270
 271                 /* sk is safely in the parent list so reduce reference count */
 272                 sock_put(sk);
 273
 274                 /* FIXME: Is this check still needed */
 275                 if (sk->sk_state == BT_CLOSED) {
 276                         bt_accept_unlink(sk);
 277                         release_sock(sk);
 278                         continue;
 279                 }
 280
 281                 if (sk->sk_state == BT_CONNECTED || !newsock ||
 282                     test_bit(BT_SK_DEFER_SETUP, &bt_sk(parent)->flags)) {
 283                         bt_accept_unlink(sk);
 284                         if (newsock)
 285                                 sock_graft(sk, newsock);
 286
 287                         release_sock(sk);
 288                         return sk;
 289                 }
 290
 291                 release_sock(sk);
 292         }
 293
 294         return NULL;
 295 }
 296 EXPORT_SYMBOL(bt_accept_dequeue);
 297
 298 int bt_sock_recvmsg(struct socket *sock, struct msghdr *msg, size_t len,
 299                     int flags)
 300 {
 301         struct sock *sk = sock->sk;
 302         struct sk_buff *skb;
 303         size_t copied;
 304         size_t skblen;
 305         int err;
 306
 307         BT_DBG("sock %p sk %p len %zu", sock, sk, len);
 308
 309         if (flags & MSG_OOB)
 310                 return -EOPNOTSUPP;
 311
 312         skb = skb_recv_datagram(sk, flags, &err);
 313         if (!skb) {
 314                 if (sk->sk_shutdown & RCV_SHUTDOWN)
 315                         err = 0;
 316
 317                 return err;
 318         }
 319
 320         skblen = skb->len;
 321         copied = skb->len;
 322         if (len < copied) {
 323                 msg->msg_flags |= MSG_TRUNC;
 324                 copied = len;
 325         }
 326
 327         skb_reset_transport_header(skb);
 328         err = skb_copy_datagram_msg(skb, 0, msg, copied);
 329         if (err == 0) {
 330                 sock_recv_cmsgs(msg, sk, skb);
 331
 332                 if (msg->msg_name && bt_sk(sk)->skb_msg_name)
 333                         bt_sk(sk)->skb_msg_name(skb, msg->msg_name,
 334                                                 &msg->msg_namelen);
 335
 336                 if (test_bit(BT_SK_PKT_STATUS, &bt_sk(sk)->flags)) {
 337                         u8 pkt_status = hci_skb_pkt_status(skb);
 338
 339                         put_cmsg(msg, SOL_BLUETOOTH, BT_SCM_PKT_STATUS,
 340                                  sizeof(pkt_status), &pkt_status);
 341                 }
 342         }
 343
 344         skb_free_datagram(sk, skb);
 345
 346         if (flags & MSG_TRUNC)
 347                 copied = skblen;
 348
 349         return err ? : copied;
 350 }
 351 EXPORT_SYMBOL(bt_sock_recvmsg);
 352
 353 static long bt_sock_data_wait(struct sock *sk, long timeo)
 354 {
 355         DECLARE_WAITQUEUE(wait, current);
 356
 357         add_wait_queue(sk_sleep(sk), &wait);
 358         for (;;) {
 359                 set_current_state(TASK_INTERRUPTIBLE);
 360
 361                 if (!skb_queue_empty(&sk->sk_receive_queue))
 362                         break;
 363
 364                 if (sk->sk_err || (sk->sk_shutdown & RCV_SHUTDOWN))
 365                         break;
 366
 367                 if (signal_pending(current) || !timeo)
 368                         break;
 369
 370                 sk_set_bit(SOCKWQ_ASYNC_WAITDATA, sk);
 371                 release_sock(sk);
 372                 timeo = schedule_timeout(timeo);
 373                 lock_sock(sk);
 374                 sk_clear_bit(SOCKWQ_ASYNC_WAITDATA, sk);
 375         }
 376
 377         __set_current_state(TASK_RUNNING);
 378         remove_wait_queue(sk_sleep(sk), &wait);
 379         return timeo;
 380 }
 381
 382 int bt_sock_stream_recvmsg(struct socket *sock, struct msghdr *msg,
 383                            size_t size, int flags)
 384 {
 385         struct sock *sk = sock->sk;
 386         int err = 0;
 387         size_t target, copied = 0;
 388         long timeo;
 389
 390         if (flags & MSG_OOB)
 391                 return -EOPNOTSUPP;
 392
 393         BT_DBG("sk %p size %zu", sk, size);
 394
 395         lock_sock(sk);
 396
 397         target = sock_rcvlowat(sk, flags & MSG_WAITALL, size);
 398         timeo  = sock_rcvtimeo(sk, flags & MSG_DONTWAIT);
 399
 400         do {
 401                 struct sk_buff *skb;
 402                 int chunk;
 403
 404                 skb = skb_dequeue(&sk->sk_receive_queue);
 405                 if (!skb) {
 406                         if (copied >= target)
 407                                 break;
 408
 409                         err = sock_error(sk);
 410                         if (err)
 411                                 break;
 412                         if (sk->sk_shutdown & RCV_SHUTDOWN)
 413                                 break;
 414
 415                         err = -EAGAIN;
 416                         if (!timeo)
 417                                 break;
 418
 419                         timeo = bt_sock_data_wait(sk, timeo);
 420
 421                         if (signal_pending(current)) {
 422                                 err = sock_intr_errno(timeo);
 423                                 goto out;
 424                         }
 425                         continue;
 426                 }
 427
 428                 chunk = min_t(unsigned int, skb->len, size);
 429                 if (skb_copy_datagram_msg(skb, 0, msg, chunk)) {
 430                         skb_queue_head(&sk->sk_receive_queue, skb);
 431                         if (!copied)
 432                                 copied = -EFAULT;
 433                         break;
 434                 }
 435                 copied += chunk;
 436                 size   -= chunk;
 437
 438                 sock_recv_cmsgs(msg, sk, skb);
 439
 440                 if (!(flags & MSG_PEEK)) {
 441                         int skb_len = skb_headlen(skb);
 442
 443                         if (chunk <= skb_len) {
 444                                 __skb_pull(skb, chunk);
 445                         } else {
 446                                 struct sk_buff *frag;
 447
 448                                 __skb_pull(skb, skb_len);
 449                                 chunk -= skb_len;
 450
 451                                 skb_walk_frags(skb, frag) {
 452                                         if (chunk <= frag->len) {
 453                                                 /* Pulling partial data */
 454                                                 skb->len -= chunk;
 455                                                 skb->data_len -= chunk;
 456                                                 __skb_pull(frag, chunk);
 457                                                 break;
 458                                         } else if (frag->len) {
 459                                                 /* Pulling all frag data */
 460                                                 chunk -= frag->len;
 461                                                 skb->len -= frag->len;
 462                                                 skb->data_len -= frag->len;
 463                                                 __skb_pull(frag, frag->len);
 464                                         }
 465                                 }
 466                         }
 467
 468                         if (skb->len) {
 469                                 skb_queue_head(&sk->sk_receive_queue, skb);
 470                                 break;
 471                         }
 472                         kfree_skb(skb);
 473
 474                 } else {
 475                         /* put message back and return */
 476                         skb_queue_head(&sk->sk_receive_queue, skb);
 477                         break;
 478                 }
 479         } while (size);
 480
 481 out:
 482         release_sock(sk);
 483         return copied ? : err;
 484 }
 485 EXPORT_SYMBOL(bt_sock_stream_recvmsg);
 486
 487 static inline __poll_t bt_accept_poll(struct sock *parent)
 488 {
 489         struct bt_sock *s, *n;
 490         struct sock *sk;
 491
 492         list_for_each_entry_safe(s, n, &bt_sk(parent)->accept_q, accept_q) {
 493                 sk = (struct sock *)s;
 494                 if (sk->sk_state == BT_CONNECTED ||
 495                     (test_bit(BT_SK_DEFER_SETUP, &bt_sk(parent)->flags) &&
 496                      sk->sk_state == BT_CONNECT2))
 497                         return EPOLLIN | EPOLLRDNORM;
 498         }
 499
 500         return 0;
 501 }
 502
 503 __poll_t bt_sock_poll(struct file *file, struct socket *sock,
 504                       poll_table *wait)
 505 {
 506         struct sock *sk = sock->sk;
 507         __poll_t mask = 0;
 508
 509         poll_wait(file, sk_sleep(sk), wait);
 510
 511         if (sk->sk_state == BT_LISTEN)
 512                 return bt_accept_poll(sk);
 513
 514         if (sk->sk_err || !skb_queue_empty_lockless(&sk->sk_error_queue))
 515                 mask |= EPOLLERR |
 516                         (sock_flag(sk, SOCK_SELECT_ERR_QUEUE) ? EPOLLPRI : 0);
 517
 518         if (sk->sk_shutdown & RCV_SHUTDOWN)
 519                 mask |= EPOLLRDHUP | EPOLLIN | EPOLLRDNORM;
 520
 521         if (sk->sk_shutdown == SHUTDOWN_MASK)
 522                 mask |= EPOLLHUP;
 523
 524         if (!skb_queue_empty_lockless(&sk->sk_receive_queue))
 525                 mask |= EPOLLIN | EPOLLRDNORM;
 526
 527         if (sk->sk_state == BT_CLOSED)
 528                 mask |= EPOLLHUP;
 529
 530         if (sk->sk_state == BT_CONNECT ||
 531             sk->sk_state == BT_CONNECT2 ||
 532             sk->sk_state == BT_CONFIG)
 533                 return mask;
 534
 535         if (!test_bit(BT_SK_SUSPEND, &bt_sk(sk)->flags) && sock_writeable(sk))
 536                 mask |= EPOLLOUT | EPOLLWRNORM | EPOLLWRBAND;
 537         else
 538                 sk_set_bit(SOCKWQ_ASYNC_NOSPACE, sk);
 539
 540         return mask;
 541 }
 542 EXPORT_SYMBOL(bt_sock_poll);
 543
 544 int bt_sock_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
 545 {
 546         struct sock *sk = sock->sk;
 547         struct sk_buff *skb;
 548         long amount;
 549         int err;
 550
 551         BT_DBG("sk %p cmd %x arg %lx", sk, cmd, arg);
 552
 553         switch (cmd) {
 554         case TIOCOUTQ:
 555                 if (sk->sk_state == BT_LISTEN)
 556                         return -EINVAL;
 557
 558                 amount = sk->sk_sndbuf - sk_wmem_alloc_get(sk);
 559                 if (amount < 0)
 560                         amount = 0;
 561                 err = put_user(amount, (int __user *)arg);
 562                 break;
 563
 564         case TIOCINQ:
 565                 if (sk->sk_state == BT_LISTEN)
 566                         return -EINVAL;
 567
 568                 spin_lock(&sk->sk_receive_queue.lock);
 569                 skb = skb_peek(&sk->sk_receive_queue);
 570                 amount = skb ? skb->len : 0;
 571                 spin_unlock(&sk->sk_receive_queue.lock);
 572
 573                 err = put_user(amount, (int __user *)arg);
 574                 break;
 575
 576         default:
 577                 err = -ENOIOCTLCMD;
 578                 break;
 579         }
 580
 581         return err;
 582 }
 583 EXPORT_SYMBOL(bt_sock_ioctl);
 584
 585 /* This function expects the sk lock to be held when called */
 586 int bt_sock_wait_state(struct sock *sk, int state, unsigned long timeo)
 587 {
 588         DECLARE_WAITQUEUE(wait, current);
 589         int err = 0;
 590
 591         BT_DBG("sk %p", sk);
 592
 593         add_wait_queue(sk_sleep(sk), &wait);
 594         set_current_state(TASK_INTERRUPTIBLE);
 595         while (sk->sk_state != state) {
 596                 if (!timeo) {
 597                         err = -EINPROGRESS;
 598                         break;
 599                 }
 600
 601                 if (signal_pending(current)) {
 602                         err = sock_intr_errno(timeo);
 603                         break;
 604                 }
 605
 606                 release_sock(sk);
 607                 timeo = schedule_timeout(timeo);
 608                 lock_sock(sk);
 609                 set_current_state(TASK_INTERRUPTIBLE);
 610
 611                 err = sock_error(sk);
 612                 if (err)
 613                         break;
 614         }
 615         __set_current_state(TASK_RUNNING);
 616         remove_wait_queue(sk_sleep(sk), &wait);
 617         return err;
 618 }
 619 EXPORT_SYMBOL(bt_sock_wait_state);
 620
 621 /* This function expects the sk lock to be held when called */
 622 int bt_sock_wait_ready(struct sock *sk, unsigned int msg_flags)
 623 {
 624         DECLARE_WAITQUEUE(wait, current);
 625         unsigned long timeo;
 626         int err = 0;
 627
 628         BT_DBG("sk %p", sk);
 629
 630         timeo = sock_sndtimeo(sk, !!(msg_flags & MSG_DONTWAIT));
 631
 632         add_wait_queue(sk_sleep(sk), &wait);
 633         set_current_state(TASK_INTERRUPTIBLE);
 634         while (test_bit(BT_SK_SUSPEND, &bt_sk(sk)->flags)) {
 635                 if (!timeo) {
 636                         err = -EAGAIN;
 637                         break;
 638                 }
 639
 640                 if (signal_pending(current)) {
 641                         err = sock_intr_errno(timeo);
 642                         break;
 643                 }
 644
 645                 release_sock(sk);
 646                 timeo = schedule_timeout(timeo);
 647                 lock_sock(sk);
 648                 set_current_state(TASK_INTERRUPTIBLE);
 649
 650                 err = sock_error(sk);
 651                 if (err)
 652                         break;
 653         }
 654         __set_current_state(TASK_RUNNING);
 655         remove_wait_queue(sk_sleep(sk), &wait);
 656
 657         return err;
 658 }
 659 EXPORT_SYMBOL(bt_sock_wait_ready);
 660
 661 #ifdef CONFIG_PROC_FS
 662 static void *bt_seq_start(struct seq_file *seq, loff_t *pos)
 663         __acquires(seq->private->l->lock)
 664 {
 665         struct bt_sock_list *l = pde_data(file_inode(seq->file));
 666
 667         read_lock(&l->lock);
 668         return seq_hlist_start_head(&l->head, *pos);
 669 }
 670
 671 static void *bt_seq_next(struct seq_file *seq, void *v, loff_t *pos)
 672 {
 673         struct bt_sock_list *l = pde_data(file_inode(seq->file));
 674
 675         return seq_hlist_next(v, &l->head, pos);
 676 }
 677
 678 static void bt_seq_stop(struct seq_file *seq, void *v)
 679         __releases(seq->private->l->lock)
 680 {
 681         struct bt_sock_list *l = pde_data(file_inode(seq->file));
 682
 683         read_unlock(&l->lock);
 684 }
 685
 686 static int bt_seq_show(struct seq_file *seq, void *v)
 687 {
 688         struct bt_sock_list *l = pde_data(file_inode(seq->file));
 689
 690         if (v == SEQ_START_TOKEN) {
 691                 seq_puts(seq, "sk               RefCnt Rmem   Wmem   User   Inode  Parent");
 692
 693                 if (l->custom_seq_show) {
 694                         seq_putc(seq, ' ');
 695                         l->custom_seq_show(seq, v);
 696                 }
 697
 698                 seq_putc(seq, '\n');
 699         } else {
 700                 struct sock *sk = sk_entry(v);
 701                 struct bt_sock *bt = bt_sk(sk);
 702
 703                 seq_printf(seq,
 704                            "%pK %-6d %-6u %-6u %-6u %-6lu %-6lu",
 705                            sk,
 706                            refcount_read(&sk->sk_refcnt),
 707                            sk_rmem_alloc_get(sk),
 708                            sk_wmem_alloc_get(sk),
 709                            from_kuid(seq_user_ns(seq), sock_i_uid(sk)),
 710                            sock_i_ino(sk),
 711                            bt->parent ? sock_i_ino(bt->parent) : 0LU);
 712
 713                 if (l->custom_seq_show) {
 714                         seq_putc(seq, ' ');
 715                         l->custom_seq_show(seq, v);
 716                 }
 717
 718                 seq_putc(seq, '\n');
 719         }
 720         return 0;
 721 }
 722
 723 static const struct seq_operations bt_seq_ops = {
 724         .start = bt_seq_start,
 725         .next  = bt_seq_next,
 726         .stop  = bt_seq_stop,
 727         .show  = bt_seq_show,
 728 };
 729
 730 int bt_procfs_init(struct net *net, const char *name,
 731                    struct bt_sock_list *sk_list,
 732                    int (*seq_show)(struct seq_file *, void *))
 733 {
 734         sk_list->custom_seq_show = seq_show;
 735
 736         if (!proc_create_seq_data(name, 0, net->proc_net, &bt_seq_ops, sk_list))
 737                 return -ENOMEM;
 738         return 0;
 739 }
 740
 741 void bt_procfs_cleanup(struct net *net, const char *name)
 742 {
 743         remove_proc_entry(name, net->proc_net);
 744 }
 745 #else
 746 int bt_procfs_init(struct net *net, const char *name,
 747                    struct bt_sock_list *sk_list,
 748                    int (*seq_show)(struct seq_file *, void *))
 749 {
 750         return 0;
 751 }
 752
 753 void bt_procfs_cleanup(struct net *net, const char *name)
 754 {
 755 }
 756 #endif
 757 EXPORT_SYMBOL(bt_procfs_init);
 758 EXPORT_SYMBOL(bt_procfs_cleanup);
 759
 760 static const struct net_proto_family bt_sock_family_ops = {
 761         .owner  = THIS_MODULE,
 762         .family = PF_BLUETOOTH,
 763         .create = bt_sock_create,
 764 };
 765
 766 struct dentry *bt_debugfs;
 767 EXPORT_SYMBOL_GPL(bt_debugfs);
 768
 769 #define VERSION __stringify(BT_SUBSYS_VERSION) "." \
 770                 __stringify(BT_SUBSYS_REVISION)
 771
 772 static int __init bt_init(void)
 773 {
 774         int err;
 775
 776         sock_skb_cb_check_size(sizeof(struct bt_skb_cb));
 777
 778         BT_INFO("Core ver %s", VERSION);
 779
 780         err = bt_selftest();
 781         if (err < 0)
 782                 return err;
 783
 784         bt_debugfs = debugfs_create_dir("bluetooth", NULL);
 785
 786         bt_leds_init();
 787
 788         err = bt_sysfs_init();
 789         if (err < 0)
 790                 goto cleanup_led;
 791
 792         err = sock_register(&bt_sock_family_ops);
 793         if (err)
 794                 goto cleanup_sysfs;
 795
 796         BT_INFO("HCI device and connection manager initialized");
 797
 798         err = hci_sock_init();
 799         if (err)
 800                 goto unregister_socket;
 801
 802         err = l2cap_init();
 803         if (err)
 804                 goto cleanup_socket;
 805
 806         err = sco_init();
 807         if (err)
 808                 goto cleanup_cap;
 809
 810         err = mgmt_init();
 811         if (err)
 812                 goto cleanup_sco;
 813
 814         return 0;
 815
 816 cleanup_sco:
 817         sco_exit();
 818 cleanup_cap:
 819         l2cap_exit();
 820 cleanup_socket:
 821         hci_sock_cleanup();
 822 unregister_socket:
 823         sock_unregister(PF_BLUETOOTH);
 824 cleanup_sysfs:
 825         bt_sysfs_cleanup();
 826 cleanup_led:
 827         bt_leds_cleanup();
 828         return err;
 829 }
 830
 831 static void __exit bt_exit(void)
 832 {
 833         mgmt_exit();
 834
 835         sco_exit();
 836
 837         l2cap_exit();
 838
 839         hci_sock_cleanup();
 840
 841         sock_unregister(PF_BLUETOOTH);
 842
 843         bt_sysfs_cleanup();
 844
 845         bt_leds_cleanup();
 846
 847         debugfs_remove_recursive(bt_debugfs);
 848 }
 849
 850 subsys_initcall(bt_init);
 851 module_exit(bt_exit);
 852
 853 MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>");
 854 MODULE_DESCRIPTION("Bluetooth Core ver " VERSION);
 855 MODULE_VERSION(VERSION);
 856 MODULE_LICENSE("GPL");
 857 MODULE_ALIAS_NETPROTO(PF_BLUETOOTH);