1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23#include <linux/module.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/slab.h>
30#include <linux/poll.h>
31#include <linux/fcntl.h>
32#include <linux/skbuff.h>
33#include <linux/socket.h>
34#include <linux/ioctl.h>
35#include <linux/file.h>
36#include <linux/compat.h>
37#include <net/sock.h>
38
39#include <linux/isdn/capilli.h>
40
41#include <asm/system.h>
42#include <asm/uaccess.h>
43
44#include "cmtp.h"
45
46static int cmtp_sock_release(struct socket *sock)
47{
48 struct sock *sk = sock->sk;
49
50 BT_DBG("sock %p sk %p", sock, sk);
51
52 if (!sk)
53 return 0;
54
55 sock_orphan(sk);
56 sock_put(sk);
57
58 return 0;
59}
60
61static int cmtp_sock_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
62{
63 struct cmtp_connadd_req ca;
64 struct cmtp_conndel_req cd;
65 struct cmtp_connlist_req cl;
66 struct cmtp_conninfo ci;
67 struct socket *nsock;
68 void __user *argp = (void __user *)arg;
69 int err;
70
71 BT_DBG("cmd %x arg %lx", cmd, arg);
72
73 switch (cmd) {
74 case CMTPCONNADD:
75 if (!capable(CAP_NET_ADMIN))
76 return -EACCES;
77
78 if (copy_from_user(&ca, argp, sizeof(ca)))
79 return -EFAULT;
80
81 nsock = sockfd_lookup(ca.sock, &err);
82 if (!nsock)
83 return err;
84
85 if (nsock->sk->sk_state != BT_CONNECTED) {
86 sockfd_put(nsock);
87 return -EBADFD;
88 }
89
90 err = cmtp_add_connection(&ca, nsock);
91 if (!err) {
92 if (copy_to_user(argp, &ca, sizeof(ca)))
93 err = -EFAULT;
94 } else
95 sockfd_put(nsock);
96
97 return err;
98
99 case CMTPCONNDEL:
100 if (!capable(CAP_NET_ADMIN))
101 return -EACCES;
102
103 if (copy_from_user(&cd, argp, sizeof(cd)))
104 return -EFAULT;
105
106 return cmtp_del_connection(&cd);
107
108 case CMTPGETCONNLIST:
109 if (copy_from_user(&cl, argp, sizeof(cl)))
110 return -EFAULT;
111
112 if (cl.cnum <= 0)
113 return -EINVAL;
114
115 err = cmtp_get_connlist(&cl);
116 if (!err && copy_to_user(argp, &cl, sizeof(cl)))
117 return -EFAULT;
118
119 return err;
120
121 case CMTPGETCONNINFO:
122 if (copy_from_user(&ci, argp, sizeof(ci)))
123 return -EFAULT;
124
125 err = cmtp_get_conninfo(&ci);
126 if (!err && copy_to_user(argp, &ci, sizeof(ci)))
127 return -EFAULT;
128
129 return err;
130 }
131
132 return -EINVAL;
133}
134
135#ifdef CONFIG_COMPAT
136static int cmtp_sock_compat_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
137{
138 if (cmd == CMTPGETCONNLIST) {
139 struct cmtp_connlist_req cl;
140 uint32_t uci;
141 int err;
142
143 if (get_user(cl.cnum, (uint32_t __user *) arg) ||
144 get_user(uci, (u32 __user *) (arg + 4)))
145 return -EFAULT;
146
147 cl.ci = compat_ptr(uci);
148
149 if (cl.cnum <= 0)
150 return -EINVAL;
151
152 err = cmtp_get_connlist(&cl);
153
154 if (!err && put_user(cl.cnum, (uint32_t __user *) arg))
155 err = -EFAULT;
156
157 return err;
158 }
159
160 return cmtp_sock_ioctl(sock, cmd, arg);
161}
162#endif
163
164static const struct proto_ops cmtp_sock_ops = {
165 .family = PF_BLUETOOTH,
166 .owner = THIS_MODULE,
167 .release = cmtp_sock_release,
168 .ioctl = cmtp_sock_ioctl,
169#ifdef CONFIG_COMPAT
170 .compat_ioctl = cmtp_sock_compat_ioctl,
171#endif
172 .bind = sock_no_bind,
173 .getname = sock_no_getname,
174 .sendmsg = sock_no_sendmsg,
175 .recvmsg = sock_no_recvmsg,
176 .poll = sock_no_poll,
177 .listen = sock_no_listen,
178 .shutdown = sock_no_shutdown,
179 .setsockopt = sock_no_setsockopt,
180 .getsockopt = sock_no_getsockopt,
181 .connect = sock_no_connect,
182 .socketpair = sock_no_socketpair,
183 .accept = sock_no_accept,
184 .mmap = sock_no_mmap
185};
186
187static struct proto cmtp_proto = {
188 .name = "CMTP",
189 .owner = THIS_MODULE,
190 .obj_size = sizeof(struct bt_sock)
191};
192
193static int cmtp_sock_create(struct net *net, struct socket *sock, int protocol)
194{
195 struct sock *sk;
196
197 BT_DBG("sock %p", sock);
198
199 if (sock->type != SOCK_RAW)
200 return -ESOCKTNOSUPPORT;
201
202 sk = sk_alloc(net, PF_BLUETOOTH, GFP_ATOMIC, &cmtp_proto);
203 if (!sk)
204 return -ENOMEM;
205
206 sock_init_data(sock, sk);
207
208 sock->ops = &cmtp_sock_ops;
209
210 sock->state = SS_UNCONNECTED;
211
212 sock_reset_flag(sk, SOCK_ZAPPED);
213
214 sk->sk_protocol = protocol;
215 sk->sk_state = BT_OPEN;
216
217 return 0;
218}
219
220static struct net_proto_family cmtp_sock_family_ops = {
221 .family = PF_BLUETOOTH,
222 .owner = THIS_MODULE,
223 .create = cmtp_sock_create
224};
225
226int cmtp_init_sockets(void)
227{
228 int err;
229
230 err = proto_register(&cmtp_proto, 0);
231 if (err < 0)
232 return err;
233
234 err = bt_sock_register(BTPROTO_CMTP, &cmtp_sock_family_ops);
235 if (err < 0)
236 goto error;
237
238 return 0;
239
240error:
241 BT_ERR("Can't register CMTP socket");
242 proto_unregister(&cmtp_proto);
243 return err;
244}
245
246void cmtp_cleanup_sockets(void)
247{
248 if (bt_sock_unregister(BTPROTO_CMTP) < 0)
249 BT_ERR("Can't unregister CMTP socket");
250
251 proto_unregister(&cmtp_proto);
252}
253