1 | /* |
2 | CMTP implementation for Linux Bluetooth stack (BlueZ). |
3 | Copyright (C) 2002-2003 Marcel Holtmann <marcel@holtmann.org> |
4 | |
5 | This program is free software; you can redistribute it and/or modify |
6 | it under the terms of the GNU General Public License version 2 as |
7 | published by the Free Software Foundation; |
8 | |
9 | THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS |
10 | OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
11 | FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS. |
12 | IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY |
13 | CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES |
14 | WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN |
15 | ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF |
16 | OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. |
17 | |
18 | ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS, |
19 | COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS |
20 | SOFTWARE IS DISCLAIMED. |
21 | */ |
22 | |
23 | #include <linux/export.h> |
24 | |
25 | #include <linux/types.h> |
26 | #include <linux/capability.h> |
27 | #include <linux/errno.h> |
28 | #include <linux/kernel.h> |
29 | #include <linux/poll.h> |
30 | #include <linux/fcntl.h> |
31 | #include <linux/skbuff.h> |
32 | #include <linux/socket.h> |
33 | #include <linux/ioctl.h> |
34 | #include <linux/file.h> |
35 | #include <linux/compat.h> |
36 | #include <linux/gfp.h> |
37 | #include <linux/uaccess.h> |
38 | #include <net/sock.h> |
39 | |
40 | #include <linux/isdn/capilli.h> |
41 | |
42 | |
43 | #include "cmtp.h" |
44 | |
45 | static struct bt_sock_list cmtp_sk_list = { |
46 | .lock = __RW_LOCK_UNLOCKED(cmtp_sk_list.lock) |
47 | }; |
48 | |
49 | static int cmtp_sock_release(struct socket *sock) |
50 | { |
51 | struct sock *sk = sock->sk; |
52 | |
53 | BT_DBG("sock %p sk %p" , sock, sk); |
54 | |
55 | if (!sk) |
56 | return 0; |
57 | |
58 | bt_sock_unlink(l: &cmtp_sk_list, s: sk); |
59 | |
60 | sock_orphan(sk); |
61 | sock_put(sk); |
62 | |
63 | return 0; |
64 | } |
65 | |
66 | static int do_cmtp_sock_ioctl(struct socket *sock, unsigned int cmd, void __user *argp) |
67 | { |
68 | struct cmtp_connadd_req ca; |
69 | struct cmtp_conndel_req cd; |
70 | struct cmtp_connlist_req cl; |
71 | struct cmtp_conninfo ci; |
72 | struct socket *nsock; |
73 | int err; |
74 | |
75 | BT_DBG("cmd %x arg %p" , cmd, argp); |
76 | |
77 | switch (cmd) { |
78 | case CMTPCONNADD: |
79 | if (!capable(CAP_NET_ADMIN)) |
80 | return -EPERM; |
81 | |
82 | if (copy_from_user(to: &ca, from: argp, n: sizeof(ca))) |
83 | return -EFAULT; |
84 | |
85 | nsock = sockfd_lookup(fd: ca.sock, err: &err); |
86 | if (!nsock) |
87 | return err; |
88 | |
89 | if (nsock->sk->sk_state != BT_CONNECTED) { |
90 | sockfd_put(nsock); |
91 | return -EBADFD; |
92 | } |
93 | |
94 | err = cmtp_add_connection(req: &ca, sock: nsock); |
95 | if (!err) { |
96 | if (copy_to_user(to: argp, from: &ca, n: sizeof(ca))) |
97 | err = -EFAULT; |
98 | } else |
99 | sockfd_put(nsock); |
100 | |
101 | return err; |
102 | |
103 | case CMTPCONNDEL: |
104 | if (!capable(CAP_NET_ADMIN)) |
105 | return -EPERM; |
106 | |
107 | if (copy_from_user(to: &cd, from: argp, n: sizeof(cd))) |
108 | return -EFAULT; |
109 | |
110 | return cmtp_del_connection(req: &cd); |
111 | |
112 | case CMTPGETCONNLIST: |
113 | if (copy_from_user(to: &cl, from: argp, n: sizeof(cl))) |
114 | return -EFAULT; |
115 | |
116 | if (cl.cnum <= 0) |
117 | return -EINVAL; |
118 | |
119 | err = cmtp_get_connlist(req: &cl); |
120 | if (!err && copy_to_user(to: argp, from: &cl, n: sizeof(cl))) |
121 | return -EFAULT; |
122 | |
123 | return err; |
124 | |
125 | case CMTPGETCONNINFO: |
126 | if (copy_from_user(to: &ci, from: argp, n: sizeof(ci))) |
127 | return -EFAULT; |
128 | |
129 | err = cmtp_get_conninfo(ci: &ci); |
130 | if (!err && copy_to_user(to: argp, from: &ci, n: sizeof(ci))) |
131 | return -EFAULT; |
132 | |
133 | return err; |
134 | } |
135 | |
136 | return -EINVAL; |
137 | } |
138 | |
139 | static int cmtp_sock_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg) |
140 | { |
141 | return do_cmtp_sock_ioctl(sock, cmd, argp: (void __user *)arg); |
142 | } |
143 | |
144 | #ifdef CONFIG_COMPAT |
145 | static int cmtp_sock_compat_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg) |
146 | { |
147 | void __user *argp = compat_ptr(uptr: arg); |
148 | if (cmd == CMTPGETCONNLIST) { |
149 | struct cmtp_connlist_req cl; |
150 | u32 __user *p = argp; |
151 | u32 uci; |
152 | int err; |
153 | |
154 | if (get_user(cl.cnum, p) || get_user(uci, p + 1)) |
155 | return -EFAULT; |
156 | |
157 | cl.ci = compat_ptr(uptr: uci); |
158 | |
159 | if (cl.cnum <= 0) |
160 | return -EINVAL; |
161 | |
162 | err = cmtp_get_connlist(req: &cl); |
163 | |
164 | if (!err && put_user(cl.cnum, p)) |
165 | err = -EFAULT; |
166 | |
167 | return err; |
168 | } |
169 | |
170 | return do_cmtp_sock_ioctl(sock, cmd, argp); |
171 | } |
172 | #endif |
173 | |
174 | static const struct proto_ops cmtp_sock_ops = { |
175 | .family = PF_BLUETOOTH, |
176 | .owner = THIS_MODULE, |
177 | .release = cmtp_sock_release, |
178 | .ioctl = cmtp_sock_ioctl, |
179 | #ifdef CONFIG_COMPAT |
180 | .compat_ioctl = cmtp_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 | .listen = sock_no_listen, |
187 | .shutdown = sock_no_shutdown, |
188 | .connect = sock_no_connect, |
189 | .socketpair = sock_no_socketpair, |
190 | .accept = sock_no_accept, |
191 | .mmap = sock_no_mmap |
192 | }; |
193 | |
194 | static struct proto cmtp_proto = { |
195 | .name = "CMTP" , |
196 | .owner = THIS_MODULE, |
197 | .obj_size = sizeof(struct bt_sock) |
198 | }; |
199 | |
200 | static int cmtp_sock_create(struct net *net, struct socket *sock, int protocol, |
201 | int kern) |
202 | { |
203 | struct sock *sk; |
204 | |
205 | BT_DBG("sock %p" , sock); |
206 | |
207 | if (sock->type != SOCK_RAW) |
208 | return -ESOCKTNOSUPPORT; |
209 | |
210 | sk = sk_alloc(net, PF_BLUETOOTH, GFP_ATOMIC, prot: &cmtp_proto, kern); |
211 | if (!sk) |
212 | return -ENOMEM; |
213 | |
214 | sock_init_data(sock, sk); |
215 | |
216 | sock->ops = &cmtp_sock_ops; |
217 | |
218 | sock->state = SS_UNCONNECTED; |
219 | |
220 | sock_reset_flag(sk, flag: SOCK_ZAPPED); |
221 | |
222 | sk->sk_protocol = protocol; |
223 | sk->sk_state = BT_OPEN; |
224 | |
225 | bt_sock_link(l: &cmtp_sk_list, s: sk); |
226 | |
227 | return 0; |
228 | } |
229 | |
230 | static const struct net_proto_family cmtp_sock_family_ops = { |
231 | .family = PF_BLUETOOTH, |
232 | .owner = THIS_MODULE, |
233 | .create = cmtp_sock_create |
234 | }; |
235 | |
236 | int cmtp_init_sockets(void) |
237 | { |
238 | int err; |
239 | |
240 | err = proto_register(prot: &cmtp_proto, alloc_slab: 0); |
241 | if (err < 0) |
242 | return err; |
243 | |
244 | err = bt_sock_register(BTPROTO_CMTP, ops: &cmtp_sock_family_ops); |
245 | if (err < 0) { |
246 | BT_ERR("Can't register CMTP socket" ); |
247 | goto error; |
248 | } |
249 | |
250 | err = bt_procfs_init(net: &init_net, name: "cmtp" , sk_list: &cmtp_sk_list, NULL); |
251 | if (err < 0) { |
252 | BT_ERR("Failed to create CMTP proc file" ); |
253 | bt_sock_unregister(BTPROTO_HIDP); |
254 | goto error; |
255 | } |
256 | |
257 | BT_INFO("CMTP socket layer initialized" ); |
258 | |
259 | return 0; |
260 | |
261 | error: |
262 | proto_unregister(prot: &cmtp_proto); |
263 | return err; |
264 | } |
265 | |
266 | void cmtp_cleanup_sockets(void) |
267 | { |
268 | bt_procfs_cleanup(net: &init_net, name: "cmtp" ); |
269 | bt_sock_unregister(BTPROTO_CMTP); |
270 | proto_unregister(prot: &cmtp_proto); |
271 | } |
272 | |