YOSHIFUJI Hideaki | 8e87d14 | 2007-02-09 23:24:33 +0900 | [diff] [blame] | 1 | /* |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 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 |
YOSHIFUJI Hideaki | 8e87d14 | 2007-02-09 23:24:33 +0900 | [diff] [blame] | 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 |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 20 | OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. |
| 21 | |
YOSHIFUJI Hideaki | 8e87d14 | 2007-02-09 23:24:33 +0900 | [diff] [blame] | 22 | ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS, |
| 23 | COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 24 | SOFTWARE IS DISCLAIMED. |
| 25 | */ |
| 26 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 27 | #include <linux/module.h> |
| 28 | |
| 29 | #include <linux/types.h> |
Randy Dunlap | 4fc268d | 2006-01-11 12:17:47 -0800 | [diff] [blame] | 30 | #include <linux/capability.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 31 | #include <linux/errno.h> |
| 32 | #include <linux/kernel.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 33 | #include <linux/slab.h> |
| 34 | #include <linux/poll.h> |
| 35 | #include <linux/fcntl.h> |
| 36 | #include <linux/skbuff.h> |
| 37 | #include <linux/socket.h> |
| 38 | #include <linux/ioctl.h> |
| 39 | #include <linux/file.h> |
| 40 | #include <linux/init.h> |
Marcel Holtmann | e9c5702 | 2006-10-15 17:30:22 +0200 | [diff] [blame] | 41 | #include <linux/compat.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 42 | #include <net/sock.h> |
| 43 | |
| 44 | #include <asm/system.h> |
| 45 | #include <asm/uaccess.h> |
| 46 | |
| 47 | #include "bnep.h" |
| 48 | |
| 49 | #ifndef CONFIG_BT_BNEP_DEBUG |
| 50 | #undef BT_DBG |
| 51 | #define BT_DBG( A... ) |
| 52 | #endif |
| 53 | |
| 54 | static int bnep_sock_release(struct socket *sock) |
| 55 | { |
| 56 | struct sock *sk = sock->sk; |
| 57 | |
| 58 | BT_DBG("sock %p sk %p", sock, sk); |
| 59 | |
| 60 | if (!sk) |
| 61 | return 0; |
| 62 | |
| 63 | sock_orphan(sk); |
| 64 | sock_put(sk); |
| 65 | return 0; |
| 66 | } |
| 67 | |
| 68 | static int bnep_sock_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg) |
| 69 | { |
| 70 | struct bnep_connlist_req cl; |
| 71 | struct bnep_connadd_req ca; |
| 72 | struct bnep_conndel_req cd; |
| 73 | struct bnep_conninfo ci; |
| 74 | struct socket *nsock; |
| 75 | void __user *argp = (void __user *)arg; |
| 76 | int err; |
| 77 | |
| 78 | BT_DBG("cmd %x arg %lx", cmd, arg); |
| 79 | |
| 80 | switch (cmd) { |
| 81 | case BNEPCONNADD: |
| 82 | if (!capable(CAP_NET_ADMIN)) |
| 83 | return -EACCES; |
| 84 | |
| 85 | if (copy_from_user(&ca, argp, sizeof(ca))) |
| 86 | return -EFAULT; |
YOSHIFUJI Hideaki | 8e87d14 | 2007-02-09 23:24:33 +0900 | [diff] [blame] | 87 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 88 | nsock = sockfd_lookup(ca.sock, &err); |
| 89 | if (!nsock) |
| 90 | return err; |
| 91 | |
| 92 | if (nsock->sk->sk_state != BT_CONNECTED) { |
Julia Lawall | 67b2321 | 2008-01-07 22:38:42 -0800 | [diff] [blame] | 93 | sockfd_put(nsock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 94 | return -EBADFD; |
| 95 | } |
| 96 | |
| 97 | err = bnep_add_connection(&ca, nsock); |
| 98 | if (!err) { |
YOSHIFUJI Hideaki | 8e87d14 | 2007-02-09 23:24:33 +0900 | [diff] [blame] | 99 | if (copy_to_user(argp, &ca, sizeof(ca))) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 100 | err = -EFAULT; |
| 101 | } else |
Julia Lawall | 67b2321 | 2008-01-07 22:38:42 -0800 | [diff] [blame] | 102 | sockfd_put(nsock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 103 | |
| 104 | return err; |
YOSHIFUJI Hideaki | 8e87d14 | 2007-02-09 23:24:33 +0900 | [diff] [blame] | 105 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 106 | case BNEPCONNDEL: |
| 107 | if (!capable(CAP_NET_ADMIN)) |
| 108 | return -EACCES; |
| 109 | |
| 110 | if (copy_from_user(&cd, argp, sizeof(cd))) |
| 111 | return -EFAULT; |
YOSHIFUJI Hideaki | 8e87d14 | 2007-02-09 23:24:33 +0900 | [diff] [blame] | 112 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 113 | return bnep_del_connection(&cd); |
| 114 | |
| 115 | case BNEPGETCONNLIST: |
| 116 | if (copy_from_user(&cl, argp, sizeof(cl))) |
| 117 | return -EFAULT; |
| 118 | |
| 119 | if (cl.cnum <= 0) |
| 120 | return -EINVAL; |
YOSHIFUJI Hideaki | 8e87d14 | 2007-02-09 23:24:33 +0900 | [diff] [blame] | 121 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 122 | err = bnep_get_connlist(&cl); |
| 123 | if (!err && copy_to_user(argp, &cl, sizeof(cl))) |
| 124 | return -EFAULT; |
| 125 | |
| 126 | return err; |
| 127 | |
| 128 | case BNEPGETCONNINFO: |
| 129 | if (copy_from_user(&ci, argp, sizeof(ci))) |
| 130 | return -EFAULT; |
| 131 | |
| 132 | err = bnep_get_conninfo(&ci); |
| 133 | if (!err && copy_to_user(argp, &ci, sizeof(ci))) |
| 134 | return -EFAULT; |
| 135 | |
| 136 | return err; |
| 137 | |
| 138 | default: |
| 139 | return -EINVAL; |
| 140 | } |
| 141 | |
| 142 | return 0; |
| 143 | } |
| 144 | |
Marcel Holtmann | e9c5702 | 2006-10-15 17:30:22 +0200 | [diff] [blame] | 145 | #ifdef CONFIG_COMPAT |
| 146 | static int bnep_sock_compat_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg) |
| 147 | { |
| 148 | if (cmd == BNEPGETCONNLIST) { |
| 149 | struct bnep_connlist_req cl; |
| 150 | uint32_t uci; |
| 151 | int err; |
| 152 | |
| 153 | if (get_user(cl.cnum, (uint32_t __user *) arg) || |
| 154 | get_user(uci, (u32 __user *) (arg + 4))) |
| 155 | return -EFAULT; |
| 156 | |
| 157 | cl.ci = compat_ptr(uci); |
| 158 | |
| 159 | if (cl.cnum <= 0) |
| 160 | return -EINVAL; |
YOSHIFUJI Hideaki | 8e87d14 | 2007-02-09 23:24:33 +0900 | [diff] [blame] | 161 | |
Marcel Holtmann | e9c5702 | 2006-10-15 17:30:22 +0200 | [diff] [blame] | 162 | err = bnep_get_connlist(&cl); |
| 163 | |
| 164 | if (!err && put_user(cl.cnum, (uint32_t __user *) arg)) |
| 165 | err = -EFAULT; |
| 166 | |
| 167 | return err; |
| 168 | } |
| 169 | |
| 170 | return bnep_sock_ioctl(sock, cmd, arg); |
| 171 | } |
| 172 | #endif |
| 173 | |
Eric Dumazet | 90ddc4f | 2005-12-22 12:49:22 -0800 | [diff] [blame] | 174 | static const struct proto_ops bnep_sock_ops = { |
Marcel Holtmann | e9c5702 | 2006-10-15 17:30:22 +0200 | [diff] [blame] | 175 | .family = PF_BLUETOOTH, |
| 176 | .owner = THIS_MODULE, |
| 177 | .release = bnep_sock_release, |
| 178 | .ioctl = bnep_sock_ioctl, |
| 179 | #ifdef CONFIG_COMPAT |
| 180 | .compat_ioctl = bnep_sock_compat_ioctl, |
| 181 | #endif |
| 182 | .bind = sock_no_bind, |
| 183 | .getname = sock_no_getname, |
| 184 | .sendmsg = sock_no_sendmsg, |
| 185 | .recvmsg = sock_no_recvmsg, |
| 186 | .poll = sock_no_poll, |
| 187 | .listen = sock_no_listen, |
| 188 | .shutdown = sock_no_shutdown, |
| 189 | .setsockopt = sock_no_setsockopt, |
| 190 | .getsockopt = sock_no_getsockopt, |
| 191 | .connect = sock_no_connect, |
| 192 | .socketpair = sock_no_socketpair, |
| 193 | .accept = sock_no_accept, |
| 194 | .mmap = sock_no_mmap |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 195 | }; |
| 196 | |
| 197 | static struct proto bnep_proto = { |
| 198 | .name = "BNEP", |
| 199 | .owner = THIS_MODULE, |
| 200 | .obj_size = sizeof(struct bt_sock) |
| 201 | }; |
| 202 | |
Eric W. Biederman | 1b8d7ae | 2007-10-08 23:24:22 -0700 | [diff] [blame] | 203 | static int bnep_sock_create(struct net *net, struct socket *sock, int protocol) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 204 | { |
| 205 | struct sock *sk; |
| 206 | |
| 207 | BT_DBG("sock %p", sock); |
| 208 | |
| 209 | if (sock->type != SOCK_RAW) |
| 210 | return -ESOCKTNOSUPPORT; |
| 211 | |
Pavel Emelyanov | 6257ff2 | 2007-11-01 00:39:31 -0700 | [diff] [blame] | 212 | sk = sk_alloc(net, PF_BLUETOOTH, GFP_ATOMIC, &bnep_proto); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 213 | if (!sk) |
| 214 | return -ENOMEM; |
| 215 | |
| 216 | sock_init_data(sock, sk); |
| 217 | |
| 218 | sock->ops = &bnep_sock_ops; |
| 219 | |
| 220 | sock->state = SS_UNCONNECTED; |
| 221 | |
| 222 | sock_reset_flag(sk, SOCK_ZAPPED); |
| 223 | |
| 224 | sk->sk_protocol = protocol; |
| 225 | sk->sk_state = BT_OPEN; |
| 226 | |
| 227 | return 0; |
| 228 | } |
| 229 | |
| 230 | static struct net_proto_family bnep_sock_family_ops = { |
| 231 | .family = PF_BLUETOOTH, |
| 232 | .owner = THIS_MODULE, |
| 233 | .create = bnep_sock_create |
| 234 | }; |
| 235 | |
| 236 | int __init bnep_sock_init(void) |
| 237 | { |
| 238 | int err; |
| 239 | |
| 240 | err = proto_register(&bnep_proto, 0); |
| 241 | if (err < 0) |
| 242 | return err; |
| 243 | |
| 244 | err = bt_sock_register(BTPROTO_BNEP, &bnep_sock_family_ops); |
| 245 | if (err < 0) |
| 246 | goto error; |
| 247 | |
| 248 | return 0; |
| 249 | |
| 250 | error: |
| 251 | BT_ERR("Can't register BNEP socket"); |
| 252 | proto_unregister(&bnep_proto); |
| 253 | return err; |
| 254 | } |
| 255 | |
Tobias Klauser | a4e2acf | 2008-03-05 18:47:40 -0800 | [diff] [blame] | 256 | void __exit bnep_sock_cleanup(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 257 | { |
| 258 | if (bt_sock_unregister(BTPROTO_BNEP) < 0) |
| 259 | BT_ERR("Can't unregister BNEP socket"); |
| 260 | |
| 261 | proto_unregister(&bnep_proto); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 262 | } |