^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * File: socket.c
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Phonet sockets
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * Copyright (C) 2008 Nokia Corporation.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) * Authors: Sakari Ailus <sakari.ailus@nokia.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) * Rémi Denis-Courmont
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/gfp.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/net.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/poll.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/sched/signal.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <net/sock.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include <net/tcp_states.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #include <linux/phonet.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #include <linux/export.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #include <net/phonet/phonet.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #include <net/phonet/pep.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #include <net/phonet/pn_dev.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) static int pn_socket_release(struct socket *sock)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) struct sock *sk = sock->sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) if (sk) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) sock->sk = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) sk->sk_prot->close(sk, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) #define PN_HASHSIZE 16
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) #define PN_HASHMASK (PN_HASHSIZE-1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) static struct {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) struct hlist_head hlist[PN_HASHSIZE];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) struct mutex lock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) } pnsocks;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) void __init pn_sock_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) unsigned int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) for (i = 0; i < PN_HASHSIZE; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) INIT_HLIST_HEAD(pnsocks.hlist + i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) mutex_init(&pnsocks.lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) static struct hlist_head *pn_hash_list(u16 obj)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) return pnsocks.hlist + (obj & PN_HASHMASK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) * Find address based on socket address, match only certain fields.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) * Also grab sock if it was found. Remember to sock_put it later.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) struct sock *pn_find_sock_by_sa(struct net *net, const struct sockaddr_pn *spn)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) struct sock *sknode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) struct sock *rval = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) u16 obj = pn_sockaddr_get_object(spn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) u8 res = spn->spn_resource;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) struct hlist_head *hlist = pn_hash_list(obj);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) rcu_read_lock();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) sk_for_each_rcu(sknode, hlist) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) struct pn_sock *pn = pn_sk(sknode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) BUG_ON(!pn->sobject); /* unbound socket */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) if (!net_eq(sock_net(sknode), net))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) if (pn_port(obj)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) /* Look up socket by port */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) if (pn_port(pn->sobject) != pn_port(obj))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) /* If port is zero, look up by resource */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) if (pn->resource != res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) if (pn_addr(pn->sobject) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) pn_addr(pn->sobject) != pn_addr(obj))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) rval = sknode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) sock_hold(sknode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) rcu_read_unlock();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) return rval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) /* Deliver a broadcast packet (only in bottom-half) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) void pn_deliver_sock_broadcast(struct net *net, struct sk_buff *skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) struct hlist_head *hlist = pnsocks.hlist;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) unsigned int h;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) rcu_read_lock();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) for (h = 0; h < PN_HASHSIZE; h++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) struct sock *sknode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) sk_for_each(sknode, hlist) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) struct sk_buff *clone;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) if (!net_eq(sock_net(sknode), net))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) if (!sock_flag(sknode, SOCK_BROADCAST))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) clone = skb_clone(skb, GFP_ATOMIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) if (clone) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) sock_hold(sknode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) sk_receive_skb(sknode, clone, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) hlist++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) rcu_read_unlock();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) int pn_sock_hash(struct sock *sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) struct hlist_head *hlist = pn_hash_list(pn_sk(sk)->sobject);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) mutex_lock(&pnsocks.lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) sk_add_node_rcu(sk, hlist);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) mutex_unlock(&pnsocks.lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) EXPORT_SYMBOL(pn_sock_hash);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) void pn_sock_unhash(struct sock *sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) mutex_lock(&pnsocks.lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) sk_del_node_init_rcu(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) mutex_unlock(&pnsocks.lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) pn_sock_unbind_all_res(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) synchronize_rcu();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) EXPORT_SYMBOL(pn_sock_unhash);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) static DEFINE_MUTEX(port_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) static int pn_socket_bind(struct socket *sock, struct sockaddr *addr, int len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) struct sock *sk = sock->sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) struct pn_sock *pn = pn_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) struct sockaddr_pn *spn = (struct sockaddr_pn *)addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) u16 handle;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) u8 saddr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) if (sk->sk_prot->bind)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) return sk->sk_prot->bind(sk, addr, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) if (len < sizeof(struct sockaddr_pn))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) if (spn->spn_family != AF_PHONET)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) return -EAFNOSUPPORT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) handle = pn_sockaddr_get_object((struct sockaddr_pn *)addr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) saddr = pn_addr(handle);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) if (saddr && phonet_address_lookup(sock_net(sk), saddr))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) return -EADDRNOTAVAIL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) lock_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) if (sk->sk_state != TCP_CLOSE || pn_port(pn->sobject)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) err = -EINVAL; /* attempt to rebind */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) WARN_ON(sk_hashed(sk));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) mutex_lock(&port_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) err = sk->sk_prot->get_port(sk, pn_port(handle));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) goto out_port;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) /* get_port() sets the port, bind() sets the address if applicable */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) pn->sobject = pn_object(saddr, pn_port(pn->sobject));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) pn->resource = spn->spn_resource;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) /* Enable RX on the socket */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) err = sk->sk_prot->hash(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) out_port:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) mutex_unlock(&port_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) static int pn_socket_autobind(struct socket *sock)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) struct sockaddr_pn sa;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) memset(&sa, 0, sizeof(sa));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) sa.spn_family = AF_PHONET;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) err = pn_socket_bind(sock, (struct sockaddr *)&sa,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) sizeof(struct sockaddr_pn));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) if (err != -EINVAL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) BUG_ON(!pn_port(pn_sk(sock->sk)->sobject));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) return 0; /* socket was already bound */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) static int pn_socket_connect(struct socket *sock, struct sockaddr *addr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) int len, int flags)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) struct sock *sk = sock->sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) struct pn_sock *pn = pn_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) struct sockaddr_pn *spn = (struct sockaddr_pn *)addr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) struct task_struct *tsk = current;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) long timeo = sock_rcvtimeo(sk, flags & O_NONBLOCK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) if (pn_socket_autobind(sock))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) return -ENOBUFS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) if (len < sizeof(struct sockaddr_pn))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) if (spn->spn_family != AF_PHONET)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) return -EAFNOSUPPORT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) lock_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) switch (sock->state) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) case SS_UNCONNECTED:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) if (sk->sk_state != TCP_CLOSE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) err = -EISCONN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) case SS_CONNECTING:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) err = -EALREADY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) err = -EISCONN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) pn->dobject = pn_sockaddr_get_object(spn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) pn->resource = pn_sockaddr_get_resource(spn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) sock->state = SS_CONNECTING;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) err = sk->sk_prot->connect(sk, addr, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) if (err) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) sock->state = SS_UNCONNECTED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) pn->dobject = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) while (sk->sk_state == TCP_SYN_SENT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) DEFINE_WAIT(wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) if (!timeo) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) err = -EINPROGRESS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) if (signal_pending(tsk)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) err = sock_intr_errno(timeo);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) prepare_to_wait_exclusive(sk_sleep(sk), &wait,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) TASK_INTERRUPTIBLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) timeo = schedule_timeout(timeo);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) lock_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) finish_wait(sk_sleep(sk), &wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) if ((1 << sk->sk_state) & (TCPF_SYN_RECV|TCPF_ESTABLISHED))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) err = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) else if (sk->sk_state == TCP_CLOSE_WAIT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) err = -ECONNRESET;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) err = -ECONNREFUSED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) sock->state = err ? SS_UNCONNECTED : SS_CONNECTED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) static int pn_socket_accept(struct socket *sock, struct socket *newsock,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) int flags, bool kern)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) struct sock *sk = sock->sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) struct sock *newsk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) if (unlikely(sk->sk_state != TCP_LISTEN))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) newsk = sk->sk_prot->accept(sk, flags, &err, kern);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) if (!newsk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) lock_sock(newsk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) sock_graft(newsk, newsock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) newsock->state = SS_CONNECTED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) release_sock(newsk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) static int pn_socket_getname(struct socket *sock, struct sockaddr *addr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) int peer)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) struct sock *sk = sock->sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) struct pn_sock *pn = pn_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) memset(addr, 0, sizeof(struct sockaddr_pn));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) addr->sa_family = AF_PHONET;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) if (!peer) /* Race with bind() here is userland's problem. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) pn_sockaddr_set_object((struct sockaddr_pn *)addr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) pn->sobject);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) return sizeof(struct sockaddr_pn);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) static __poll_t pn_socket_poll(struct file *file, struct socket *sock,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) poll_table *wait)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) struct sock *sk = sock->sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) struct pep_sock *pn = pep_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) __poll_t mask = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) poll_wait(file, sk_sleep(sk), wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) if (sk->sk_state == TCP_CLOSE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) return EPOLLERR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) if (!skb_queue_empty_lockless(&sk->sk_receive_queue))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) mask |= EPOLLIN | EPOLLRDNORM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) if (!skb_queue_empty_lockless(&pn->ctrlreq_queue))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) mask |= EPOLLPRI;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) if (!mask && sk->sk_state == TCP_CLOSE_WAIT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) return EPOLLHUP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) if (sk->sk_state == TCP_ESTABLISHED &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) refcount_read(&sk->sk_wmem_alloc) < sk->sk_sndbuf &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) atomic_read(&pn->tx_credits))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) mask |= EPOLLOUT | EPOLLWRNORM | EPOLLWRBAND;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) return mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) static int pn_socket_ioctl(struct socket *sock, unsigned int cmd,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) unsigned long arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) struct sock *sk = sock->sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) struct pn_sock *pn = pn_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) if (cmd == SIOCPNGETOBJECT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) struct net_device *dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) u16 handle;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) u8 saddr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) if (get_user(handle, (__u16 __user *)arg))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) lock_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) if (sk->sk_bound_dev_if)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) dev = dev_get_by_index(sock_net(sk),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) sk->sk_bound_dev_if);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) dev = phonet_device_get(sock_net(sk));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) if (dev && (dev->flags & IFF_UP))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) saddr = phonet_address_get(dev, pn_addr(handle));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) saddr = PN_NO_ADDR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) if (dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) dev_put(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) if (saddr == PN_NO_ADDR)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) return -EHOSTUNREACH;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) handle = pn_object(saddr, pn_port(pn->sobject));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) return put_user(handle, (__u16 __user *)arg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) return sk->sk_prot->ioctl(sk, cmd, arg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) static int pn_socket_listen(struct socket *sock, int backlog)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) struct sock *sk = sock->sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) int err = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) if (pn_socket_autobind(sock))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) return -ENOBUFS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) lock_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) if (sock->state != SS_UNCONNECTED) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) err = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) if (sk->sk_state != TCP_LISTEN) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) sk->sk_state = TCP_LISTEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) sk->sk_ack_backlog = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) sk->sk_max_ack_backlog = backlog;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) static int pn_socket_sendmsg(struct socket *sock, struct msghdr *m,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) size_t total_len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) struct sock *sk = sock->sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) if (pn_socket_autobind(sock))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) return -EAGAIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) return sk->sk_prot->sendmsg(sk, m, total_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) const struct proto_ops phonet_dgram_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) .family = AF_PHONET,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) .release = pn_socket_release,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) .bind = pn_socket_bind,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) .connect = sock_no_connect,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) .socketpair = sock_no_socketpair,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) .accept = sock_no_accept,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) .getname = pn_socket_getname,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) .poll = datagram_poll,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) .ioctl = pn_socket_ioctl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) .listen = sock_no_listen,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) .shutdown = sock_no_shutdown,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) .sendmsg = pn_socket_sendmsg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) .recvmsg = sock_common_recvmsg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) .mmap = sock_no_mmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) .sendpage = sock_no_sendpage,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) const struct proto_ops phonet_stream_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) .family = AF_PHONET,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) .release = pn_socket_release,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) .bind = pn_socket_bind,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) .connect = pn_socket_connect,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) .socketpair = sock_no_socketpair,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) .accept = pn_socket_accept,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) .getname = pn_socket_getname,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) .poll = pn_socket_poll,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) .ioctl = pn_socket_ioctl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) .listen = pn_socket_listen,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) .shutdown = sock_no_shutdown,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) .setsockopt = sock_common_setsockopt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) .getsockopt = sock_common_getsockopt,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) .sendmsg = pn_socket_sendmsg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) .recvmsg = sock_common_recvmsg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) .mmap = sock_no_mmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) .sendpage = sock_no_sendpage,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) EXPORT_SYMBOL(phonet_stream_ops);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) /* allocate port for a socket */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) int pn_sock_get_port(struct sock *sk, unsigned short sport)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) static int port_cur;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) struct net *net = sock_net(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) struct pn_sock *pn = pn_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) struct sockaddr_pn try_sa;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) struct sock *tmpsk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) memset(&try_sa, 0, sizeof(struct sockaddr_pn));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) try_sa.spn_family = AF_PHONET;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) WARN_ON(!mutex_is_locked(&port_mutex));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) if (!sport) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) /* search free port */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) int port, pmin, pmax;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) phonet_get_local_port_range(&pmin, &pmax);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) for (port = pmin; port <= pmax; port++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) port_cur++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) if (port_cur < pmin || port_cur > pmax)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) port_cur = pmin;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) pn_sockaddr_set_port(&try_sa, port_cur);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) tmpsk = pn_find_sock_by_sa(net, &try_sa);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) if (tmpsk == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) sport = port_cur;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) goto found;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) } else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) sock_put(tmpsk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) /* try to find specific port */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) pn_sockaddr_set_port(&try_sa, sport);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) tmpsk = pn_find_sock_by_sa(net, &try_sa);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) if (tmpsk == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) /* No sock there! We can use that port... */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) goto found;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) sock_put(tmpsk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) /* the port must be in use already */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) return -EADDRINUSE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) found:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) pn->sobject = pn_object(pn_addr(pn->sobject), sport);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) EXPORT_SYMBOL(pn_sock_get_port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) #ifdef CONFIG_PROC_FS
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) static struct sock *pn_sock_get_idx(struct seq_file *seq, loff_t pos)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) struct net *net = seq_file_net(seq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) struct hlist_head *hlist = pnsocks.hlist;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) struct sock *sknode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) unsigned int h;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) for (h = 0; h < PN_HASHSIZE; h++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) sk_for_each_rcu(sknode, hlist) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) if (!net_eq(net, sock_net(sknode)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) if (!pos)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) return sknode;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) pos--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) hlist++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) static struct sock *pn_sock_get_next(struct seq_file *seq, struct sock *sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) struct net *net = seq_file_net(seq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) do
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) sk = sk_next(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) while (sk && !net_eq(net, sock_net(sk)));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) return sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) static void *pn_sock_seq_start(struct seq_file *seq, loff_t *pos)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) __acquires(rcu)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) rcu_read_lock();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) return *pos ? pn_sock_get_idx(seq, *pos - 1) : SEQ_START_TOKEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) static void *pn_sock_seq_next(struct seq_file *seq, void *v, loff_t *pos)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) struct sock *sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) if (v == SEQ_START_TOKEN)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) sk = pn_sock_get_idx(seq, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) sk = pn_sock_get_next(seq, v);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) (*pos)++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) return sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) static void pn_sock_seq_stop(struct seq_file *seq, void *v)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) __releases(rcu)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) rcu_read_unlock();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) static int pn_sock_seq_show(struct seq_file *seq, void *v)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) seq_setwidth(seq, 127);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) if (v == SEQ_START_TOKEN)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) seq_puts(seq, "pt loc rem rs st tx_queue rx_queue "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) " uid inode ref pointer drops");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) struct sock *sk = v;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) struct pn_sock *pn = pn_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) seq_printf(seq, "%2d %04X:%04X:%02X %02X %08X:%08X %5d %lu "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) "%d %pK %u",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) sk->sk_protocol, pn->sobject, pn->dobject,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) pn->resource, sk->sk_state,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) sk_wmem_alloc_get(sk), sk_rmem_alloc_get(sk),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) from_kuid_munged(seq_user_ns(seq), sock_i_uid(sk)),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) sock_i_ino(sk),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) refcount_read(&sk->sk_refcnt), sk,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) atomic_read(&sk->sk_drops));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) seq_pad(seq, '\n');
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) const struct seq_operations pn_sock_seq_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) .start = pn_sock_seq_start,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) .next = pn_sock_seq_next,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) .stop = pn_sock_seq_stop,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) .show = pn_sock_seq_show,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) static struct {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) struct sock *sk[256];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610) } pnres;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613) * Find and hold socket based on resource.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615) struct sock *pn_find_sock_by_res(struct net *net, u8 res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) struct sock *sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) if (!net_eq(net, &init_net))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) rcu_read_lock();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623) sk = rcu_dereference(pnres.sk[res]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624) if (sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) sock_hold(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) rcu_read_unlock();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) return sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630) static DEFINE_MUTEX(resource_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632) int pn_sock_bind_res(struct sock *sk, u8 res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634) int ret = -EADDRINUSE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636) if (!net_eq(sock_net(sk), &init_net))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637) return -ENOIOCTLCMD;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638) if (!capable(CAP_SYS_ADMIN))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639) return -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640) if (pn_socket_autobind(sk->sk_socket))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641) return -EAGAIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643) mutex_lock(&resource_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644) if (pnres.sk[res] == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645) sock_hold(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646) rcu_assign_pointer(pnres.sk[res], sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647) ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649) mutex_unlock(&resource_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653) int pn_sock_unbind_res(struct sock *sk, u8 res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655) int ret = -ENOENT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657) if (!capable(CAP_SYS_ADMIN))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658) return -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660) mutex_lock(&resource_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661) if (pnres.sk[res] == sk) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) RCU_INIT_POINTER(pnres.sk[res], NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663) ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665) mutex_unlock(&resource_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) if (ret == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668) synchronize_rcu();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669) sock_put(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674) void pn_sock_unbind_all_res(struct sock *sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676) unsigned int res, match = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678) mutex_lock(&resource_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679) for (res = 0; res < 256; res++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680) if (pnres.sk[res] == sk) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681) RCU_INIT_POINTER(pnres.sk[res], NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682) match++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685) mutex_unlock(&resource_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687) while (match > 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) __sock_put(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689) match--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691) /* Caller is responsible for RCU sync before final sock_put() */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694) #ifdef CONFIG_PROC_FS
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) static struct sock **pn_res_get_idx(struct seq_file *seq, loff_t pos)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697) struct net *net = seq_file_net(seq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698) unsigned int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700) if (!net_eq(net, &init_net))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703) for (i = 0; i < 256; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704) if (pnres.sk[i] == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706) if (!pos)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707) return pnres.sk + i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 708) pos--;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 709) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 710) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 711) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 712)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 713) static struct sock **pn_res_get_next(struct seq_file *seq, struct sock **sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 714) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 715) struct net *net = seq_file_net(seq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 716) unsigned int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 717)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 718) BUG_ON(!net_eq(net, &init_net));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 719)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 720) for (i = (sk - pnres.sk) + 1; i < 256; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 721) if (pnres.sk[i])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 722) return pnres.sk + i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 723) return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 724) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 725)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 726) static void *pn_res_seq_start(struct seq_file *seq, loff_t *pos)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 727) __acquires(resource_mutex)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 728) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 729) mutex_lock(&resource_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 730) return *pos ? pn_res_get_idx(seq, *pos - 1) : SEQ_START_TOKEN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 731) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 732)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 733) static void *pn_res_seq_next(struct seq_file *seq, void *v, loff_t *pos)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 734) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 735) struct sock **sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 736)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 737) if (v == SEQ_START_TOKEN)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 738) sk = pn_res_get_idx(seq, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 739) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 740) sk = pn_res_get_next(seq, v);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 741) (*pos)++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 742) return sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 743) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 744)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 745) static void pn_res_seq_stop(struct seq_file *seq, void *v)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 746) __releases(resource_mutex)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 747) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 748) mutex_unlock(&resource_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 749) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 750)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 751) static int pn_res_seq_show(struct seq_file *seq, void *v)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 752) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 753) seq_setwidth(seq, 63);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 754) if (v == SEQ_START_TOKEN)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 755) seq_puts(seq, "rs uid inode");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 756) else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 757) struct sock **psk = v;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 758) struct sock *sk = *psk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 759)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 760) seq_printf(seq, "%02X %5u %lu",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 761) (int) (psk - pnres.sk),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 762) from_kuid_munged(seq_user_ns(seq), sock_i_uid(sk)),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 763) sock_i_ino(sk));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 764) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 765) seq_pad(seq, '\n');
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 766) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 767) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 768)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 769) const struct seq_operations pn_res_seq_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 770) .start = pn_res_seq_start,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 771) .next = pn_res_seq_next,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 772) .stop = pn_res_seq_stop,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 773) .show = pn_res_seq_show,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 774) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 775) #endif
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags