net/bluetooth/sco.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 SCO sockets. */
  26
  27 #include <linux/module.h>
  28 #include <linux/debugfs.h>
  29 #include <linux/seq_file.h>
  30
  31 #include <net/bluetooth/bluetooth.h>
  32 #include <net/bluetooth/hci_core.h>
  33 #include <net/bluetooth/sco.h>
  34
  35 static bool disable_esco;
  36
  37 static const struct proto_ops sco_sock_ops;
  38
  39 static struct bt_sock_list sco_sk_list = {
  40         .lock = __RW_LOCK_UNLOCKED(sco_sk_list.lock)
  41 };
  42
  43 static void __sco_chan_add(struct sco_conn *conn, struct sock *sk, struct sock *parent);
  44 static void sco_chan_del(struct sock *sk, int err);
  45
  46 static void sco_sock_close(struct sock *sk);
  47 static void sco_sock_kill(struct sock *sk);
  48
  49 /* ---- SCO timers ---- */
  50 static void sco_sock_timeout(unsigned long arg)
  51 {
  52         struct sock *sk = (struct sock *) arg;
  53
  54         BT_DBG("sock %p state %d", sk, sk->sk_state);
  55
  56         bh_lock_sock(sk);
  57         sk->sk_err = ETIMEDOUT;
  58         sk->sk_state_change(sk);
  59         bh_unlock_sock(sk);
  60
  61         sco_sock_kill(sk);
  62         sock_put(sk);
  63 }
  64
  65 static void sco_sock_set_timer(struct sock *sk, long timeout)
  66 {
  67         BT_DBG("sock %p state %d timeout %ld", sk, sk->sk_state, timeout);
  68         sk_reset_timer(sk, &sk->sk_timer, jiffies + timeout);
  69 }
  70
  71 static void sco_sock_clear_timer(struct sock *sk)
  72 {
  73         BT_DBG("sock %p state %d", sk, sk->sk_state);
  74         sk_stop_timer(sk, &sk->sk_timer);
  75 }
  76
  77 /* ---- SCO connections ---- */
  78 static struct sco_conn *sco_conn_add(struct hci_conn *hcon)
  79 {
  80         struct hci_dev *hdev = hcon->hdev;
  81         struct sco_conn *conn = hcon->sco_data;
  82
  83         if (conn)
  84                 return conn;
  85
  86         conn = kzalloc(sizeof(struct sco_conn), GFP_ATOMIC);
  87         if (!conn)
  88                 return NULL;
  89
  90         spin_lock_init(&conn->lock);
  91
  92         hcon->sco_data = conn;
  93         conn->hcon = hcon;
  94
  95         conn->src = &hdev->bdaddr;
  96         conn->dst = &hcon->dst;
  97
  98         if (hdev->sco_mtu > 0)
  99                 conn->mtu = hdev->sco_mtu;
 100         else
 101                 conn->mtu = 60;
 102
 103         BT_DBG("hcon %p conn %p", hcon, conn);
 104
 105         return conn;
 106 }
 107
 108 static struct sock *sco_chan_get(struct sco_conn *conn)
 109 {
 110         struct sock *sk = NULL;
 111         sco_conn_lock(conn);
 112         sk = conn->sk;
 113         sco_conn_unlock(conn);
 114         return sk;
 115 }
 116
 117 static int sco_conn_del(struct hci_conn *hcon, int err)
 118 {
 119         struct sco_conn *conn = hcon->sco_data;
 120         struct sock *sk;
 121
 122         if (!conn)
 123                 return 0;
 124
 125         BT_DBG("hcon %p conn %p, err %d", hcon, conn, err);
 126
 127         /* Kill socket */
 128         sk = sco_chan_get(conn);
 129         if (sk) {
 130                 bh_lock_sock(sk);
 131                 sco_sock_clear_timer(sk);
 132                 sco_chan_del(sk, err);
 133                 bh_unlock_sock(sk);
 134                 sco_sock_kill(sk);
 135         }
 136
 137         hcon->sco_data = NULL;
 138         kfree(conn);
 139         return 0;
 140 }
 141
 142 static int sco_chan_add(struct sco_conn *conn, struct sock *sk,
 143                         struct sock *parent)
 144 {
 145         int err = 0;
 146
 147         sco_conn_lock(conn);
 148         if (conn->sk)
 149                 err = -EBUSY;
 150         else
 151                 __sco_chan_add(conn, sk, parent);
 152
 153         sco_conn_unlock(conn);
 154         return err;
 155 }
 156
 157 static int sco_connect(struct sock *sk)
 158 {
 159         bdaddr_t *src = &bt_sk(sk)->src;
 160         bdaddr_t *dst = &bt_sk(sk)->dst;
 161         struct sco_conn *conn;
 162         struct hci_conn *hcon;
 163         struct hci_dev  *hdev;
 164         int err, type;
 165
 166         BT_DBG("%pMR -> %pMR", src, dst);
 167
 168         hdev = hci_get_route(dst, src);
 169         if (!hdev)
 170                 return -EHOSTUNREACH;
 171
 172         hci_dev_lock(hdev);
 173
 174         if (lmp_esco_capable(hdev) && !disable_esco)
 175                 type = ESCO_LINK;
 176         else
 177                 type = SCO_LINK;
 178
 179         hcon = hci_connect(hdev, type, dst, BDADDR_BREDR, BT_SECURITY_LOW,
 180                            HCI_AT_NO_BONDING);
 181         if (IS_ERR(hcon)) {
 182                 err = PTR_ERR(hcon);
 183                 goto done;
 184         }
 185
 186         conn = sco_conn_add(hcon);
 187         if (!conn) {
 188                 hci_conn_put(hcon);
 189                 err = -ENOMEM;
 190                 goto done;
 191         }
 192
 193         /* Update source addr of the socket */
 194         bacpy(src, conn->src);
 195
 196         err = sco_chan_add(conn, sk, NULL);
 197         if (err)
 198                 goto done;
 199
 200         if (hcon->state == BT_CONNECTED) {
 201                 sco_sock_clear_timer(sk);
 202                 sk->sk_state = BT_CONNECTED;
 203         } else {
 204                 sk->sk_state = BT_CONNECT;
 205                 sco_sock_set_timer(sk, sk->sk_sndtimeo);
 206         }
 207
 208 done:
 209         hci_dev_unlock(hdev);
 210         hci_dev_put(hdev);
 211         return err;
 212 }
 213
 214 static int sco_send_frame(struct sock *sk, struct msghdr *msg, int len)
 215 {
 216         struct sco_conn *conn = sco_pi(sk)->conn;
 217         struct sk_buff *skb;
 218         int err;
 219
 220         /* Check outgoing MTU */
 221         if (len > conn->mtu)
 222                 return -EINVAL;
 223
 224         BT_DBG("sk %p len %d", sk, len);
 225
 226         skb = bt_skb_send_alloc(sk, len, msg->msg_flags & MSG_DONTWAIT, &err);
 227         if (!skb)
 228                 return err;
 229
 230         if (memcpy_fromiovec(skb_put(skb, len), msg->msg_iov, len)) {
 231                 kfree_skb(skb);
 232                 return -EFAULT;
 233         }
 234
 235         hci_send_sco(conn->hcon, skb);
 236
 237         return len;
 238 }
 239
 240 static void sco_recv_frame(struct sco_conn *conn, struct sk_buff *skb)
 241 {
 242         struct sock *sk = sco_chan_get(conn);
 243
 244         if (!sk)
 245                 goto drop;
 246
 247         BT_DBG("sk %p len %d", sk, skb->len);
 248
 249         if (sk->sk_state != BT_CONNECTED)
 250                 goto drop;
 251
 252         if (!sock_queue_rcv_skb(sk, skb))
 253                 return;
 254
 255 drop:
 256         kfree_skb(skb);
 257 }
 258
 259 /* -------- Socket interface ---------- */
 260 static struct sock *__sco_get_sock_listen_by_addr(bdaddr_t *ba)
 261 {
 262         struct hlist_node *node;
 263         struct sock *sk;
 264
 265         sk_for_each(sk, node, &sco_sk_list.head) {
 266                 if (sk->sk_state != BT_LISTEN)
 267                         continue;
 268
 269                 if (!bacmp(&bt_sk(sk)->src, ba))
 270                         return sk;
 271         }
 272
 273         return NULL;
 274 }
 275
 276 /* Find socket listening on source bdaddr.
 277  * Returns closest match.
 278  */
 279 static struct sock *sco_get_sock_listen(bdaddr_t *src)
 280 {
 281         struct sock *sk = NULL, *sk1 = NULL;
 282         struct hlist_node *node;
 283
 284         read_lock(&sco_sk_list.lock);
 285
 286         sk_for_each(sk, node, &sco_sk_list.head) {
 287                 if (sk->sk_state != BT_LISTEN)
 288                         continue;
 289
 290                 /* Exact match. */
 291                 if (!bacmp(&bt_sk(sk)->src, src))
 292                         break;
 293
 294                 /* Closest match */
 295                 if (!bacmp(&bt_sk(sk)->src, BDADDR_ANY))
 296                         sk1 = sk;
 297         }
 298
 299         read_unlock(&sco_sk_list.lock);
 300
 301         return node ? sk : sk1;
 302 }
 303
 304 static void sco_sock_destruct(struct sock *sk)
 305 {
 306         BT_DBG("sk %p", sk);
 307
 308         skb_queue_purge(&sk->sk_receive_queue);
 309         skb_queue_purge(&sk->sk_write_queue);
 310 }
 311
 312 static void sco_sock_cleanup_listen(struct sock *parent)
 313 {
 314         struct sock *sk;
 315
 316         BT_DBG("parent %p", parent);
 317
 318         /* Close not yet accepted channels */
 319         while ((sk = bt_accept_dequeue(parent, NULL))) {
 320                 sco_sock_close(sk);
 321                 sco_sock_kill(sk);
 322         }
 323
 324         parent->sk_state  = BT_CLOSED;
 325         sock_set_flag(parent, SOCK_ZAPPED);
 326 }
 327
 328 /* Kill socket (only if zapped and orphan)
 329  * Must be called on unlocked socket.
 330  */
 331 static void sco_sock_kill(struct sock *sk)
 332 {
 333         if (!sock_flag(sk, SOCK_ZAPPED) || sk->sk_socket)
 334                 return;
 335
 336         BT_DBG("sk %p state %d", sk, sk->sk_state);
 337
 338         /* Kill poor orphan */
 339         bt_sock_unlink(&sco_sk_list, sk);
 340         sock_set_flag(sk, SOCK_DEAD);
 341         sock_put(sk);
 342 }
 343
 344 static void __sco_sock_close(struct sock *sk)
 345 {
 346         BT_DBG("sk %p state %d socket %p", sk, sk->sk_state, sk->sk_socket);
 347
 348         switch (sk->sk_state) {
 349         case BT_LISTEN:
 350                 sco_sock_cleanup_listen(sk);
 351                 break;
 352
 353         case BT_CONNECTED:
 354         case BT_CONFIG:
 355                 if (sco_pi(sk)->conn->hcon) {
 356                         sk->sk_state = BT_DISCONN;
 357                         sco_sock_set_timer(sk, SCO_DISCONN_TIMEOUT);
 358                         hci_conn_put(sco_pi(sk)->conn->hcon);
 359                         sco_pi(sk)->conn->hcon = NULL;
 360                 } else
 361                         sco_chan_del(sk, ECONNRESET);
 362                 break;
 363
 364         case BT_CONNECT:
 365         case BT_DISCONN:
 366                 sco_chan_del(sk, ECONNRESET);
 367                 break;
 368
 369         default:
 370                 sock_set_flag(sk, SOCK_ZAPPED);
 371                 break;
 372         }
 373 }
 374
 375 /* Must be called on unlocked socket. */
 376 static void sco_sock_close(struct sock *sk)
 377 {
 378         sco_sock_clear_timer(sk);
 379         lock_sock(sk);
 380         __sco_sock_close(sk);
 381         release_sock(sk);
 382         sco_sock_kill(sk);
 383 }
 384
 385 static void sco_sock_init(struct sock *sk, struct sock *parent)
 386 {
 387         BT_DBG("sk %p", sk);
 388
 389         if (parent) {
 390                 sk->sk_type = parent->sk_type;
 391                 bt_sk(sk)->flags = bt_sk(parent)->flags;
 392                 security_sk_clone(parent, sk);
 393         }
 394 }
 395
 396 static struct proto sco_proto = {
 397         .name           = "SCO",
 398         .owner          = THIS_MODULE,
 399         .obj_size       = sizeof(struct sco_pinfo)
 400 };
 401
 402 static struct sock *sco_sock_alloc(struct net *net, struct socket *sock, int proto, gfp_t prio)
 403 {
 404         struct sock *sk;
 405
 406         sk = sk_alloc(net, PF_BLUETOOTH, prio, &sco_proto);
 407         if (!sk)
 408                 return NULL;
 409
 410         sock_init_data(sock, sk);
 411         INIT_LIST_HEAD(&bt_sk(sk)->accept_q);
 412
 413         sk->sk_destruct = sco_sock_destruct;
 414         sk->sk_sndtimeo = SCO_CONN_TIMEOUT;
 415
 416         sock_reset_flag(sk, SOCK_ZAPPED);
 417
 418         sk->sk_protocol = proto;
 419         sk->sk_state    = BT_OPEN;
 420
 421         setup_timer(&sk->sk_timer, sco_sock_timeout, (unsigned long)sk);
 422
 423         bt_sock_link(&sco_sk_list, sk);
 424         return sk;
 425 }
 426
 427 static int sco_sock_create(struct net *net, struct socket *sock, int protocol,
 428                            int kern)
 429 {
 430         struct sock *sk;
 431
 432         BT_DBG("sock %p", sock);
 433
 434         sock->state = SS_UNCONNECTED;
 435
 436         if (sock->type != SOCK_SEQPACKET)
 437                 return -ESOCKTNOSUPPORT;
 438
 439         sock->ops = &sco_sock_ops;
 440
 441         sk = sco_sock_alloc(net, sock, protocol, GFP_ATOMIC);
 442         if (!sk)
 443                 return -ENOMEM;
 444
 445         sco_sock_init(sk, NULL);
 446         return 0;
 447 }
 448
 449 static int sco_sock_bind(struct socket *sock, struct sockaddr *addr, int addr_len)
 450 {
 451         struct sockaddr_sco *sa = (struct sockaddr_sco *) addr;
 452         struct sock *sk = sock->sk;
 453         int err = 0;
 454
 455         BT_DBG("sk %p %pMR", sk, &sa->sco_bdaddr);
 456
 457         if (!addr || addr->sa_family != AF_BLUETOOTH)
 458                 return -EINVAL;
 459
 460         lock_sock(sk);
 461
 462         if (sk->sk_state != BT_OPEN) {
 463                 err = -EBADFD;
 464                 goto done;
 465         }
 466
 467         if (sk->sk_type != SOCK_SEQPACKET) {
 468                 err = -EINVAL;
 469                 goto done;
 470         }
 471
 472         bacpy(&bt_sk(sk)->src, &sa->sco_bdaddr);
 473
 474         sk->sk_state = BT_BOUND;
 475
 476 done:
 477         release_sock(sk);
 478         return err;
 479 }
 480
 481 static int sco_sock_connect(struct socket *sock, struct sockaddr *addr, int alen, int flags)
 482 {
 483         struct sockaddr_sco *sa = (struct sockaddr_sco *) addr;
 484         struct sock *sk = sock->sk;
 485         int err = 0;
 486
 487
 488         BT_DBG("sk %p", sk);
 489
 490         if (alen < sizeof(struct sockaddr_sco) ||
 491             addr->sa_family != AF_BLUETOOTH)
 492                 return -EINVAL;
 493
 494         if (sk->sk_state != BT_OPEN && sk->sk_state != BT_BOUND)
 495                 return -EBADFD;
 496
 497         if (sk->sk_type != SOCK_SEQPACKET)
 498                 return -EINVAL;
 499
 500         lock_sock(sk);
 501
 502         /* Set destination address and psm */
 503         bacpy(&bt_sk(sk)->dst, &sa->sco_bdaddr);
 504
 505         err = sco_connect(sk);
 506         if (err)
 507                 goto done;
 508
 509         err = bt_sock_wait_state(sk, BT_CONNECTED,
 510                                  sock_sndtimeo(sk, flags & O_NONBLOCK));
 511
 512 done:
 513         release_sock(sk);
 514         return err;
 515 }
 516
 517 static int sco_sock_listen(struct socket *sock, int backlog)
 518 {
 519         struct sock *sk = sock->sk;
 520         bdaddr_t *src = &bt_sk(sk)->src;
 521         int err = 0;
 522
 523         BT_DBG("sk %p backlog %d", sk, backlog);
 524
 525         lock_sock(sk);
 526
 527         if (sk->sk_state != BT_BOUND) {
 528                 err = -EBADFD;
 529                 goto done;
 530         }
 531
 532         if (sk->sk_type != SOCK_SEQPACKET) {
 533                 err = -EINVAL;
 534                 goto done;
 535         }
 536
 537         write_lock(&sco_sk_list.lock);
 538
 539         if (__sco_get_sock_listen_by_addr(src)) {
 540                 err = -EADDRINUSE;
 541                 goto unlock;
 542         }
 543
 544         sk->sk_max_ack_backlog = backlog;
 545         sk->sk_ack_backlog = 0;
 546
 547         sk->sk_state = BT_LISTEN;
 548
 549 unlock:
 550         write_unlock(&sco_sk_list.lock);
 551
 552 done:
 553         release_sock(sk);
 554         return err;
 555 }
 556
 557 static int sco_sock_accept(struct socket *sock, struct socket *newsock, int flags)
 558 {
 559         DECLARE_WAITQUEUE(wait, current);
 560         struct sock *sk = sock->sk, *ch;
 561         long timeo;
 562         int err = 0;
 563
 564         lock_sock(sk);
 565
 566         timeo = sock_rcvtimeo(sk, flags & O_NONBLOCK);
 567
 568         BT_DBG("sk %p timeo %ld", sk, timeo);
 569
 570         /* Wait for an incoming connection. (wake-one). */
 571         add_wait_queue_exclusive(sk_sleep(sk), &wait);
 572         while (1) {
 573                 set_current_state(TASK_INTERRUPTIBLE);
 574
 575                 if (sk->sk_state != BT_LISTEN) {
 576                         err = -EBADFD;
 577                         break;
 578                 }
 579
 580                 ch = bt_accept_dequeue(sk, newsock);
 581                 if (ch)
 582                         break;
 583
 584                 if (!timeo) {
 585                         err = -EAGAIN;
 586                         break;
 587                 }
 588
 589                 if (signal_pending(current)) {
 590                         err = sock_intr_errno(timeo);
 591                         break;
 592                 }
 593
 594                 release_sock(sk);
 595                 timeo = schedule_timeout(timeo);
 596                 lock_sock(sk);
 597         }
 598         __set_current_state(TASK_RUNNING);
 599         remove_wait_queue(sk_sleep(sk), &wait);
 600
 601         if (err)
 602                 goto done;
 603
 604         newsock->state = SS_CONNECTED;
 605
 606         BT_DBG("new socket %p", ch);
 607
 608 done:
 609         release_sock(sk);
 610         return err;
 611 }
 612
 613 static int sco_sock_getname(struct socket *sock, struct sockaddr *addr, int *len, int peer)
 614 {
 615         struct sockaddr_sco *sa = (struct sockaddr_sco *) addr;
 616         struct sock *sk = sock->sk;
 617
 618         BT_DBG("sock %p, sk %p", sock, sk);
 619
 620         addr->sa_family = AF_BLUETOOTH;
 621         *len = sizeof(struct sockaddr_sco);
 622
 623         if (peer)
 624                 bacpy(&sa->sco_bdaddr, &bt_sk(sk)->dst);
 625         else
 626                 bacpy(&sa->sco_bdaddr, &bt_sk(sk)->src);
 627
 628         return 0;
 629 }
 630
 631 static int sco_sock_sendmsg(struct kiocb *iocb, struct socket *sock,
 632                             struct msghdr *msg, size_t len)
 633 {
 634         struct sock *sk = sock->sk;
 635         int err;
 636
 637         BT_DBG("sock %p, sk %p", sock, sk);
 638
 639         err = sock_error(sk);
 640         if (err)
 641                 return err;
 642
 643         if (msg->msg_flags & MSG_OOB)
 644                 return -EOPNOTSUPP;
 645
 646         lock_sock(sk);
 647
 648         if (sk->sk_state == BT_CONNECTED)
 649                 err = sco_send_frame(sk, msg, len);
 650         else
 651                 err = -ENOTCONN;
 652
 653         release_sock(sk);
 654         return err;
 655 }
 656
 657 static int sco_sock_recvmsg(struct kiocb *iocb, struct socket *sock,
 658                             struct msghdr *msg, size_t len, int flags)
 659 {
 660         struct sock *sk = sock->sk;
 661         struct sco_pinfo *pi = sco_pi(sk);
 662
 663         lock_sock(sk);
 664
 665         if (sk->sk_state == BT_CONNECT2 &&
 666             test_bit(BT_SK_DEFER_SETUP, &bt_sk(sk)->flags)) {
 667                 hci_conn_accept(pi->conn->hcon, 0);
 668                 sk->sk_state = BT_CONFIG;
 669
 670                 release_sock(sk);
 671                 return 0;
 672         }
 673
 674         release_sock(sk);
 675
 676         return bt_sock_recvmsg(iocb, sock, msg, len, flags);
 677 }
 678
 679 static int sco_sock_setsockopt(struct socket *sock, int level, int optname, char __user *optval, unsigned int optlen)
 680 {
 681         struct sock *sk = sock->sk;
 682         int err = 0;
 683         u32 opt;
 684
 685         BT_DBG("sk %p", sk);
 686
 687         lock_sock(sk);
 688
 689         switch (optname) {
 690
 691         case BT_DEFER_SETUP:
 692                 if (sk->sk_state != BT_BOUND && sk->sk_state != BT_LISTEN) {
 693                         err = -EINVAL;
 694                         break;
 695                 }
 696
 697                 if (get_user(opt, (u32 __user *) optval)) {
 698                         err = -EFAULT;
 699                         break;
 700                 }
 701
 702                 if (opt)
 703                         set_bit(BT_SK_DEFER_SETUP, &bt_sk(sk)->flags);
 704                 else
 705                         clear_bit(BT_SK_DEFER_SETUP, &bt_sk(sk)->flags);
 706                 break;
 707
 708         default:
 709                 err = -ENOPROTOOPT;
 710                 break;
 711         }
 712
 713         release_sock(sk);
 714         return err;
 715 }
 716
 717 static int sco_sock_getsockopt_old(struct socket *sock, int optname, char __user *optval, int __user *optlen)
 718 {
 719         struct sock *sk = sock->sk;
 720         struct sco_options opts;
 721         struct sco_conninfo cinfo;
 722         int len, err = 0;
 723
 724         BT_DBG("sk %p", sk);
 725
 726         if (get_user(len, optlen))
 727                 return -EFAULT;
 728
 729         lock_sock(sk);
 730
 731         switch (optname) {
 732         case SCO_OPTIONS:
 733                 if (sk->sk_state != BT_CONNECTED) {
 734                         err = -ENOTCONN;
 735                         break;
 736                 }
 737
 738                 opts.mtu = sco_pi(sk)->conn->mtu;
 739
 740                 BT_DBG("mtu %d", opts.mtu);
 741
 742                 len = min_t(unsigned int, len, sizeof(opts));
 743                 if (copy_to_user(optval, (char *)&opts, len))
 744                         err = -EFAULT;
 745
 746                 break;
 747
 748         case SCO_CONNINFO:
 749                 if (sk->sk_state != BT_CONNECTED) {
 750                         err = -ENOTCONN;
 751                         break;
 752                 }
 753
 754                 memset(&cinfo, 0, sizeof(cinfo));
 755                 cinfo.hci_handle = sco_pi(sk)->conn->hcon->handle;
 756                 memcpy(cinfo.dev_class, sco_pi(sk)->conn->hcon->dev_class, 3);
 757
 758                 len = min_t(unsigned int, len, sizeof(cinfo));
 759                 if (copy_to_user(optval, (char *)&cinfo, len))
 760                         err = -EFAULT;
 761
 762                 break;
 763
 764         default:
 765                 err = -ENOPROTOOPT;
 766                 break;
 767         }
 768
 769         release_sock(sk);
 770         return err;
 771 }
 772
 773 static int sco_sock_getsockopt(struct socket *sock, int level, int optname, char __user *optval, int __user *optlen)
 774 {
 775         struct sock *sk = sock->sk;
 776         int len, err = 0;
 777
 778         BT_DBG("sk %p", sk);
 779
 780         if (level == SOL_SCO)
 781                 return sco_sock_getsockopt_old(sock, optname, optval, optlen);
 782
 783         if (get_user(len, optlen))
 784                 return -EFAULT;
 785
 786         lock_sock(sk);
 787
 788         switch (optname) {
 789
 790         case BT_DEFER_SETUP:
 791                 if (sk->sk_state != BT_BOUND && sk->sk_state != BT_LISTEN) {
 792                         err = -EINVAL;
 793                         break;
 794                 }
 795
 796                 if (put_user(test_bit(BT_SK_DEFER_SETUP, &bt_sk(sk)->flags),
 797                              (u32 __user *) optval))
 798                         err = -EFAULT;
 799
 800                 break;
 801
 802         default:
 803                 err = -ENOPROTOOPT;
 804                 break;
 805         }
 806
 807         release_sock(sk);
 808         return err;
 809 }
 810
 811 static int sco_sock_shutdown(struct socket *sock, int how)
 812 {
 813         struct sock *sk = sock->sk;
 814         int err = 0;
 815
 816         BT_DBG("sock %p, sk %p", sock, sk);
 817
 818         if (!sk)
 819                 return 0;
 820
 821         lock_sock(sk);
 822         if (!sk->sk_shutdown) {
 823                 sk->sk_shutdown = SHUTDOWN_MASK;
 824                 sco_sock_clear_timer(sk);
 825                 __sco_sock_close(sk);
 826
 827                 if (sock_flag(sk, SOCK_LINGER) && sk->sk_lingertime)
 828                         err = bt_sock_wait_state(sk, BT_CLOSED,
 829                                                  sk->sk_lingertime);
 830         }
 831         release_sock(sk);
 832         return err;
 833 }
 834
 835 static int sco_sock_release(struct socket *sock)
 836 {
 837         struct sock *sk = sock->sk;
 838         int err = 0;
 839
 840         BT_DBG("sock %p, sk %p", sock, sk);
 841
 842         if (!sk)
 843                 return 0;
 844
 845         sco_sock_close(sk);
 846
 847         if (sock_flag(sk, SOCK_LINGER) && sk->sk_lingertime) {
 848                 lock_sock(sk);
 849                 err = bt_sock_wait_state(sk, BT_CLOSED, sk->sk_lingertime);
 850                 release_sock(sk);
 851         }
 852
 853         sock_orphan(sk);
 854         sco_sock_kill(sk);
 855         return err;
 856 }
 857
 858 static void __sco_chan_add(struct sco_conn *conn, struct sock *sk, struct sock *parent)
 859 {
 860         BT_DBG("conn %p", conn);
 861
 862         sco_pi(sk)->conn = conn;
 863         conn->sk = sk;
 864
 865         if (parent)
 866                 bt_accept_enqueue(parent, sk);
 867 }
 868
 869 /* Delete channel.
 870  * Must be called on the locked socket. */
 871 static void sco_chan_del(struct sock *sk, int err)
 872 {
 873         struct sco_conn *conn;
 874
 875         conn = sco_pi(sk)->conn;
 876
 877         BT_DBG("sk %p, conn %p, err %d", sk, conn, err);
 878
 879         if (conn) {
 880                 sco_conn_lock(conn);
 881                 conn->sk = NULL;
 882                 sco_pi(sk)->conn = NULL;
 883                 sco_conn_unlock(conn);
 884
 885                 if (conn->hcon)
 886                         hci_conn_put(conn->hcon);
 887         }
 888
 889         sk->sk_state = BT_CLOSED;
 890         sk->sk_err   = err;
 891         sk->sk_state_change(sk);
 892
 893         sock_set_flag(sk, SOCK_ZAPPED);
 894 }
 895
 896 static void sco_conn_ready(struct sco_conn *conn)
 897 {
 898         struct sock *parent;
 899         struct sock *sk = conn->sk;
 900
 901         BT_DBG("conn %p", conn);
 902
 903         if (sk) {
 904                 sco_sock_clear_timer(sk);
 905                 bh_lock_sock(sk);
 906                 sk->sk_state = BT_CONNECTED;
 907                 sk->sk_state_change(sk);
 908                 bh_unlock_sock(sk);
 909         } else {
 910                 sco_conn_lock(conn);
 911
 912                 parent = sco_get_sock_listen(conn->src);
 913                 if (!parent) {
 914                         sco_conn_unlock(conn);
 915                         return;
 916                 }
 917
 918                 bh_lock_sock(parent);
 919
 920                 sk = sco_sock_alloc(sock_net(parent), NULL,
 921                                     BTPROTO_SCO, GFP_ATOMIC);
 922                 if (!sk) {
 923                         bh_unlock_sock(parent);
 924                         sco_conn_unlock(conn);
 925                         return;
 926                 }
 927
 928                 sco_sock_init(sk, parent);
 929
 930                 bacpy(&bt_sk(sk)->src, conn->src);
 931                 bacpy(&bt_sk(sk)->dst, conn->dst);
 932
 933                 hci_conn_hold(conn->hcon);
 934                 __sco_chan_add(conn, sk, parent);
 935
 936                 if (test_bit(BT_SK_DEFER_SETUP, &bt_sk(parent)->flags))
 937                         sk->sk_state = BT_CONNECT2;
 938                 else
 939                         sk->sk_state = BT_CONNECTED;
 940
 941                 /* Wake up parent */
 942                 parent->sk_data_ready(parent, 1);
 943
 944                 bh_unlock_sock(parent);
 945
 946                 sco_conn_unlock(conn);
 947         }
 948 }
 949
 950 /* ----- SCO interface with lower layer (HCI) ----- */
 951 int sco_connect_ind(struct hci_dev *hdev, bdaddr_t *bdaddr, __u8 *flags)
 952 {
 953         struct sock *sk;
 954         struct hlist_node *node;
 955         int lm = 0;
 956
 957         BT_DBG("hdev %s, bdaddr %pMR", hdev->name, bdaddr);
 958
 959         /* Find listening sockets */
 960         read_lock(&sco_sk_list.lock);
 961         sk_for_each(sk, node, &sco_sk_list.head) {
 962                 if (sk->sk_state != BT_LISTEN)
 963                         continue;
 964
 965                 if (!bacmp(&bt_sk(sk)->src, &hdev->bdaddr) ||
 966                     !bacmp(&bt_sk(sk)->src, BDADDR_ANY)) {
 967                         lm |= HCI_LM_ACCEPT;
 968
 969                         if (test_bit(BT_SK_DEFER_SETUP, &bt_sk(sk)->flags))
 970                                 *flags |= HCI_PROTO_DEFER;
 971                         break;
 972                 }
 973         }
 974         read_unlock(&sco_sk_list.lock);
 975
 976         return lm;
 977 }
 978
 979 void sco_connect_cfm(struct hci_conn *hcon, __u8 status)
 980 {
 981         BT_DBG("hcon %p bdaddr %pMR status %d", hcon, &hcon->dst, status);
 982         if (!status) {
 983                 struct sco_conn *conn;
 984
 985                 conn = sco_conn_add(hcon);
 986                 if (conn)
 987                         sco_conn_ready(conn);
 988         } else
 989                 sco_conn_del(hcon, bt_to_errno(status));
 990 }
 991
 992 void sco_disconn_cfm(struct hci_conn *hcon, __u8 reason)
 993 {
 994         BT_DBG("hcon %p reason %d", hcon, reason);
 995
 996         sco_conn_del(hcon, bt_to_errno(reason));
 997 }
 998
 999 int sco_recv_scodata(struct hci_conn *hcon, struct sk_buff *skb)
