1 // SPDX-License-Identifier: GPL-2.0-only
7 * Copyright (C) 2008 Nokia Corporation.
10 * Rémi Denis-Courmont
13 #include <linux/gfp.h>
14 #include <linux/kernel.h>
15 #include <linux/net.h>
16 #include <linux/poll.h>
17 #include <linux/sched/signal.h>
20 #include <net/tcp_states.h>
22 #include <linux/phonet.h>
23 #include <linux/export.h>
24 #include <net/phonet/phonet.h>
25 #include <net/phonet/pep.h>
26 #include <net/phonet/pn_dev.h>
28 static int pn_socket_release(struct socket *sock)
30 struct sock *sk = sock->sk;
34 sk->sk_prot->close(sk, 0);
39 #define PN_HASHSIZE 16
40 #define PN_HASHMASK (PN_HASHSIZE-1)
44 struct hlist_head hlist[PN_HASHSIZE];
48 void __init pn_sock_init(void)
52 for (i = 0; i < PN_HASHSIZE; i++)
53 INIT_HLIST_HEAD(pnsocks.hlist + i);
54 mutex_init(&pnsocks.lock);
57 static struct hlist_head *pn_hash_list(u16 obj)
59 return pnsocks.hlist + (obj & PN_HASHMASK);
63 * Find address based on socket address, match only certain fields.
64 * Also grab sock if it was found. Remember to sock_put it later.
66 struct sock *pn_find_sock_by_sa(struct net *net, const struct sockaddr_pn *spn)
69 struct sock *rval = NULL;
70 u16 obj = pn_sockaddr_get_object(spn);
71 u8 res = spn->spn_resource;
72 struct hlist_head *hlist = pn_hash_list(obj);
75 sk_for_each_rcu(sknode, hlist) {
76 struct pn_sock *pn = pn_sk(sknode);
77 BUG_ON(!pn->sobject); /* unbound socket */
79 if (!net_eq(sock_net(sknode), net))
82 /* Look up socket by port */
83 if (pn_port(pn->sobject) != pn_port(obj))
86 /* If port is zero, look up by resource */
87 if (pn->resource != res)
90 if (pn_addr(pn->sobject) &&
91 pn_addr(pn->sobject) != pn_addr(obj))
103 /* Deliver a broadcast packet (only in bottom-half) */
104 void pn_deliver_sock_broadcast(struct net *net, struct sk_buff *skb)
106 struct hlist_head *hlist = pnsocks.hlist;
110 for (h = 0; h < PN_HASHSIZE; h++) {
113 sk_for_each(sknode, hlist) {
114 struct sk_buff *clone;
116 if (!net_eq(sock_net(sknode), net))
118 if (!sock_flag(sknode, SOCK_BROADCAST))
121 clone = skb_clone(skb, GFP_ATOMIC);
124 sk_receive_skb(sknode, clone, 0);
132 int pn_sock_hash(struct sock *sk)
134 struct hlist_head *hlist = pn_hash_list(pn_sk(sk)->sobject);
136 mutex_lock(&pnsocks.lock);
137 sk_add_node_rcu(sk, hlist);
138 mutex_unlock(&pnsocks.lock);
142 EXPORT_SYMBOL(pn_sock_hash);
144 void pn_sock_unhash(struct sock *sk)
146 mutex_lock(&pnsocks.lock);
147 sk_del_node_init_rcu(sk);
148 mutex_unlock(&pnsocks.lock);
149 pn_sock_unbind_all_res(sk);
152 EXPORT_SYMBOL(pn_sock_unhash);
154 static DEFINE_MUTEX(port_mutex);
156 static int pn_socket_bind(struct socket *sock, struct sockaddr *addr, int len)
158 struct sock *sk = sock->sk;
159 struct pn_sock *pn = pn_sk(sk);
160 struct sockaddr_pn *spn = (struct sockaddr_pn *)addr;
165 if (sk->sk_prot->bind)
166 return sk->sk_prot->bind(sk, addr, len);
168 if (len < sizeof(struct sockaddr_pn))
170 if (spn->spn_family != AF_PHONET)
171 return -EAFNOSUPPORT;
173 handle = pn_sockaddr_get_object((struct sockaddr_pn *)addr);
174 saddr = pn_addr(handle);
175 if (saddr && phonet_address_lookup(sock_net(sk), saddr))
176 return -EADDRNOTAVAIL;
179 if (sk->sk_state != TCP_CLOSE || pn_port(pn->sobject)) {
180 err = -EINVAL; /* attempt to rebind */
183 WARN_ON(sk_hashed(sk));
184 mutex_lock(&port_mutex);
185 err = sk->sk_prot->get_port(sk, pn_port(handle));
189 /* get_port() sets the port, bind() sets the address if applicable */
190 pn->sobject = pn_object(saddr, pn_port(pn->sobject));
191 pn->resource = spn->spn_resource;
193 /* Enable RX on the socket */
194 err = sk->sk_prot->hash(sk);
196 mutex_unlock(&port_mutex);
202 static int pn_socket_autobind(struct socket *sock)
204 struct sockaddr_pn sa;
207 memset(&sa, 0, sizeof(sa));
208 sa.spn_family = AF_PHONET;
209 err = pn_socket_bind(sock, (struct sockaddr *)&sa,
210 sizeof(struct sockaddr_pn));
213 BUG_ON(!pn_port(pn_sk(sock->sk)->sobject));
214 return 0; /* socket was already bound */
217 static int pn_socket_connect(struct socket *sock, struct sockaddr *addr,
220 struct sock *sk = sock->sk;
221 struct pn_sock *pn = pn_sk(sk);
222 struct sockaddr_pn *spn = (struct sockaddr_pn *)addr;
223 struct task_struct *tsk = current;
224 long timeo = sock_rcvtimeo(sk, flags & O_NONBLOCK);
227 if (pn_socket_autobind(sock))
229 if (len < sizeof(struct sockaddr_pn))
231 if (spn->spn_family != AF_PHONET)
232 return -EAFNOSUPPORT;
236 switch (sock->state) {
238 if (sk->sk_state != TCP_CLOSE) {
251 pn->dobject = pn_sockaddr_get_object(spn);
252 pn->resource = pn_sockaddr_get_resource(spn);
253 sock->state = SS_CONNECTING;
255 err = sk->sk_prot->connect(sk, addr, len);
257 sock->state = SS_UNCONNECTED;
262 while (sk->sk_state == TCP_SYN_SENT) {
269 if (signal_pending(tsk)) {
270 err = sock_intr_errno(timeo);
274 prepare_to_wait_exclusive(sk_sleep(sk), &wait,
277 timeo = schedule_timeout(timeo);
279 finish_wait(sk_sleep(sk), &wait);
282 if ((1 << sk->sk_state) & (TCPF_SYN_RECV|TCPF_ESTABLISHED))
284 else if (sk->sk_state == TCP_CLOSE_WAIT)
288 sock->state = err ? SS_UNCONNECTED : SS_CONNECTED;
294 static int pn_socket_accept(struct socket *sock, struct socket *newsock,
295 int flags, bool kern)
297 struct sock *sk = sock->sk;
301 if (unlikely(sk->sk_state != TCP_LISTEN))
304 newsk = sk->sk_prot->accept(sk, flags, &err, kern);
309 sock_graft(newsk, newsock);
310 newsock->state = SS_CONNECTED;
315 static int pn_socket_getname(struct socket *sock, struct sockaddr *addr,
318 struct sock *sk = sock->sk;
319 struct pn_sock *pn = pn_sk(sk);
321 memset(addr, 0, sizeof(struct sockaddr_pn));
322 addr->sa_family = AF_PHONET;
323 if (!peer) /* Race with bind() here is userland's problem. */
324 pn_sockaddr_set_object((struct sockaddr_pn *)addr,
327 return sizeof(struct sockaddr_pn);
330 static __poll_t pn_socket_poll(struct file *file, struct socket *sock,
333 struct sock *sk = sock->sk;
334 struct pep_sock *pn = pep_sk(sk);
337 poll_wait(file, sk_sleep(sk), wait);
339 if (sk->sk_state == TCP_CLOSE)
341 if (!skb_queue_empty_lockless(&sk->sk_receive_queue))
342 mask |= EPOLLIN | EPOLLRDNORM;
343 if (!skb_queue_empty_lockless(&pn->ctrlreq_queue))
345 if (!mask && sk->sk_state == TCP_CLOSE_WAIT)
348 if (sk->sk_state == TCP_ESTABLISHED &&
349 refcount_read(&sk->sk_wmem_alloc) < sk->sk_sndbuf &&
350 atomic_read(&pn->tx_credits))
351 mask |= EPOLLOUT | EPOLLWRNORM | EPOLLWRBAND;
356 static int pn_socket_ioctl(struct socket *sock, unsigned int cmd,
359 struct sock *sk = sock->sk;
360 struct pn_sock *pn = pn_sk(sk);
362 if (cmd == SIOCPNGETOBJECT) {
363 struct net_device *dev;
367 if (get_user(handle, (__u16 __user *)arg))
371 if (sk->sk_bound_dev_if)
372 dev = dev_get_by_index(sock_net(sk),
373 sk->sk_bound_dev_if);
375 dev = phonet_device_get(sock_net(sk));
376 if (dev && (dev->flags & IFF_UP))
377 saddr = phonet_address_get(dev, pn_addr(handle));
384 if (saddr == PN_NO_ADDR)
385 return -EHOSTUNREACH;
387 handle = pn_object(saddr, pn_port(pn->sobject));
388 return put_user(handle, (__u16 __user *)arg);
391 return sk->sk_prot->ioctl(sk, cmd, arg);
394 static int pn_socket_listen(struct socket *sock, int backlog)
396 struct sock *sk = sock->sk;
399 if (pn_socket_autobind(sock))
403 if (sock->state != SS_UNCONNECTED) {
408 if (sk->sk_state != TCP_LISTEN) {
409 sk->sk_state = TCP_LISTEN;
410 sk->sk_ack_backlog = 0;
412 sk->sk_max_ack_backlog = backlog;
418 static int pn_socket_sendmsg(struct socket *sock, struct msghdr *m,
421 struct sock *sk = sock->sk;
423 if (pn_socket_autobind(sock))
426 return sk->sk_prot->sendmsg(sk, m, total_len);
429 const struct proto_ops phonet_dgram_ops = {
431 .owner = THIS_MODULE,
432 .release = pn_socket_release,
433 .bind = pn_socket_bind,
434 .connect = sock_no_connect,
435 .socketpair = sock_no_socketpair,
436 .accept = sock_no_accept,
437 .getname = pn_socket_getname,
438 .poll = datagram_poll,
439 .ioctl = pn_socket_ioctl,
440 .listen = sock_no_listen,
441 .shutdown = sock_no_shutdown,
442 .sendmsg = pn_socket_sendmsg,
443 .recvmsg = sock_common_recvmsg,
444 .mmap = sock_no_mmap,
445 .sendpage = sock_no_sendpage,
448 const struct proto_ops phonet_stream_ops = {
450 .owner = THIS_MODULE,
451 .release = pn_socket_release,
452 .bind = pn_socket_bind,
453 .connect = pn_socket_connect,
454 .socketpair = sock_no_socketpair,
455 .accept = pn_socket_accept,
456 .getname = pn_socket_getname,
457 .poll = pn_socket_poll,
458 .ioctl = pn_socket_ioctl,
459 .listen = pn_socket_listen,
460 .shutdown = sock_no_shutdown,
461 .setsockopt = sock_common_setsockopt,
462 .getsockopt = sock_common_getsockopt,
463 .sendmsg = pn_socket_sendmsg,
464 .recvmsg = sock_common_recvmsg,
465 .mmap = sock_no_mmap,
466 .sendpage = sock_no_sendpage,
468 EXPORT_SYMBOL(phonet_stream_ops);
470 /* allocate port for a socket */
471 int pn_sock_get_port(struct sock *sk, unsigned short sport)
474 struct net *net = sock_net(sk);
475 struct pn_sock *pn = pn_sk(sk);
476 struct sockaddr_pn try_sa;
479 memset(&try_sa, 0, sizeof(struct sockaddr_pn));
480 try_sa.spn_family = AF_PHONET;
481 WARN_ON(!mutex_is_locked(&port_mutex));
483 /* search free port */
484 int port, pmin, pmax;
486 phonet_get_local_port_range(&pmin, &pmax);
487 for (port = pmin; port <= pmax; port++) {
489 if (port_cur < pmin || port_cur > pmax)
492 pn_sockaddr_set_port(&try_sa, port_cur);
493 tmpsk = pn_find_sock_by_sa(net, &try_sa);
501 /* try to find specific port */
502 pn_sockaddr_set_port(&try_sa, sport);
503 tmpsk = pn_find_sock_by_sa(net, &try_sa);
505 /* No sock there! We can use that port... */
510 /* the port must be in use already */
514 pn->sobject = pn_object(pn_addr(pn->sobject), sport);
517 EXPORT_SYMBOL(pn_sock_get_port);
519 #ifdef CONFIG_PROC_FS
520 static struct sock *pn_sock_get_idx(struct seq_file *seq, loff_t pos)
522 struct net *net = seq_file_net(seq);
523 struct hlist_head *hlist = pnsocks.hlist;
527 for (h = 0; h < PN_HASHSIZE; h++) {
528 sk_for_each_rcu(sknode, hlist) {
529 if (!net_eq(net, sock_net(sknode)))
540 static struct sock *pn_sock_get_next(struct seq_file *seq, struct sock *sk)
542 struct net *net = seq_file_net(seq);
546 while (sk && !net_eq(net, sock_net(sk)));
551 static void *pn_sock_seq_start(struct seq_file *seq, loff_t *pos)
555 return *pos ? pn_sock_get_idx(seq, *pos - 1) : SEQ_START_TOKEN;
558 static void *pn_sock_seq_next(struct seq_file *seq, void *v, loff_t *pos)
562 if (v == SEQ_START_TOKEN)
563 sk = pn_sock_get_idx(seq, 0);
565 sk = pn_sock_get_next(seq, v);
570 static void pn_sock_seq_stop(struct seq_file *seq, void *v)
576 static int pn_sock_seq_show(struct seq_file *seq, void *v)
578 seq_setwidth(seq, 127);
579 if (v == SEQ_START_TOKEN)
580 seq_puts(seq, "pt loc rem rs st tx_queue rx_queue "
581 " uid inode ref pointer drops");
584 struct pn_sock *pn = pn_sk(sk);
586 seq_printf(seq, "%2d %04X:%04X:%02X %02X %08X:%08X %5d %lu "
588 sk->sk_protocol, pn->sobject, pn->dobject,
589 pn->resource, sk->sk_state,
590 sk_wmem_alloc_get(sk), sk_rmem_alloc_get(sk),
591 from_kuid_munged(seq_user_ns(seq), sock_i_uid(sk)),
593 refcount_read(&sk->sk_refcnt), sk,
594 atomic_read(&sk->sk_drops));
600 const struct seq_operations pn_sock_seq_ops = {
601 .start = pn_sock_seq_start,
602 .next = pn_sock_seq_next,
603 .stop = pn_sock_seq_stop,
604 .show = pn_sock_seq_show,
609 struct sock *sk[256];
613 * Find and hold socket based on resource.
615 struct sock *pn_find_sock_by_res(struct net *net, u8 res)
619 if (!net_eq(net, &init_net))
623 sk = rcu_dereference(pnres.sk[res]);
630 static DEFINE_MUTEX(resource_mutex);
632 int pn_sock_bind_res(struct sock *sk, u8 res)
634 int ret = -EADDRINUSE;
636 if (!net_eq(sock_net(sk), &init_net))
638 if (!capable(CAP_SYS_ADMIN))
640 if (pn_socket_autobind(sk->sk_socket))
643 mutex_lock(&resource_mutex);
644 if (pnres.sk[res] == NULL) {
646 rcu_assign_pointer(pnres.sk[res], sk);
649 mutex_unlock(&resource_mutex);
653 int pn_sock_unbind_res(struct sock *sk, u8 res)
657 if (!capable(CAP_SYS_ADMIN))
660 mutex_lock(&resource_mutex);
661 if (pnres.sk[res] == sk) {
662 RCU_INIT_POINTER(pnres.sk[res], NULL);
665 mutex_unlock(&resource_mutex);
674 void pn_sock_unbind_all_res(struct sock *sk)
676 unsigned int res, match = 0;
678 mutex_lock(&resource_mutex);
679 for (res = 0; res < 256; res++) {
680 if (pnres.sk[res] == sk) {
681 RCU_INIT_POINTER(pnres.sk[res], NULL);
685 mutex_unlock(&resource_mutex);
691 /* Caller is responsible for RCU sync before final sock_put() */
694 #ifdef CONFIG_PROC_FS
695 static struct sock **pn_res_get_idx(struct seq_file *seq, loff_t pos)
697 struct net *net = seq_file_net(seq);
700 if (!net_eq(net, &init_net))
703 for (i = 0; i < 256; i++) {
704 if (pnres.sk[i] == NULL)
713 static struct sock **pn_res_get_next(struct seq_file *seq, struct sock **sk)
715 struct net *net = seq_file_net(seq);
718 BUG_ON(!net_eq(net, &init_net));
720 for (i = (sk - pnres.sk) + 1; i < 256; i++)
726 static void *pn_res_seq_start(struct seq_file *seq, loff_t *pos)
727 __acquires(resource_mutex)
729 mutex_lock(&resource_mutex);
730 return *pos ? pn_res_get_idx(seq, *pos - 1) : SEQ_START_TOKEN;
733 static void *pn_res_seq_next(struct seq_file *seq, void *v, loff_t *pos)
737 if (v == SEQ_START_TOKEN)
738 sk = pn_res_get_idx(seq, 0);
740 sk = pn_res_get_next(seq, v);
745 static void pn_res_seq_stop(struct seq_file *seq, void *v)
746 __releases(resource_mutex)
748 mutex_unlock(&resource_mutex);
751 static int pn_res_seq_show(struct seq_file *seq, void *v)
753 seq_setwidth(seq, 63);
754 if (v == SEQ_START_TOKEN)
755 seq_puts(seq, "rs uid inode");
757 struct sock **psk = v;
758 struct sock *sk = *psk;
760 seq_printf(seq, "%02X %5u %lu",
761 (int) (psk - pnres.sk),
762 from_kuid_munged(seq_user_ns(seq), sock_i_uid(sk)),
769 const struct seq_operations pn_res_seq_ops = {
770 .start = pn_res_seq_start,
771 .next = pn_res_seq_next,
772 .stop = pn_res_seq_stop,
773 .show = pn_res_seq_show,