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 sock *sk; 263 264 sk_for_each(sk, &sco_sk_list.head) { 265 if (sk->sk_state != BT_LISTEN) 266 continue; 267 268 if (!bacmp(&bt_sk(sk)->src, ba)) 269 return sk; 270 } 271 272 return NULL; 273 } 274 275 /* Find socket listening on source bdaddr. 276 * Returns closest match. 277 */ 278 static struct sock *sco_get_sock_listen(bdaddr_t *src) 279 { 280 struct sock *sk = NULL, *sk1 = NULL; 281 282 read_lock(&sco_sk_list.lock); 283 284 sk_for_each(sk, &sco_sk_list.head) { 285 if (sk->sk_state != BT_LISTEN) 286 continue; 287 288 /* Exact match. */ 289 if (!bacmp(&bt_sk(sk)->src, src)) 290 break; 291 292 /* Closest match */ 293 if (!bacmp(&bt_sk(sk)->src, BDADDR_ANY)) 294 sk1 = sk; 295 } 296 297 read_unlock(&sco_sk_list.lock); 298 299 return sk ? sk : sk1; 300 } 301 302 static void sco_sock_destruct(struct sock *sk) 303 { 304 BT_DBG("sk %p", sk); 305 306 skb_queue_purge(&sk->sk_receive_queue); 307 skb_queue_purge(&sk->sk_write_queue); 308 } 309 310 static void sco_sock_cleanup_listen(struct sock *parent) 311 { 312 struct sock *sk; 313 314 BT_DBG("parent %p", parent); 315 316 /* Close not yet accepted channels */ 317 while ((sk = bt_accept_dequeue(parent, NULL))) { 318 sco_sock_close(sk); 319 sco_sock_kill(sk); 320 } 321 322 parent->sk_state = BT_CLOSED; 323 sock_set_flag(parent, SOCK_ZAPPED); 324 } 325 326 /* Kill socket (only if zapped and orphan) 327 * Must be called on unlocked socket. 328 */ 329 static void sco_sock_kill(struct sock *sk) 330 { 331 if (!sock_flag(sk, SOCK_ZAPPED) || sk->sk_socket) 332 return; 333 334 BT_DBG("sk %p state %d", sk, sk->sk_state); 335 336 /* Kill poor orphan */ 337 bt_sock_unlink(&sco_sk_list, sk); 338 sock_set_flag(sk, SOCK_DEAD); 339 sock_put(sk); 340 } 341 342 static void __sco_sock_close(struct sock *sk) 343 { 344 BT_DBG("sk %p state %d socket %p", sk, sk->sk_state, sk->sk_socket); 345 346 switch (sk->sk_state) { 347 case BT_LISTEN: 348 sco_sock_cleanup_listen(sk); 349 break; 350 351 case BT_CONNECTED: 352 case BT_CONFIG: 353 if (sco_pi(sk)->conn->hcon) { 354 sk->sk_state = BT_DISCONN; 355 sco_sock_set_timer(sk, SCO_DISCONN_TIMEOUT); 356 hci_conn_put(sco_pi(sk)->conn->hcon); 357 sco_pi(sk)->conn->hcon = NULL; 358 } else 359 sco_chan_del(sk, ECONNRESET); 360 break; 361 362 case BT_CONNECT2: 363 case BT_CONNECT: 364 case BT_DISCONN: 365 sco_chan_del(sk, ECONNRESET); 366 break; 367 368 default: 369 sock_set_flag(sk, SOCK_ZAPPED); 370 break; 371 } 372 } 373 374 /* Must be called on unlocked socket. */ 375 static void sco_sock_close(struct sock *sk) 376 { 377 sco_sock_clear_timer(sk); 378 lock_sock(sk); 379 __sco_sock_close(sk); 380 release_sock(sk); 381 sco_sock_kill(sk); 382 } 383 384 static void sco_sock_init(struct sock *sk, struct sock *parent) 385 { 386 BT_DBG("sk %p", sk); 387 388 if (parent) { 389 sk->sk_type = parent->sk_type; 390 bt_sk(sk)->flags = bt_sk(parent)->flags; 391 security_sk_clone(parent, sk); 392 } 393 } 394 395 static struct proto sco_proto = { 396 .name = "SCO", 397 .owner = THIS_MODULE, 398 .obj_size = sizeof(struct sco_pinfo) 399 }; 400 401 static struct sock *sco_sock_alloc(struct net *net, struct socket *sock, int proto, gfp_t prio) 402 { 403 struct sock *sk; 404 405 sk = sk_alloc(net, PF_BLUETOOTH, prio, &sco_proto); 406 if (!sk) 407 return NULL; 408 409 sock_init_data(sock, sk); 410 INIT_LIST_HEAD(&bt_sk(sk)->accept_q); 411 412 sk->sk_destruct = sco_sock_destruct; 413 sk->sk_sndtimeo = SCO_CONN_TIMEOUT; 414 415 sock_reset_flag(sk, SOCK_ZAPPED); 416 417 sk->sk_protocol = proto; 418 sk->sk_state = BT_OPEN; 419 420 setup_timer(&sk->sk_timer, sco_sock_timeout, (unsigned long)sk); 421 422 bt_sock_link(&sco_sk_list, sk); 423 return sk; 424 } 425 426 static int sco_sock_create(struct net *net, struct socket *sock, int protocol, 427 int kern) 428 { 429 struct sock *sk; 430 431 BT_DBG("sock %p", sock); 432 433 sock->state = SS_UNCONNECTED; 434 435 if (sock->type != SOCK_SEQPACKET) 436 return -ESOCKTNOSUPPORT; 437 438 sock->ops = &sco_sock_ops; 439 440 sk = sco_sock_alloc(net, sock, protocol, GFP_ATOMIC); 441 if (!sk) 442 return -ENOMEM; 443 444 sco_sock_init(sk, NULL); 445 return 0; 446 } 447 448 static int sco_sock_bind(struct socket *sock, struct sockaddr *addr, int addr_len) 449 { 450 struct sockaddr_sco *sa = (struct sockaddr_sco *) addr; 451 struct sock *sk = sock->sk; 452 int err = 0; 453 454 BT_DBG("sk %p %pMR", sk, &sa->sco_bdaddr); 455 456 if (!addr || addr->sa_family != AF_BLUETOOTH) 457 return -EINVAL; 458 459 lock_sock(sk); 460 461 if (sk->sk_state != BT_OPEN) { 462 err = -EBADFD; 463 goto done; 464 } 465 466 if (sk->sk_type != SOCK_SEQPACKET) { 467 err = -EINVAL; 468 goto done; 469 } 470 471 bacpy(&bt_sk(sk)->src, &sa->sco_bdaddr); 472 473 sk->sk_state = BT_BOUND; 474 475 done: 476 release_sock(sk); 477 return err; 478 } 479 480 static int sco_sock_connect(struct socket *sock, struct sockaddr *addr, int alen, int flags) 481 { 482 struct sockaddr_sco *sa = (struct sockaddr_sco *) addr; 483 struct sock *sk = sock->sk; 484 int err = 0; 485 486 487 BT_DBG("sk %p", sk); 488 489 if (alen < sizeof(struct sockaddr_sco) || 490 addr->sa_family != AF_BLUETOOTH) 491 return -EINVAL; 492 493 if (sk->sk_state != BT_OPEN && sk->sk_state != BT_BOUND) 494 return -EBADFD; 495 496 if (sk->sk_type != SOCK_SEQPACKET) 497 return -EINVAL; 498 499 lock_sock(sk); 500 501 /* Set destination address and psm */ 502 bacpy(&bt_sk(sk)->dst, &sa->sco_bdaddr); 503 504 err = sco_connect(sk); 505 if (err) 506 goto done; 507 508 err = bt_sock_wait_state(sk, BT_CONNECTED, 509 sock_sndtimeo(sk, flags & O_NONBLOCK)); 510 511 done: 512 release_sock(sk); 513 return err; 514 } 515 516 static int sco_sock_listen(struct socket *sock, int backlog) 517 { 518 struct sock *sk = sock->sk; 519 bdaddr_t *src = &bt_sk(sk)->src; 520 int err = 0; 521 522 BT_DBG("sk %p backlog %d", sk, backlog); 523 524 lock_sock(sk); 525 526 if (sk->sk_state != BT_BOUND) { 527 err = -EBADFD; 528 goto done; 529 } 530 531 if (sk->sk_type != SOCK_SEQPACKET) { 532 err = -EINVAL; 533 goto done; 534 } 535 536 write_lock(&sco_sk_list.lock); 537 538 if (__sco_get_sock_listen_by_addr(src)) { 539 err = -EADDRINUSE; 540 goto unlock; 541 } 542 543 sk->sk_max_ack_backlog = backlog; 544 sk->sk_ack_backlog = 0; 545 546 sk->sk_state = BT_LISTEN; 547 548 unlock: 549 write_unlock(&sco_sk_list.lock); 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 timeo = sock_rcvtimeo(sk, flags & O_NONBLOCK); 566 567 BT_DBG("sk %p timeo %ld", sk, timeo); 568 569 /* Wait for an incoming connection. (wake-one). */ 570 add_wait_queue_exclusive(sk_sleep(sk), &wait); 571 while (1) { 572 set_current_state(TASK_INTERRUPTIBLE); 573 574 if (sk->sk_state != BT_LISTEN) { 575 err = -EBADFD; 576 break; 577 } 578 579 ch = bt_accept_dequeue(sk, newsock); 580 if (ch) 581 break; 582 583 if (!timeo) { 584 err = -EAGAIN; 585 break; 586 } 587 588 if (signal_pending(current)) { 589 err = sock_intr_errno(timeo); 590 break; 591 } 592 593 release_sock(sk); 594 timeo = schedule_timeout(timeo); 595 lock_sock(sk); 596 } 597 __set_current_state(TASK_RUNNING); 598 remove_wait_queue(sk_sleep(sk), &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; 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_recvmsg(struct kiocb *iocb, struct socket *sock, 657 struct msghdr *msg, size_t len, int flags) 658 { 659 struct sock *sk = sock->sk; 660 struct sco_pinfo *pi = sco_pi(sk); 661 662 lock_sock(sk); 663 664 if (sk->sk_state == BT_CONNECT2 && 665 test_bit(BT_SK_DEFER_SETUP, &bt_sk(sk)->flags)) { 666 hci_conn_accept(pi->conn->hcon, 0); 667 sk->sk_state = BT_CONFIG; 668 msg->msg_namelen = 0; 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 int lm = 0; 955 956 BT_DBG("hdev %s, bdaddr %pMR", hdev->name, bdaddr); 957 958 /* Find listening sockets */ 959 read_lock(&sco_sk_list.lock); 960 sk_for_each(sk, &sco_sk_list.head) { 961 if (sk->sk_state != BT_LISTEN) 962 continue; 963 964 if (!bacmp(&bt_sk(sk)->src, &hdev->bdaddr) || 965 !bacmp(&bt_sk(sk)->src, BDADDR_ANY)) { 966 lm |= HCI_LM_ACCEPT; 967 968 if (test_bit(BT_SK_DEFER_SETUP, &bt_sk(sk)->flags)) 969 *flags |= HCI_PROTO_DEFER; 970 break; 971 } 972 } 973 read_unlock(&sco_sk_list.lock); 974 975 return lm; 976 } 977 978 void sco_connect_cfm(struct hci_conn *hcon, __u8 status) 979 { 980 BT_DBG("hcon %p bdaddr %pMR status %d", hcon, &hcon->dst, status); 981 if (!status) { 982 struct sco_conn *conn; 983 984 conn = sco_conn_add(hcon); 985 if (conn) 986 sco_conn_ready(conn); 987 } else 988 sco_conn_del(hcon, bt_to_errno(status)); 989 } 990 991 void sco_disconn_cfm(struct hci_conn *hcon, __u8 reason) 992 { 993 BT_DBG("hcon %p reason %d", hcon, reason); 994 995 sco_conn_del(hcon, bt_to_errno(reason)); 996 } 997 998 int sco_recv_scodata(struct hci_conn *hcon, struct sk_buff *skb) 999 { 1000 struct sco_conn *conn = hcon->sco_data; 1001 1002 if (!conn) 1003 goto drop; 1004 1005 BT_DBG("conn %p len %d", conn, skb->len); 1006 1007 if (skb->len) { 1008 sco_recv_frame(conn, skb); 1009 return 0; 1010 } 1011 1012 drop: 1013 kfree_skb(skb); 1014 return 0; 1015 } 1016 1017 static int sco_debugfs_show(struct seq_file *f, void *p) 1018 { 1019 struct sock *sk; 1020 1021 read_lock(&sco_sk_list.lock); 1022 1023 sk_for_each(sk, &sco_sk_list.head) { 1024 seq_printf(f, "%pMR %pMR %d\n", &bt_sk(sk)->src, 1025 &bt_sk(sk)->dst, sk->sk_state); 1026 } 1027 1028 read_unlock(&sco_sk_list.lock); 1029 1030 return 0; 1031 } 1032 1033 static int sco_debugfs_open(struct inode *inode, struct file *file) 1034 { 1035 return single_open(file, sco_debugfs_show, inode->i_private); 1036 } 1037 1038 static const struct file_operations sco_debugfs_fops = { 1039 .open = sco_debugfs_open, 1040 .read = seq_read, 1041 .llseek = seq_lseek, 1042 .release = single_release, 1043 }; 1044 1045 static struct dentry *sco_debugfs; 1046 1047 static const struct proto_ops sco_sock_ops = { 1048 .family = PF_BLUETOOTH, 1049 .owner = THIS_MODULE, 1050 .release = sco_sock_release, 1051 .bind = sco_sock_bind, 1052 .connect = sco_sock_connect, 1053 .listen = sco_sock_listen, 1054 .accept = sco_sock_accept, 1055 .getname = sco_sock_getname, 1056 .sendmsg = sco_sock_sendmsg, 1057 .recvmsg = sco_sock_recvmsg, 1058 .poll = bt_sock_poll, 1059 .ioctl = bt_sock_ioctl, 1060 .mmap = sock_no_mmap, 1061 .socketpair = sock_no_socketpair, 1062 .shutdown = sco_sock_shutdown, 1063 .setsockopt = sco_sock_setsockopt, 1064 .getsockopt = sco_sock_getsockopt 1065 }; 1066 1067 static const struct net_proto_family sco_sock_family_ops = { 1068 .family = PF_BLUETOOTH, 1069 .owner = THIS_MODULE, 1070 .create = sco_sock_create, 1071 }; 1072 1073 int __init sco_init(void) 1074 { 1075 int err; 1076 1077 err = proto_register(&sco_proto, 0); 1078 if (err < 0) 1079 return err; 1080 1081 err = bt_sock_register(BTPROTO_SCO, &sco_sock_family_ops); 1082 if (err < 0) { 1083 BT_ERR("SCO socket registration failed"); 1084 goto error; 1085 } 1086 1087 err = bt_procfs_init(THIS_MODULE, &init_net, "sco", &sco_sk_list, NULL); 1088 if (err < 0) { 1089 BT_ERR("Failed to create SCO proc file"); 1090 bt_sock_unregister(BTPROTO_SCO); 1091 goto error; 1092 } 1093 1094 if (bt_debugfs) { 1095 sco_debugfs = debugfs_create_file("sco", 0444, bt_debugfs, 1096 NULL, &sco_debugfs_fops); 1097 if (!sco_debugfs) 1098 BT_ERR("Failed to create SCO debug file"); 1099 } 1100 1101 BT_INFO("SCO socket layer initialized"); 1102 1103 return 0; 1104 1105 error: 1106 proto_unregister(&sco_proto); 1107 return err; 1108 } 1109 1110 void __exit sco_exit(void) 1111 { 1112 bt_procfs_cleanup(&init_net, "sco"); 1113 1114 debugfs_remove(sco_debugfs); 1115 1116 if (bt_sock_unregister(BTPROTO_SCO) < 0) 1117 BT_ERR("SCO socket unregistration failed"); 1118 1119 proto_unregister(&sco_proto); 1120 } 1121 1122 module_param(disable_esco, bool, 0644); 1123 MODULE_PARM_DESC(disable_esco, "Disable eSCO connection creation"); 1124