blob: d575ef4e9aa6d390bde4f78ba85247acf8e9bf65 [file] [log] [blame]
Remi Denis-Courmontba113a92008-09-22 20:05:19 -07001/*
2 * File: socket.c
3 *
4 * Phonet sockets
5 *
6 * Copyright (C) 2008 Nokia Corporation.
7 *
Rémi Denis-Courmont31fdc552012-06-13 22:29:03 +00008 * Authors: Sakari Ailus <sakari.ailus@nokia.com>
9 * Rémi Denis-Courmont
Remi Denis-Courmontba113a92008-09-22 20:05:19 -070010 *
11 * This program is free software; you can redistribute it and/or
12 * modify it under the terms of the GNU General Public License
13 * version 2 as published by the Free Software Foundation.
14 *
15 * This program is distributed in the hope that it will be useful, but
16 * WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
18 * General Public License for more details.
19 *
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, write to the Free Software
22 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
23 * 02110-1301 USA
24 */
25
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090026#include <linux/gfp.h>
Remi Denis-Courmontba113a92008-09-22 20:05:19 -070027#include <linux/kernel.h>
28#include <linux/net.h>
Rémi Denis-Courmont9995a322008-10-05 11:14:48 -070029#include <linux/poll.h>
Remi Denis-Courmontba113a92008-09-22 20:05:19 -070030#include <net/sock.h>
31#include <net/tcp_states.h>
32
33#include <linux/phonet.h>
Paul Gortmakerbc3b2d72011-07-15 11:47:34 -040034#include <linux/export.h>
Remi Denis-Courmontba113a92008-09-22 20:05:19 -070035#include <net/phonet/phonet.h>
Rémi Denis-Courmont9995a322008-10-05 11:14:48 -070036#include <net/phonet/pep.h>
Remi Denis-Courmontba113a92008-09-22 20:05:19 -070037#include <net/phonet/pn_dev.h>
38
39static int pn_socket_release(struct socket *sock)
40{
41 struct sock *sk = sock->sk;
42
43 if (sk) {
44 sock->sk = NULL;
45 sk->sk_prot->close(sk, 0);
46 }
47 return 0;
48}
49
Rémi Denis-Courmont6b0d07b2009-11-09 02:17:01 +000050#define PN_HASHSIZE 16
51#define PN_HASHMASK (PN_HASHSIZE-1)
52
53
Remi Denis-Courmontba113a92008-09-22 20:05:19 -070054static struct {
Rémi Denis-Courmont6b0d07b2009-11-09 02:17:01 +000055 struct hlist_head hlist[PN_HASHSIZE];
Rémi Denis-Courmont44f4d5a2011-04-12 23:27:36 +000056 struct mutex lock;
Rémi Denis-Courmont6b0d07b2009-11-09 02:17:01 +000057} pnsocks;
58
59void __init pn_sock_init(void)
60{
Eric Dumazet95c96172012-04-15 05:58:06 +000061 unsigned int i;
Rémi Denis-Courmont6b0d07b2009-11-09 02:17:01 +000062
63 for (i = 0; i < PN_HASHSIZE; i++)
64 INIT_HLIST_HEAD(pnsocks.hlist + i);
Rémi Denis-Courmont44f4d5a2011-04-12 23:27:36 +000065 mutex_init(&pnsocks.lock);
Rémi Denis-Courmont6b0d07b2009-11-09 02:17:01 +000066}
67
68static struct hlist_head *pn_hash_list(u16 obj)
69{
70 return pnsocks.hlist + (obj & PN_HASHMASK);
71}
Remi Denis-Courmontba113a92008-09-22 20:05:19 -070072
73/*
74 * Find address based on socket address, match only certain fields.
75 * Also grab sock if it was found. Remember to sock_put it later.
76 */
Rémi Denis-Courmont52404882008-12-03 15:42:56 -080077struct sock *pn_find_sock_by_sa(struct net *net, const struct sockaddr_pn *spn)
Remi Denis-Courmontba113a92008-09-22 20:05:19 -070078{
Remi Denis-Courmontba113a92008-09-22 20:05:19 -070079 struct sock *sknode;
80 struct sock *rval = NULL;
81 u16 obj = pn_sockaddr_get_object(spn);
82 u8 res = spn->spn_resource;
Rémi Denis-Courmont6b0d07b2009-11-09 02:17:01 +000083 struct hlist_head *hlist = pn_hash_list(obj);
Remi Denis-Courmontba113a92008-09-22 20:05:19 -070084
Rémi Denis-Courmont44f4d5a2011-04-12 23:27:36 +000085 rcu_read_lock();
Sasha Levinb67bfe02013-02-27 17:06:00 -080086 sk_for_each_rcu(sknode, hlist) {
Remi Denis-Courmontba113a92008-09-22 20:05:19 -070087 struct pn_sock *pn = pn_sk(sknode);
88 BUG_ON(!pn->sobject); /* unbound socket */
89
Rémi Denis-Courmont52404882008-12-03 15:42:56 -080090 if (!net_eq(sock_net(sknode), net))
91 continue;
Remi Denis-Courmontba113a92008-09-22 20:05:19 -070092 if (pn_port(obj)) {
93 /* Look up socket by port */
94 if (pn_port(pn->sobject) != pn_port(obj))
95 continue;
96 } else {
97 /* If port is zero, look up by resource */
98 if (pn->resource != res)
99 continue;
100 }
Joe Perchesf64f9e72009-11-29 16:55:45 -0800101 if (pn_addr(pn->sobject) &&
102 pn_addr(pn->sobject) != pn_addr(obj))
Remi Denis-Courmontba113a92008-09-22 20:05:19 -0700103 continue;
104
105 rval = sknode;
106 sock_hold(sknode);
107 break;
108 }
Rémi Denis-Courmont44f4d5a2011-04-12 23:27:36 +0000109 rcu_read_unlock();
Remi Denis-Courmontba113a92008-09-22 20:05:19 -0700110
111 return rval;
Rémi Denis-Courmontf14001f2009-10-14 00:48:27 +0000112}
Remi Denis-Courmontba113a92008-09-22 20:05:19 -0700113
Rémi Denis-Courmontf14001f2009-10-14 00:48:27 +0000114/* Deliver a broadcast packet (only in bottom-half) */
115void pn_deliver_sock_broadcast(struct net *net, struct sk_buff *skb)
116{
Rémi Denis-Courmont6b0d07b2009-11-09 02:17:01 +0000117 struct hlist_head *hlist = pnsocks.hlist;
Eric Dumazet95c96172012-04-15 05:58:06 +0000118 unsigned int h;
Rémi Denis-Courmontf14001f2009-10-14 00:48:27 +0000119
Rémi Denis-Courmont44f4d5a2011-04-12 23:27:36 +0000120 rcu_read_lock();
Rémi Denis-Courmont6b0d07b2009-11-09 02:17:01 +0000121 for (h = 0; h < PN_HASHSIZE; h++) {
Rémi Denis-Courmont6b0d07b2009-11-09 02:17:01 +0000122 struct sock *sknode;
Rémi Denis-Courmontf14001f2009-10-14 00:48:27 +0000123
Sasha Levinb67bfe02013-02-27 17:06:00 -0800124 sk_for_each(sknode, hlist) {
Rémi Denis-Courmont6b0d07b2009-11-09 02:17:01 +0000125 struct sk_buff *clone;
Rémi Denis-Courmontf14001f2009-10-14 00:48:27 +0000126
Rémi Denis-Courmont6b0d07b2009-11-09 02:17:01 +0000127 if (!net_eq(sock_net(sknode), net))
128 continue;
129 if (!sock_flag(sknode, SOCK_BROADCAST))
130 continue;
131
132 clone = skb_clone(skb, GFP_ATOMIC);
133 if (clone) {
134 sock_hold(sknode);
135 sk_receive_skb(sknode, clone, 0);
136 }
Rémi Denis-Courmont21912d12009-10-15 12:29:14 -0700137 }
Rémi Denis-Courmont6b0d07b2009-11-09 02:17:01 +0000138 hlist++;
Rémi Denis-Courmontf14001f2009-10-14 00:48:27 +0000139 }
Rémi Denis-Courmont44f4d5a2011-04-12 23:27:36 +0000140 rcu_read_unlock();
Remi Denis-Courmontba113a92008-09-22 20:05:19 -0700141}
142
143void pn_sock_hash(struct sock *sk)
144{
Rémi Denis-Courmont6b0d07b2009-11-09 02:17:01 +0000145 struct hlist_head *hlist = pn_hash_list(pn_sk(sk)->sobject);
146
Rémi Denis-Courmont44f4d5a2011-04-12 23:27:36 +0000147 mutex_lock(&pnsocks.lock);
148 sk_add_node_rcu(sk, hlist);
149 mutex_unlock(&pnsocks.lock);
Remi Denis-Courmontba113a92008-09-22 20:05:19 -0700150}
151EXPORT_SYMBOL(pn_sock_hash);
152
153void pn_sock_unhash(struct sock *sk)
154{
Rémi Denis-Courmont44f4d5a2011-04-12 23:27:36 +0000155 mutex_lock(&pnsocks.lock);
156 sk_del_node_init_rcu(sk);
157 mutex_unlock(&pnsocks.lock);
Rémi Denis-Courmont7417fa82010-09-15 12:30:12 +0000158 pn_sock_unbind_all_res(sk);
Rémi Denis-Courmont44f4d5a2011-04-12 23:27:36 +0000159 synchronize_rcu();
Remi Denis-Courmontba113a92008-09-22 20:05:19 -0700160}
161EXPORT_SYMBOL(pn_sock_unhash);
162
Rémi Denis-Courmont582b0b62009-09-23 03:17:10 +0000163static DEFINE_MUTEX(port_mutex);
164
Remi Denis-Courmontba113a92008-09-22 20:05:19 -0700165static int pn_socket_bind(struct socket *sock, struct sockaddr *addr, int len)
166{
167 struct sock *sk = sock->sk;
168 struct pn_sock *pn = pn_sk(sk);
169 struct sockaddr_pn *spn = (struct sockaddr_pn *)addr;
170 int err;
171 u16 handle;
172 u8 saddr;
173
174 if (sk->sk_prot->bind)
175 return sk->sk_prot->bind(sk, addr, len);
176
177 if (len < sizeof(struct sockaddr_pn))
178 return -EINVAL;
179 if (spn->spn_family != AF_PHONET)
180 return -EAFNOSUPPORT;
181
182 handle = pn_sockaddr_get_object((struct sockaddr_pn *)addr);
183 saddr = pn_addr(handle);
Rémi Denis-Courmont52404882008-12-03 15:42:56 -0800184 if (saddr && phonet_address_lookup(sock_net(sk), saddr))
Remi Denis-Courmontba113a92008-09-22 20:05:19 -0700185 return -EADDRNOTAVAIL;
186
187 lock_sock(sk);
188 if (sk->sk_state != TCP_CLOSE || pn_port(pn->sobject)) {
189 err = -EINVAL; /* attempt to rebind */
190 goto out;
191 }
Rémi Denis-Courmont582b0b62009-09-23 03:17:10 +0000192 WARN_ON(sk_hashed(sk));
193 mutex_lock(&port_mutex);
Remi Denis-Courmontba113a92008-09-22 20:05:19 -0700194 err = sk->sk_prot->get_port(sk, pn_port(handle));
195 if (err)
Rémi Denis-Courmont582b0b62009-09-23 03:17:10 +0000196 goto out_port;
Remi Denis-Courmontba113a92008-09-22 20:05:19 -0700197
198 /* get_port() sets the port, bind() sets the address if applicable */
199 pn->sobject = pn_object(saddr, pn_port(pn->sobject));
200 pn->resource = spn->spn_resource;
201
202 /* Enable RX on the socket */
203 sk->sk_prot->hash(sk);
Rémi Denis-Courmont582b0b62009-09-23 03:17:10 +0000204out_port:
205 mutex_unlock(&port_mutex);
Remi Denis-Courmontba113a92008-09-22 20:05:19 -0700206out:
207 release_sock(sk);
208 return err;
209}
210
211static int pn_socket_autobind(struct socket *sock)
212{
213 struct sockaddr_pn sa;
214 int err;
215
216 memset(&sa, 0, sizeof(sa));
217 sa.spn_family = AF_PHONET;
218 err = pn_socket_bind(sock, (struct sockaddr *)&sa,
219 sizeof(struct sockaddr_pn));
220 if (err != -EINVAL)
221 return err;
222 BUG_ON(!pn_port(pn_sk(sock->sk)->sobject));
223 return 0; /* socket was already bound */
224}
225
Kumar Sanghvib3d62552010-10-12 20:14:43 +0000226static int pn_socket_connect(struct socket *sock, struct sockaddr *addr,
227 int len, int flags)
228{
229 struct sock *sk = sock->sk;
Rémi Denis-Courmont297edb62011-03-08 22:44:12 +0000230 struct pn_sock *pn = pn_sk(sk);
Kumar Sanghvib3d62552010-10-12 20:14:43 +0000231 struct sockaddr_pn *spn = (struct sockaddr_pn *)addr;
Rémi Denis-Courmont297edb62011-03-08 22:44:12 +0000232 struct task_struct *tsk = current;
233 long timeo = sock_rcvtimeo(sk, flags & O_NONBLOCK);
Kumar Sanghvib3d62552010-10-12 20:14:43 +0000234 int err;
235
Rémi Denis-Courmont297edb62011-03-08 22:44:12 +0000236 if (pn_socket_autobind(sock))
237 return -ENOBUFS;
Kumar Sanghvib3d62552010-10-12 20:14:43 +0000238 if (len < sizeof(struct sockaddr_pn))
239 return -EINVAL;
240 if (spn->spn_family != AF_PHONET)
241 return -EAFNOSUPPORT;
242
243 lock_sock(sk);
244
245 switch (sock->state) {
246 case SS_UNCONNECTED:
Rémi Denis-Courmont297edb62011-03-08 22:44:12 +0000247 if (sk->sk_state != TCP_CLOSE) {
248 err = -EISCONN;
249 goto out;
250 }
Kumar Sanghvib3d62552010-10-12 20:14:43 +0000251 break;
252 case SS_CONNECTING:
Rémi Denis-Courmont297edb62011-03-08 22:44:12 +0000253 err = -EALREADY;
254 goto out;
255 default:
256 err = -EISCONN;
257 goto out;
Kumar Sanghvib3d62552010-10-12 20:14:43 +0000258 }
Kumar Sanghvib3d62552010-10-12 20:14:43 +0000259
Rémi Denis-Courmont297edb62011-03-08 22:44:12 +0000260 pn->dobject = pn_sockaddr_get_object(spn);
261 pn->resource = pn_sockaddr_get_resource(spn);
Kumar Sanghvib3d62552010-10-12 20:14:43 +0000262 sock->state = SS_CONNECTING;
Rémi Denis-Courmont297edb62011-03-08 22:44:12 +0000263
Kumar Sanghvib3d62552010-10-12 20:14:43 +0000264 err = sk->sk_prot->connect(sk, addr, len);
Rémi Denis-Courmont297edb62011-03-08 22:44:12 +0000265 if (err) {
Kumar Sanghvib3d62552010-10-12 20:14:43 +0000266 sock->state = SS_UNCONNECTED;
Rémi Denis-Courmont297edb62011-03-08 22:44:12 +0000267 pn->dobject = 0;
Kumar Sanghvib3d62552010-10-12 20:14:43 +0000268 goto out;
269 }
270
Rémi Denis-Courmont297edb62011-03-08 22:44:12 +0000271 while (sk->sk_state == TCP_SYN_SENT) {
272 DEFINE_WAIT(wait);
Kumar Sanghvib3d62552010-10-12 20:14:43 +0000273
Rémi Denis-Courmont297edb62011-03-08 22:44:12 +0000274 if (!timeo) {
275 err = -EINPROGRESS;
276 goto out;
277 }
278 if (signal_pending(tsk)) {
279 err = sock_intr_errno(timeo);
280 goto out;
281 }
Kumar Sanghvib3d62552010-10-12 20:14:43 +0000282
Rémi Denis-Courmont297edb62011-03-08 22:44:12 +0000283 prepare_to_wait_exclusive(sk_sleep(sk), &wait,
284 TASK_INTERRUPTIBLE);
285 release_sock(sk);
286 timeo = schedule_timeout(timeo);
287 lock_sock(sk);
288 finish_wait(sk_sleep(sk), &wait);
Kumar Sanghvib3d62552010-10-12 20:14:43 +0000289 }
Kumar Sanghvib3d62552010-10-12 20:14:43 +0000290
Rémi Denis-Courmont297edb62011-03-08 22:44:12 +0000291 if ((1 << sk->sk_state) & (TCPF_SYN_RECV|TCPF_ESTABLISHED))
292 err = 0;
293 else if (sk->sk_state == TCP_CLOSE_WAIT)
294 err = -ECONNRESET;
295 else
296 err = -ECONNREFUSED;
297 sock->state = err ? SS_UNCONNECTED : SS_CONNECTED;
Kumar Sanghvib3d62552010-10-12 20:14:43 +0000298out:
299 release_sock(sk);
300 return err;
301}
Kumar Sanghvib3d62552010-10-12 20:14:43 +0000302
Rémi Denis-Courmont9995a322008-10-05 11:14:48 -0700303static int pn_socket_accept(struct socket *sock, struct socket *newsock,
304 int flags)
305{
306 struct sock *sk = sock->sk;
307 struct sock *newsk;
308 int err;
309
Rémi Denis-Courmontf7ae8d52011-03-08 22:44:10 +0000310 if (unlikely(sk->sk_state != TCP_LISTEN))
311 return -EINVAL;
312
Rémi Denis-Courmont9995a322008-10-05 11:14:48 -0700313 newsk = sk->sk_prot->accept(sk, flags, &err);
314 if (!newsk)
315 return err;
316
317 lock_sock(newsk);
318 sock_graft(newsk, newsock);
319 newsock->state = SS_CONNECTED;
320 release_sock(newsk);
321 return 0;
322}
323
Remi Denis-Courmontba113a92008-09-22 20:05:19 -0700324static int pn_socket_getname(struct socket *sock, struct sockaddr *addr,
325 int *sockaddr_len, int peer)
326{
327 struct sock *sk = sock->sk;
328 struct pn_sock *pn = pn_sk(sk);
329
330 memset(addr, 0, sizeof(struct sockaddr_pn));
331 addr->sa_family = AF_PHONET;
332 if (!peer) /* Race with bind() here is userland's problem. */
333 pn_sockaddr_set_object((struct sockaddr_pn *)addr,
334 pn->sobject);
335
336 *sockaddr_len = sizeof(struct sockaddr_pn);
337 return 0;
338}
339
Rémi Denis-Courmont9995a322008-10-05 11:14:48 -0700340static unsigned int pn_socket_poll(struct file *file, struct socket *sock,
341 poll_table *wait)
342{
343 struct sock *sk = sock->sk;
344 struct pep_sock *pn = pep_sk(sk);
345 unsigned int mask = 0;
346
Eric Dumazet43815482010-04-29 11:01:49 +0000347 poll_wait(file, sk_sleep(sk), wait);
Rémi Denis-Courmont9995a322008-10-05 11:14:48 -0700348
Rémi Denis-Courmontf7ae8d52011-03-08 22:44:10 +0000349 if (sk->sk_state == TCP_CLOSE)
Rémi Denis-Courmont9995a322008-10-05 11:14:48 -0700350 return POLLERR;
Rémi Denis-Courmont9995a322008-10-05 11:14:48 -0700351 if (!skb_queue_empty(&sk->sk_receive_queue))
352 mask |= POLLIN | POLLRDNORM;
Rémi Denis-Courmontc41bd97f82008-10-05 11:15:43 -0700353 if (!skb_queue_empty(&pn->ctrlreq_queue))
354 mask |= POLLPRI;
355 if (!mask && sk->sk_state == TCP_CLOSE_WAIT)
Rémi Denis-Courmont9995a322008-10-05 11:14:48 -0700356 return POLLHUP;
357
Rémi Denis-Courmont01b38602010-08-30 12:57:05 +0000358 if (sk->sk_state == TCP_ESTABLISHED &&
359 atomic_read(&sk->sk_wmem_alloc) < sk->sk_sndbuf &&
360 atomic_read(&pn->tx_credits))
Rémi Denis-Courmont9995a322008-10-05 11:14:48 -0700361 mask |= POLLOUT | POLLWRNORM | POLLWRBAND;
362
363 return mask;
364}
365
Remi Denis-Courmontba113a92008-09-22 20:05:19 -0700366static int pn_socket_ioctl(struct socket *sock, unsigned int cmd,
367 unsigned long arg)
368{
369 struct sock *sk = sock->sk;
370 struct pn_sock *pn = pn_sk(sk);
371
372 if (cmd == SIOCPNGETOBJECT) {
373 struct net_device *dev;
374 u16 handle;
375 u8 saddr;
376
377 if (get_user(handle, (__u16 __user *)arg))
378 return -EFAULT;
379
380 lock_sock(sk);
381 if (sk->sk_bound_dev_if)
382 dev = dev_get_by_index(sock_net(sk),
383 sk->sk_bound_dev_if);
384 else
385 dev = phonet_device_get(sock_net(sk));
386 if (dev && (dev->flags & IFF_UP))
387 saddr = phonet_address_get(dev, pn_addr(handle));
388 else
389 saddr = PN_NO_ADDR;
390 release_sock(sk);
391
392 if (dev)
393 dev_put(dev);
394 if (saddr == PN_NO_ADDR)
395 return -EHOSTUNREACH;
396
397 handle = pn_object(saddr, pn_port(pn->sobject));
398 return put_user(handle, (__u16 __user *)arg);
399 }
400
401 return sk->sk_prot->ioctl(sk, cmd, arg);
402}
403
Rémi Denis-Courmont9995a322008-10-05 11:14:48 -0700404static int pn_socket_listen(struct socket *sock, int backlog)
405{
406 struct sock *sk = sock->sk;
407 int err = 0;
408
Rémi Denis-Courmont9995a322008-10-05 11:14:48 -0700409 if (pn_socket_autobind(sock))
410 return -ENOBUFS;
411
412 lock_sock(sk);
Rémi Denis-Courmont96241542011-02-24 23:14:56 +0000413 if (sock->state != SS_UNCONNECTED) {
Rémi Denis-Courmont9995a322008-10-05 11:14:48 -0700414 err = -EINVAL;
415 goto out;
416 }
417
Rémi Denis-Courmont96241542011-02-24 23:14:56 +0000418 if (sk->sk_state != TCP_LISTEN) {
419 sk->sk_state = TCP_LISTEN;
420 sk->sk_ack_backlog = 0;
421 }
Rémi Denis-Courmont9995a322008-10-05 11:14:48 -0700422 sk->sk_max_ack_backlog = backlog;
423out:
424 release_sock(sk);
425 return err;
426}
427
Ying Xue1b784142015-03-02 15:37:48 +0800428static int pn_socket_sendmsg(struct socket *sock, struct msghdr *m,
429 size_t total_len)
Remi Denis-Courmontba113a92008-09-22 20:05:19 -0700430{
431 struct sock *sk = sock->sk;
432
433 if (pn_socket_autobind(sock))
434 return -EAGAIN;
435
Ying Xue1b784142015-03-02 15:37:48 +0800436 return sk->sk_prot->sendmsg(sk, m, total_len);
Remi Denis-Courmontba113a92008-09-22 20:05:19 -0700437}
438
439const struct proto_ops phonet_dgram_ops = {
440 .family = AF_PHONET,
441 .owner = THIS_MODULE,
442 .release = pn_socket_release,
443 .bind = pn_socket_bind,
444 .connect = sock_no_connect,
445 .socketpair = sock_no_socketpair,
446 .accept = sock_no_accept,
447 .getname = pn_socket_getname,
448 .poll = datagram_poll,
449 .ioctl = pn_socket_ioctl,
450 .listen = sock_no_listen,
451 .shutdown = sock_no_shutdown,
452 .setsockopt = sock_no_setsockopt,
453 .getsockopt = sock_no_getsockopt,
454#ifdef CONFIG_COMPAT
455 .compat_setsockopt = sock_no_setsockopt,
456 .compat_getsockopt = sock_no_getsockopt,
457#endif
458 .sendmsg = pn_socket_sendmsg,
459 .recvmsg = sock_common_recvmsg,
460 .mmap = sock_no_mmap,
461 .sendpage = sock_no_sendpage,
462};
463
Rémi Denis-Courmont9995a322008-10-05 11:14:48 -0700464const struct proto_ops phonet_stream_ops = {
465 .family = AF_PHONET,
466 .owner = THIS_MODULE,
467 .release = pn_socket_release,
468 .bind = pn_socket_bind,
Kumar Sanghvib3d62552010-10-12 20:14:43 +0000469 .connect = pn_socket_connect,
Rémi Denis-Courmont9995a322008-10-05 11:14:48 -0700470 .socketpair = sock_no_socketpair,
471 .accept = pn_socket_accept,
472 .getname = pn_socket_getname,
473 .poll = pn_socket_poll,
474 .ioctl = pn_socket_ioctl,
475 .listen = pn_socket_listen,
476 .shutdown = sock_no_shutdown,
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700477 .setsockopt = sock_common_setsockopt,
478 .getsockopt = sock_common_getsockopt,
Rémi Denis-Courmont9995a322008-10-05 11:14:48 -0700479#ifdef CONFIG_COMPAT
Rémi Denis-Courmont02a47612008-10-05 11:16:16 -0700480 .compat_setsockopt = compat_sock_common_setsockopt,
481 .compat_getsockopt = compat_sock_common_getsockopt,
Rémi Denis-Courmont9995a322008-10-05 11:14:48 -0700482#endif
483 .sendmsg = pn_socket_sendmsg,
484 .recvmsg = sock_common_recvmsg,
485 .mmap = sock_no_mmap,
486 .sendpage = sock_no_sendpage,
487};
488EXPORT_SYMBOL(phonet_stream_ops);
489
Remi Denis-Courmontba113a92008-09-22 20:05:19 -0700490/* allocate port for a socket */
491int pn_sock_get_port(struct sock *sk, unsigned short sport)
492{
493 static int port_cur;
Rémi Denis-Courmont52404882008-12-03 15:42:56 -0800494 struct net *net = sock_net(sk);
Remi Denis-Courmontba113a92008-09-22 20:05:19 -0700495 struct pn_sock *pn = pn_sk(sk);
496 struct sockaddr_pn try_sa;
497 struct sock *tmpsk;
498
499 memset(&try_sa, 0, sizeof(struct sockaddr_pn));
500 try_sa.spn_family = AF_PHONET;
Rémi Denis-Courmont582b0b62009-09-23 03:17:10 +0000501 WARN_ON(!mutex_is_locked(&port_mutex));
Remi Denis-Courmontba113a92008-09-22 20:05:19 -0700502 if (!sport) {
503 /* search free port */
Remi Denis-Courmont87ab4e22008-09-22 20:08:39 -0700504 int port, pmin, pmax;
Remi Denis-Courmontba113a92008-09-22 20:05:19 -0700505
Remi Denis-Courmont87ab4e22008-09-22 20:08:39 -0700506 phonet_get_local_port_range(&pmin, &pmax);
Remi Denis-Courmontba113a92008-09-22 20:05:19 -0700507 for (port = pmin; port <= pmax; port++) {
508 port_cur++;
509 if (port_cur < pmin || port_cur > pmax)
510 port_cur = pmin;
511
512 pn_sockaddr_set_port(&try_sa, port_cur);
Rémi Denis-Courmont52404882008-12-03 15:42:56 -0800513 tmpsk = pn_find_sock_by_sa(net, &try_sa);
Remi Denis-Courmontba113a92008-09-22 20:05:19 -0700514 if (tmpsk == NULL) {
515 sport = port_cur;
516 goto found;
517 } else
518 sock_put(tmpsk);
519 }
520 } else {
521 /* try to find specific port */
522 pn_sockaddr_set_port(&try_sa, sport);
Rémi Denis-Courmont52404882008-12-03 15:42:56 -0800523 tmpsk = pn_find_sock_by_sa(net, &try_sa);
Remi Denis-Courmontba113a92008-09-22 20:05:19 -0700524 if (tmpsk == NULL)
525 /* No sock there! We can use that port... */
526 goto found;
527 else
528 sock_put(tmpsk);
529 }
Remi Denis-Courmontba113a92008-09-22 20:05:19 -0700530 /* the port must be in use already */
531 return -EADDRINUSE;
532
533found:
Remi Denis-Courmontba113a92008-09-22 20:05:19 -0700534 pn->sobject = pn_object(pn_addr(pn->sobject), sport);
535 return 0;
536}
537EXPORT_SYMBOL(pn_sock_get_port);
Rémi Denis-Courmontc1dc13e2009-07-21 01:57:57 +0000538
Randy Dunlapae6e2ae2009-08-17 10:35:49 +0000539#ifdef CONFIG_PROC_FS
Rémi Denis-Courmontc1dc13e2009-07-21 01:57:57 +0000540static struct sock *pn_sock_get_idx(struct seq_file *seq, loff_t pos)
541{
542 struct net *net = seq_file_net(seq);
Rémi Denis-Courmont6b0d07b2009-11-09 02:17:01 +0000543 struct hlist_head *hlist = pnsocks.hlist;
Rémi Denis-Courmontc1dc13e2009-07-21 01:57:57 +0000544 struct sock *sknode;
Eric Dumazet95c96172012-04-15 05:58:06 +0000545 unsigned int h;
Rémi Denis-Courmontc1dc13e2009-07-21 01:57:57 +0000546
Rémi Denis-Courmont6b0d07b2009-11-09 02:17:01 +0000547 for (h = 0; h < PN_HASHSIZE; h++) {
Sasha Levinb67bfe02013-02-27 17:06:00 -0800548 sk_for_each_rcu(sknode, hlist) {
Rémi Denis-Courmont6b0d07b2009-11-09 02:17:01 +0000549 if (!net_eq(net, sock_net(sknode)))
550 continue;
551 if (!pos)
552 return sknode;
553 pos--;
554 }
555 hlist++;
Rémi Denis-Courmontc1dc13e2009-07-21 01:57:57 +0000556 }
557 return NULL;
558}
559
560static struct sock *pn_sock_get_next(struct seq_file *seq, struct sock *sk)
561{
562 struct net *net = seq_file_net(seq);
563
564 do
565 sk = sk_next(sk);
566 while (sk && !net_eq(net, sock_net(sk)));
567
568 return sk;
569}
570
571static void *pn_sock_seq_start(struct seq_file *seq, loff_t *pos)
Rémi Denis-Courmont44f4d5a2011-04-12 23:27:36 +0000572 __acquires(rcu)
Rémi Denis-Courmontc1dc13e2009-07-21 01:57:57 +0000573{
Rémi Denis-Courmont44f4d5a2011-04-12 23:27:36 +0000574 rcu_read_lock();
Rémi Denis-Courmontc1dc13e2009-07-21 01:57:57 +0000575 return *pos ? pn_sock_get_idx(seq, *pos - 1) : SEQ_START_TOKEN;
576}
577
578static void *pn_sock_seq_next(struct seq_file *seq, void *v, loff_t *pos)
579{
580 struct sock *sk;
581
582 if (v == SEQ_START_TOKEN)
583 sk = pn_sock_get_idx(seq, 0);
584 else
585 sk = pn_sock_get_next(seq, v);
586 (*pos)++;
587 return sk;
588}
589
590static void pn_sock_seq_stop(struct seq_file *seq, void *v)
Rémi Denis-Courmont44f4d5a2011-04-12 23:27:36 +0000591 __releases(rcu)
Rémi Denis-Courmontc1dc13e2009-07-21 01:57:57 +0000592{
Rémi Denis-Courmont44f4d5a2011-04-12 23:27:36 +0000593 rcu_read_unlock();
Rémi Denis-Courmontc1dc13e2009-07-21 01:57:57 +0000594}
595
596static int pn_sock_seq_show(struct seq_file *seq, void *v)
597{
Tetsuo Handa652586d2013-11-14 14:31:57 -0800598 seq_setwidth(seq, 127);
Rémi Denis-Courmontc1dc13e2009-07-21 01:57:57 +0000599 if (v == SEQ_START_TOKEN)
Tetsuo Handa652586d2013-11-14 14:31:57 -0800600 seq_puts(seq, "pt loc rem rs st tx_queue rx_queue "
601 " uid inode ref pointer drops");
Rémi Denis-Courmontc1dc13e2009-07-21 01:57:57 +0000602 else {
603 struct sock *sk = v;
604 struct pn_sock *pn = pn_sk(sk);
605
606 seq_printf(seq, "%2d %04X:%04X:%02X %02X %08X:%08X %5d %lu "
Tetsuo Handa652586d2013-11-14 14:31:57 -0800607 "%d %pK %d",
Rémi Denis-Courmonta8059512011-02-24 23:14:57 +0000608 sk->sk_protocol, pn->sobject, pn->dobject,
609 pn->resource, sk->sk_state,
Rémi Denis-Courmontc1dc13e2009-07-21 01:57:57 +0000610 sk_wmem_alloc_get(sk), sk_rmem_alloc_get(sk),
Eric W. Biedermana7cb5a42012-05-24 01:10:10 -0600611 from_kuid_munged(seq_user_ns(seq), sock_i_uid(sk)),
612 sock_i_ino(sk),
Rémi Denis-Courmontc1dc13e2009-07-21 01:57:57 +0000613 atomic_read(&sk->sk_refcnt), sk,
Tetsuo Handa652586d2013-11-14 14:31:57 -0800614 atomic_read(&sk->sk_drops));
Rémi Denis-Courmontc1dc13e2009-07-21 01:57:57 +0000615 }
Tetsuo Handa652586d2013-11-14 14:31:57 -0800616 seq_pad(seq, '\n');
Rémi Denis-Courmontc1dc13e2009-07-21 01:57:57 +0000617 return 0;
618}
619
620static const struct seq_operations pn_sock_seq_ops = {
621 .start = pn_sock_seq_start,
622 .next = pn_sock_seq_next,
623 .stop = pn_sock_seq_stop,
624 .show = pn_sock_seq_show,
625};
626
627static int pn_sock_open(struct inode *inode, struct file *file)
628{
Rémi Denis-Courmontcb7d9e7f2009-08-11 03:12:07 +0000629 return seq_open_net(inode, file, &pn_sock_seq_ops,
630 sizeof(struct seq_net_private));
Rémi Denis-Courmontc1dc13e2009-07-21 01:57:57 +0000631}
632
633const struct file_operations pn_sock_seq_fops = {
634 .owner = THIS_MODULE,
635 .open = pn_sock_open,
636 .read = seq_read,
637 .llseek = seq_lseek,
Rémi Denis-Courmontcb7d9e7f2009-08-11 03:12:07 +0000638 .release = seq_release_net,
Rémi Denis-Courmontc1dc13e2009-07-21 01:57:57 +0000639};
Randy Dunlapae6e2ae2009-08-17 10:35:49 +0000640#endif
Rémi Denis-Courmont4e3d16c2010-09-15 12:30:11 +0000641
642static struct {
643 struct sock *sk[256];
644} pnres;
645
646/*
647 * Find and hold socket based on resource.
648 */
649struct sock *pn_find_sock_by_res(struct net *net, u8 res)
650{
651 struct sock *sk;
652
653 if (!net_eq(net, &init_net))
654 return NULL;
655
656 rcu_read_lock();
657 sk = rcu_dereference(pnres.sk[res]);
658 if (sk)
659 sock_hold(sk);
660 rcu_read_unlock();
661 return sk;
662}
663
664static DEFINE_MUTEX(resource_mutex);
665
666int pn_sock_bind_res(struct sock *sk, u8 res)
667{
668 int ret = -EADDRINUSE;
669
670 if (!net_eq(sock_net(sk), &init_net))
671 return -ENOIOCTLCMD;
672 if (!capable(CAP_SYS_ADMIN))
673 return -EPERM;
674 if (pn_socket_autobind(sk->sk_socket))
675 return -EAGAIN;
676
677 mutex_lock(&resource_mutex);
678 if (pnres.sk[res] == NULL) {
679 sock_hold(sk);
Eric Dumazetcf778b02012-01-12 04:41:32 +0000680 rcu_assign_pointer(pnres.sk[res], sk);
Rémi Denis-Courmont4e3d16c2010-09-15 12:30:11 +0000681 ret = 0;
682 }
683 mutex_unlock(&resource_mutex);
684 return ret;
685}
686
687int pn_sock_unbind_res(struct sock *sk, u8 res)
688{
689 int ret = -ENOENT;
690
691 if (!capable(CAP_SYS_ADMIN))
692 return -EPERM;
693
694 mutex_lock(&resource_mutex);
695 if (pnres.sk[res] == sk) {
Stephen Hemmingera9b3cd72011-08-01 16:19:00 +0000696 RCU_INIT_POINTER(pnres.sk[res], NULL);
Rémi Denis-Courmont4e3d16c2010-09-15 12:30:11 +0000697 ret = 0;
698 }
699 mutex_unlock(&resource_mutex);
700
701 if (ret == 0) {
702 synchronize_rcu();
703 sock_put(sk);
704 }
705 return ret;
706}
707
708void pn_sock_unbind_all_res(struct sock *sk)
709{
Eric Dumazet95c96172012-04-15 05:58:06 +0000710 unsigned int res, match = 0;
Rémi Denis-Courmont4e3d16c2010-09-15 12:30:11 +0000711
712 mutex_lock(&resource_mutex);
713 for (res = 0; res < 256; res++) {
714 if (pnres.sk[res] == sk) {
Stephen Hemmingera9b3cd72011-08-01 16:19:00 +0000715 RCU_INIT_POINTER(pnres.sk[res], NULL);
Rémi Denis-Courmont4e3d16c2010-09-15 12:30:11 +0000716 match++;
717 }
718 }
719 mutex_unlock(&resource_mutex);
720
Rémi Denis-Courmont4e3d16c2010-09-15 12:30:11 +0000721 while (match > 0) {
Rémi Denis-Courmont44f4d5a2011-04-12 23:27:36 +0000722 __sock_put(sk);
Rémi Denis-Courmont4e3d16c2010-09-15 12:30:11 +0000723 match--;
724 }
Rémi Denis-Courmont44f4d5a2011-04-12 23:27:36 +0000725 /* Caller is responsible for RCU sync before final sock_put() */
Rémi Denis-Courmont4e3d16c2010-09-15 12:30:11 +0000726}
Rémi Denis-Courmont507215f2010-09-15 12:30:14 +0000727
728#ifdef CONFIG_PROC_FS
729static struct sock **pn_res_get_idx(struct seq_file *seq, loff_t pos)
730{
731 struct net *net = seq_file_net(seq);
Eric Dumazet95c96172012-04-15 05:58:06 +0000732 unsigned int i;
Rémi Denis-Courmont507215f2010-09-15 12:30:14 +0000733
734 if (!net_eq(net, &init_net))
735 return NULL;
736
737 for (i = 0; i < 256; i++) {
738 if (pnres.sk[i] == NULL)
739 continue;
740 if (!pos)
741 return pnres.sk + i;
742 pos--;
743 }
744 return NULL;
745}
746
747static struct sock **pn_res_get_next(struct seq_file *seq, struct sock **sk)
748{
749 struct net *net = seq_file_net(seq);
Eric Dumazet95c96172012-04-15 05:58:06 +0000750 unsigned int i;
Rémi Denis-Courmont507215f2010-09-15 12:30:14 +0000751
752 BUG_ON(!net_eq(net, &init_net));
753
754 for (i = (sk - pnres.sk) + 1; i < 256; i++)
755 if (pnres.sk[i])
756 return pnres.sk + i;
757 return NULL;
758}
759
760static void *pn_res_seq_start(struct seq_file *seq, loff_t *pos)
761 __acquires(resource_mutex)
762{
763 mutex_lock(&resource_mutex);
764 return *pos ? pn_res_get_idx(seq, *pos - 1) : SEQ_START_TOKEN;
765}
766
767static void *pn_res_seq_next(struct seq_file *seq, void *v, loff_t *pos)
768{
769 struct sock **sk;
770
771 if (v == SEQ_START_TOKEN)
772 sk = pn_res_get_idx(seq, 0);
773 else
774 sk = pn_res_get_next(seq, v);
775 (*pos)++;
776 return sk;
777}
778
779static void pn_res_seq_stop(struct seq_file *seq, void *v)
780 __releases(resource_mutex)
781{
782 mutex_unlock(&resource_mutex);
783}
784
785static int pn_res_seq_show(struct seq_file *seq, void *v)
786{
Tetsuo Handa652586d2013-11-14 14:31:57 -0800787 seq_setwidth(seq, 63);
Rémi Denis-Courmont507215f2010-09-15 12:30:14 +0000788 if (v == SEQ_START_TOKEN)
Tetsuo Handa652586d2013-11-14 14:31:57 -0800789 seq_puts(seq, "rs uid inode");
Rémi Denis-Courmont507215f2010-09-15 12:30:14 +0000790 else {
791 struct sock **psk = v;
792 struct sock *sk = *psk;
793
Tetsuo Handa652586d2013-11-14 14:31:57 -0800794 seq_printf(seq, "%02X %5u %lu",
Eric W. Biedermana7cb5a42012-05-24 01:10:10 -0600795 (int) (psk - pnres.sk),
796 from_kuid_munged(seq_user_ns(seq), sock_i_uid(sk)),
Tetsuo Handa652586d2013-11-14 14:31:57 -0800797 sock_i_ino(sk));
Rémi Denis-Courmont507215f2010-09-15 12:30:14 +0000798 }
Tetsuo Handa652586d2013-11-14 14:31:57 -0800799 seq_pad(seq, '\n');
Rémi Denis-Courmont507215f2010-09-15 12:30:14 +0000800 return 0;
801}
802
803static const struct seq_operations pn_res_seq_ops = {
804 .start = pn_res_seq_start,
805 .next = pn_res_seq_next,
806 .stop = pn_res_seq_stop,
807 .show = pn_res_seq_show,
808};
809
810static int pn_res_open(struct inode *inode, struct file *file)
811{
812 return seq_open_net(inode, file, &pn_res_seq_ops,
813 sizeof(struct seq_net_private));
814}
815
816const struct file_operations pn_res_seq_fops = {
817 .owner = THIS_MODULE,
818 .open = pn_res_open,
819 .read = seq_read,
820 .llseek = seq_lseek,
821 .release = seq_release_net,
822};
823#endif