net/bluetooth/bnep/sock.c

   1 /*
   2    BNEP implementation for Linux Bluetooth stack (BlueZ).
   3    Copyright (C) 2001-2002 Inventel Systemes
   4    Written 2001-2002 by
   5         David Libault  <david.libault@inventel.fr>
   6
   7    Copyright (C) 2002 Maxim Krasnyansky <maxk@qualcomm.com>
   8
   9    This program is free software; you can redistribute it and/or modify
  10    it under the terms of the GNU General Public License version 2 as
  11    published by the Free Software Foundation;
  12
  13    THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
  14    OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  15    FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
  16    IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
  17    CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
  18    WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  19    ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  20    OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  21
  22    ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
  23    COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
  24    SOFTWARE IS DISCLAIMED.
  25 */
  26
  27 /*
  28  * $Id: sock.c,v 1.4 2002/08/04 21:23:58 maxk Exp $
  29  */
  30
  31 #include <linux/config.h>
  32 #include <linux/module.h>
  33
  34 #include <linux/types.h>
  35 #include <linux/errno.h>
  36 #include <linux/kernel.h>
  37 #include <linux/sched.h>
  38 #include <linux/slab.h>
  39 #include <linux/poll.h>
  40 #include <linux/fcntl.h>
  41 #include <linux/skbuff.h>
  42 #include <linux/socket.h>
  43 #include <linux/ioctl.h>
  44 #include <linux/file.h>
  45 #include <linux/init.h>
  46 #include <net/sock.h>
  47
  48 #include <asm/system.h>
  49 #include <asm/uaccess.h>
  50
  51 #include "bnep.h"
  52
  53 #ifndef CONFIG_BT_BNEP_DEBUG
  54 #undef  BT_DBG
  55 #define BT_DBG( A... )
  56 #endif
  57
  58 static int bnep_sock_release(struct socket *sock)
  59 {
  60         struct sock *sk = sock->sk;
  61
  62         BT_DBG("sock %p sk %p", sock, sk);
  63
  64         if (!sk)
  65                 return 0;
  66
  67         sock_orphan(sk);
  68         sock_put(sk);
  69         return 0;
  70 }
  71
  72 static int bnep_sock_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
  73 {
  74         struct bnep_connlist_req cl;
  75         struct bnep_connadd_req  ca;
  76         struct bnep_conndel_req  cd;
  77         struct bnep_conninfo ci;
  78         struct socket *nsock;
  79         void __user *argp = (void __user *)arg;
  80         int err;
  81
  82         BT_DBG("cmd %x arg %lx", cmd, arg);
  83
  84         switch (cmd) {
  85         case BNEPCONNADD:
  86                 if (!capable(CAP_NET_ADMIN))
  87                         return -EACCES;
  88
  89                 if (copy_from_user(&ca, argp, sizeof(ca)))
  90                         return -EFAULT;
  91
  92                 nsock = sockfd_lookup(ca.sock, &err);
  93                 if (!nsock)
  94                         return err;
  95
  96                 if (nsock->sk->sk_state != BT_CONNECTED) {
  97                         fput(nsock->file);
  98                         return -EBADFD;
  99                 }
 100
 101                 err = bnep_add_connection(&ca, nsock);
 102                 if (!err) {
 103                         if (copy_to_user(argp, &ca, sizeof(ca)))
 104                                 err = -EFAULT;
 105                 } else
 106                         fput(nsock->file);
 107
 108                 return err;
 109
 110         case BNEPCONNDEL:
 111                 if (!capable(CAP_NET_ADMIN))
 112                         return -EACCES;
 113
 114                 if (copy_from_user(&cd, argp, sizeof(cd)))
 115                         return -EFAULT;
 116
 117                 return bnep_del_connection(&cd);
 118
 119         case BNEPGETCONNLIST:
 120                 if (copy_from_user(&cl, argp, sizeof(cl)))
 121                         return -EFAULT;
 122
 123                 if (cl.cnum <= 0)
 124                         return -EINVAL;
 125
 126                 err = bnep_get_connlist(&cl);
 127                 if (!err && copy_to_user(argp, &cl, sizeof(cl)))
 128                         return -EFAULT;
 129
 130                 return err;
 131
 132         case BNEPGETCONNINFO:
 133                 if (copy_from_user(&ci, argp, sizeof(ci)))
 134                         return -EFAULT;
 135
 136                 err = bnep_get_conninfo(&ci);
 137                 if (!err && copy_to_user(argp, &ci, sizeof(ci)))
 138                         return -EFAULT;
 139
 140                 return err;
 141
 142         default:
 143                 return -EINVAL;
 144         }
 145
 146         return 0;
 147 }
 148
 149 static const struct proto_ops bnep_sock_ops = {
 150         .family     = PF_BLUETOOTH,
 151         .owner      = THIS_MODULE,
 152         .release    = bnep_sock_release,
 153         .ioctl      = bnep_sock_ioctl,
 154         .bind       = sock_no_bind,
 155         .getname    = sock_no_getname,
 156         .sendmsg    = sock_no_sendmsg,
 157         .recvmsg    = sock_no_recvmsg,
 158         .poll       = sock_no_poll,
 159         .listen     = sock_no_listen,
 160         .shutdown   = sock_no_shutdown,
 161         .setsockopt = sock_no_setsockopt,
 162         .getsockopt = sock_no_getsockopt,
 163         .connect    = sock_no_connect,
 164         .socketpair = sock_no_socketpair,
 165         .accept     = sock_no_accept,
 166         .mmap       = sock_no_mmap
 167 };
 168
 169 static struct proto bnep_proto = {
 170         .name           = "BNEP",
 171         .owner          = THIS_MODULE,
 172         .obj_size       = sizeof(struct bt_sock)
 173 };
 174
 175 static int bnep_sock_create(struct socket *sock, int protocol)
 176 {
 177         struct sock *sk;
 178
 179         BT_DBG("sock %p", sock);
 180
 181         if (sock->type != SOCK_RAW)
 182                 return -ESOCKTNOSUPPORT;
 183
 184         sk = sk_alloc(PF_BLUETOOTH, GFP_KERNEL, &bnep_proto, 1);
 185         if (!sk)
 186                 return -ENOMEM;
 187
 188         sock_init_data(sock, sk);
 189
 190         sock->ops = &bnep_sock_ops;
 191
 192         sock->state = SS_UNCONNECTED;
 193
 194         sock_reset_flag(sk, SOCK_ZAPPED);
 195
 196         sk->sk_protocol = protocol;
 197         sk->sk_state    = BT_OPEN;
 198
 199         return 0;
 200 }
 201
 202 static struct net_proto_family bnep_sock_family_ops = {
 203         .family = PF_BLUETOOTH,
 204         .owner  = THIS_MODULE,
 205         .create = bnep_sock_create
 206 };
 207
 208 int __init bnep_sock_init(void)
 209 {
 210         int err;
 211
 212         err = proto_register(&bnep_proto, 0);
 213         if (err < 0)
 214                 return err;
 215
 216         err = bt_sock_register(BTPROTO_BNEP, &bnep_sock_family_ops);
 217         if (err < 0)
 218                 goto error;
 219
 220         return 0;
 221
 222 error:
 223         BT_ERR("Can't register BNEP socket");
 224         proto_unregister(&bnep_proto);
 225         return err;
 226 }
 227
 228 int __exit bnep_sock_cleanup(void)
 229 {
 230         if (bt_sock_unregister(BTPROTO_BNEP) < 0)
 231                 BT_ERR("Can't unregister BNEP socket");
 232
 233         proto_unregister(&bnep_proto);
 234
 235         return 0;
 236 }