1000 {
1001         struct sco_conn *conn = hcon->sco_data;
1002
1003         if (!conn)
1004                 goto drop;
1005
1006         BT_DBG("conn %p len %d", conn, skb->len);
1007
1008         if (skb->len) {
1009                 sco_recv_frame(conn, skb);
1010                 return 0;
1011         }
1012
1013 drop:
1014         kfree_skb(skb);
1015         return 0;
1016 }
1017
1018 static int sco_debugfs_show(struct seq_file *f, void *p)
1019 {
1020         struct sock *sk;
1021         struct hlist_node *node;
1022
1023         read_lock(&sco_sk_list.lock);
1024
1025         sk_for_each(sk, node, &sco_sk_list.head) {
1026                 seq_printf(f, "%pMR %pMR %d\n", &bt_sk(sk)->src,
1027                            &bt_sk(sk)->dst, sk->sk_state);
1028         }
1029
1030         read_unlock(&sco_sk_list.lock);
1031
1032         return 0;
1033 }
1034
1035 static int sco_debugfs_open(struct inode *inode, struct file *file)
1036 {
1037         return single_open(file, sco_debugfs_show, inode->i_private);
1038 }
1039
1040 static const struct file_operations sco_debugfs_fops = {
1041         .open           = sco_debugfs_open,
1042         .read           = seq_read,
1043         .llseek         = seq_lseek,
1044         .release        = single_release,
1045 };
1046
1047 static struct dentry *sco_debugfs;
1048
1049 static const struct proto_ops sco_sock_ops = {
1050         .family         = PF_BLUETOOTH,
1051         .owner          = THIS_MODULE,
1052         .release        = sco_sock_release,
1053         .bind           = sco_sock_bind,
1054         .connect        = sco_sock_connect,
1055         .listen         = sco_sock_listen,
1056         .accept         = sco_sock_accept,
1057         .getname        = sco_sock_getname,
1058         .sendmsg        = sco_sock_sendmsg,
1059         .recvmsg        = sco_sock_recvmsg,
1060         .poll           = bt_sock_poll,
1061         .ioctl          = bt_sock_ioctl,
1062         .mmap           = sock_no_mmap,
1063         .socketpair     = sock_no_socketpair,
1064         .shutdown       = sco_sock_shutdown,
1065         .setsockopt     = sco_sock_setsockopt,
1066         .getsockopt     = sco_sock_getsockopt
1067 };
1068
1069 static const struct net_proto_family sco_sock_family_ops = {
1070         .family = PF_BLUETOOTH,
1071         .owner  = THIS_MODULE,
1072         .create = sco_sock_create,
1073 };
1074
1075 int __init sco_init(void)
1076 {
1077         int err;
1078
1079         err = proto_register(&sco_proto, 0);
1080         if (err < 0)
1081                 return err;
1082
1083         err = bt_sock_register(BTPROTO_SCO, &sco_sock_family_ops);
1084         if (err < 0) {
1085                 BT_ERR("SCO socket registration failed");
1086                 goto error;
1087         }
1088
1089         err = bt_procfs_init(THIS_MODULE, &init_net, "sco", &sco_sk_list, NULL);
1090         if (err < 0) {
1091                 BT_ERR("Failed to create SCO proc file");
1092                 bt_sock_unregister(BTPROTO_SCO);
1093                 goto error;
1094         }
1095
1096         if (bt_debugfs) {
1097                 sco_debugfs = debugfs_create_file("sco", 0444, bt_debugfs,
1098                                                   NULL, &sco_debugfs_fops);
1099                 if (!sco_debugfs)
1100                         BT_ERR("Failed to create SCO debug file");
1101         }
1102
1103         BT_INFO("SCO socket layer initialized");
1104
1105         return 0;
1106
1107 error:
1108         proto_unregister(&sco_proto);
1109         return err;
1110 }
1111
1112 void __exit sco_exit(void)
1113 {
1114         bt_procfs_cleanup(&init_net, "sco");
1115
1116         debugfs_remove(sco_debugfs);
1117
1118         if (bt_sock_unregister(BTPROTO_SCO) < 0)
1119                 BT_ERR("SCO socket unregistration failed");
1120
1121         proto_unregister(&sco_proto);
1122 }
1123
1124 module_param(disable_esco, bool, 0644);
1125 MODULE_PARM_DESC(disable_esco, "Disable eSCO connection creation");