release/src-rt-6.x/linux/linux-2.6/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
  29 #include <linux/types.h>
  30 #include <linux/list.h>
  31 #include <linux/errno.h>
  32 #include <linux/kernel.h>
  33 #include <linux/sched.h>
  34 #include <linux/slab.h>
  35 #include <linux/skbuff.h>
  36 #include <linux/init.h>
  37 #include <linux/poll.h>
  38 #include <net/sock.h>
  39
  40 #if defined(CONFIG_KMOD)
  41 #include <linux/kmod.h>
  42 #endif
  43
  44 #include <net/bluetooth/bluetooth.h>
  45
  46 #ifndef CONFIG_BT_SOCK_DEBUG
  47 #undef  BT_DBG
  48 #define BT_DBG(D...)
  49 #endif
  50
  51 #define VERSION "2.11"
  52
  53 /* Bluetooth sockets */
  54 #define BT_MAX_PROTO    8
  55 static struct net_proto_family *bt_proto[BT_MAX_PROTO];
  56 static DEFINE_RWLOCK(bt_proto_lock);
  57
  58 int bt_sock_register(int proto, struct net_proto_family *ops)
  59 {
  60         int err = 0;
  61
  62         if (proto < 0 || proto >= BT_MAX_PROTO)
  63                 return -EINVAL;
  64
  65         write_lock(&bt_proto_lock);
  66
  67         if (bt_proto[proto])
  68                 err = -EEXIST;
  69         else
  70                 bt_proto[proto] = ops;
  71
  72         write_unlock(&bt_proto_lock);
  73
  74         return err;
  75 }
  76 EXPORT_SYMBOL(bt_sock_register);
  77
  78 int bt_sock_unregister(int proto)
  79 {
  80         int err = 0;
  81
  82         if (proto < 0 || proto >= BT_MAX_PROTO)
  83                 return -EINVAL;
  84
  85         write_lock(&bt_proto_lock);
  86
  87         if (!bt_proto[proto])
  88                 err = -ENOENT;
  89         else
  90                 bt_proto[proto] = NULL;
  91
  92         write_unlock(&bt_proto_lock);
  93
  94         return err;
  95 }
  96 EXPORT_SYMBOL(bt_sock_unregister);
  97
  98 static int bt_sock_create(struct socket *sock, int proto)
  99 {
 100         int err;
 101
 102         if (proto < 0 || proto >= BT_MAX_PROTO)
 103                 return -EINVAL;
 104
 105 #if defined(CONFIG_KMOD)
 106         if (!bt_proto[proto]) {
 107                 request_module("bt-proto-%d", proto);
 108         }
 109 #endif
 110
 111         err = -EPROTONOSUPPORT;
 112
 113         read_lock(&bt_proto_lock);
 114
 115         if (bt_proto[proto] && try_module_get(bt_proto[proto]->owner)) {
 116                 err = bt_proto[proto]->create(sock, proto);
 117                 module_put(bt_proto[proto]->owner);
 118         }
 119
 120         read_unlock(&bt_proto_lock);
 121
 122         return err;
 123 }
 124
 125 void bt_sock_link(struct bt_sock_list *l, struct sock *sk)
 126 {
 127         write_lock_bh(&l->lock);
 128         sk_add_node(sk, &l->head);
 129         write_unlock_bh(&l->lock);
 130 }
 131 EXPORT_SYMBOL(bt_sock_link);
 132
 133 void bt_sock_unlink(struct bt_sock_list *l, struct sock *sk)
 134 {
 135         write_lock_bh(&l->lock);
 136         sk_del_node_init(sk);
 137         write_unlock_bh(&l->lock);
 138 }
 139 EXPORT_SYMBOL(bt_sock_unlink);
 140
 141 void bt_accept_enqueue(struct sock *parent, struct sock *sk)
 142 {
 143         BT_DBG("parent %p, sk %p", parent, sk);
 144
 145         sock_hold(sk);
 146         list_add_tail(&bt_sk(sk)->accept_q, &bt_sk(parent)->accept_q);
 147         bt_sk(sk)->parent = parent;
 148         parent->sk_ack_backlog++;
 149 }
 150 EXPORT_SYMBOL(bt_accept_enqueue);
 151
 152 void bt_accept_unlink(struct sock *sk)
 153 {
 154         BT_DBG("sk %p state %d", sk, sk->sk_state);
 155
 156         list_del_init(&bt_sk(sk)->accept_q);
 157         bt_sk(sk)->parent->sk_ack_backlog--;
 158         bt_sk(sk)->parent = NULL;
 159         sock_put(sk);
 160 }
 161 EXPORT_SYMBOL(bt_accept_unlink);
 162
 163 struct sock *bt_accept_dequeue(struct sock *parent, struct socket *newsock)
 164 {
 165         struct list_head *p, *n;
 166         struct sock *sk;
 167
 168         BT_DBG("parent %p", parent);
 169
 170         list_for_each_safe(p, n, &bt_sk(parent)->accept_q) {
 171                 sk = (struct sock *) list_entry(p, struct bt_sock, accept_q);
 172
 173                 lock_sock(sk);
 174
 175                 /* FIXME: Is this check still needed */
 176                 if (sk->sk_state == BT_CLOSED) {
 177                         release_sock(sk);
 178                         bt_accept_unlink(sk);
 179                         continue;
 180                 }
 181
 182                 if (sk->sk_state == BT_CONNECTED || !newsock) {
 183                         bt_accept_unlink(sk);
 184                         if (newsock)
 185                                 sock_graft(sk, newsock);
 186                         release_sock(sk);
 187                         return sk;
 188                 }
 189
 190                 release_sock(sk);
 191         }
 192         return NULL;
 193 }
 194 EXPORT_SYMBOL(bt_accept_dequeue);
 195
 196 int bt_sock_recvmsg(struct kiocb *iocb, struct socket *sock,
 197         struct msghdr *msg, size_t len, int flags)
 198 {
 199         int noblock = flags & MSG_DONTWAIT;
 200         struct sock *sk = sock->sk;
 201         struct sk_buff *skb;
 202         size_t copied;
 203         int err;
 204
 205         BT_DBG("sock %p sk %p len %d", sock, sk, len);
 206
 207         if (flags & (MSG_OOB))
 208                 return -EOPNOTSUPP;
 209
 210         if (!(skb = skb_recv_datagram(sk, flags, noblock, &err))) {
 211                 if (sk->sk_shutdown & RCV_SHUTDOWN)
 212                         return 0;
 213                 return err;
 214         }
 215
 216         msg->msg_namelen = 0;
 217
 218         copied = skb->len;
 219         if (len < copied) {
 220                 msg->msg_flags |= MSG_TRUNC;
 221                 copied = len;
 222         }
 223
 224         skb_reset_transport_header(skb);
 225         err = skb_copy_datagram_iovec(skb, 0, msg->msg_iov, copied);
 226
 227         skb_free_datagram(sk, skb);
 228
 229         return err ? : copied;
 230 }
 231 EXPORT_SYMBOL(bt_sock_recvmsg);
 232
 233 static inline unsigned int bt_accept_poll(struct sock *parent)
 234 {
 235         struct list_head *p, *n;
 236         struct sock *sk;
 237
 238         list_for_each_safe(p, n, &bt_sk(parent)->accept_q) {
 239                 sk = (struct sock *) list_entry(p, struct bt_sock, accept_q);
 240                 if (sk->sk_state == BT_CONNECTED)
 241                         return POLLIN | POLLRDNORM;
 242         }
 243
 244         return 0;
 245 }
 246
 247 unsigned int bt_sock_poll(struct file * file, struct socket *sock, poll_table *wait)
 248 {
 249         struct sock *sk = sock->sk;
 250         unsigned int mask = 0;
 251
 252         BT_DBG("sock %p, sk %p", sock, sk);
 253
 254         poll_wait(file, sk->sk_sleep, wait);
 255
 256         if (sk->sk_state == BT_LISTEN)
 257                 return bt_accept_poll(sk);
 258
 259         if (sk->sk_err || !skb_queue_empty(&sk->sk_error_queue))
 260                 mask |= POLLERR;
 261
 262         if (sk->sk_shutdown & RCV_SHUTDOWN)
 263                 mask |= POLLRDHUP | POLLIN | POLLRDNORM;
 264
 265         if (sk->sk_shutdown == SHUTDOWN_MASK)
 266                 mask |= POLLHUP;
 267
 268         if (!skb_queue_empty(&sk->sk_receive_queue))
 269                 mask |= POLLIN | POLLRDNORM;
 270
 271         if (sk->sk_state == BT_CLOSED)
 272                 mask |= POLLHUP;
 273
 274         if (sk->sk_state == BT_CONNECT ||
 275                         sk->sk_state == BT_CONNECT2 ||
 276                         sk->sk_state == BT_CONFIG)
 277                 return mask;
 278
 279         if (sock_writeable(sk))
 280                 mask |= POLLOUT | POLLWRNORM | POLLWRBAND;
 281         else
 282                 set_bit(SOCK_ASYNC_NOSPACE, &sk->sk_socket->flags);
 283
 284         return mask;
 285 }
 286 EXPORT_SYMBOL(bt_sock_poll);
 287
 288 int bt_sock_wait_state(struct sock *sk, int state, unsigned long timeo)
 289 {
 290         DECLARE_WAITQUEUE(wait, current);
 291         int err = 0;
 292
 293         BT_DBG("sk %p", sk);
 294
 295         add_wait_queue(sk->sk_sleep, &wait);
 296         while (sk->sk_state != state) {
 297                 set_current_state(TASK_INTERRUPTIBLE);
 298
 299                 if (!timeo) {
 300                         err = -EINPROGRESS;
 301                         break;
 302                 }
 303
 304                 if (signal_pending(current)) {
 305                         err = sock_intr_errno(timeo);
 306                         break;
 307                 }
 308
 309                 release_sock(sk);
 310                 timeo = schedule_timeout(timeo);
 311                 lock_sock(sk);
 312
 313                 err = sock_error(sk);
 314                 if (err)
 315                         break;
 316         }
 317         set_current_state(TASK_RUNNING);
 318         remove_wait_queue(sk->sk_sleep, &wait);
 319         return err;
 320 }
 321 EXPORT_SYMBOL(bt_sock_wait_state);
 322
 323 static struct net_proto_family bt_sock_family_ops = {
 324         .owner  = THIS_MODULE,
 325         .family = PF_BLUETOOTH,
 326         .create = bt_sock_create,
 327 };
 328
 329 static int __init bt_init(void)
 330 {
 331         int err;
 332
 333         BT_INFO("Core ver %s", VERSION);
 334
 335         err = bt_sysfs_init();
 336         if (err < 0)
 337                 return err;
 338
 339         err = sock_register(&bt_sock_family_ops);
 340         if (err < 0) {
 341                 bt_sysfs_cleanup();
 342                 return err;
 343         }
 344
 345         BT_INFO("HCI device and connection manager initialized");
 346
 347         hci_sock_init();
 348
 349         return 0;
 350 }
 351
 352 static void __exit bt_exit(void)
 353 {
 354         hci_sock_cleanup();
 355
 356         sock_unregister(PF_BLUETOOTH);
 357
 358         bt_sysfs_cleanup();
 359 }
 360
 361 subsys_initcall(bt_init);
 362 module_exit(bt_exit);
 363
 364 MODULE_AUTHOR("Maxim Krasnyansky <maxk@qualcomm.com>, Marcel Holtmann <marcel@holtmann.org>");
 365 MODULE_DESCRIPTION("Bluetooth Core ver " VERSION);
 366 MODULE_VERSION(VERSION);
 367 MODULE_LICENSE("GPL");
 368 MODULE_ALIAS_NETPROTO(PF_BLUETOOTH);