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