1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * File: datagram.c 4 * 5 * Datagram (ISI) Phonet sockets 6 * 7 * Copyright (C) 2008 Nokia Corporation. 8 * 9 * Authors: Sakari Ailus <sakari.ailus@nokia.com> 10 * Rémi Denis-Courmont 11 */ 12 13 #include <linux/kernel.h> 14 #include <linux/slab.h> 15 #include <linux/socket.h> 16 #include <asm/ioctls.h> 17 #include <net/sock.h> 18 19 #include <linux/phonet.h> 20 #include <linux/export.h> 21 #include <net/phonet/phonet.h> 22 23 static int pn_backlog_rcv(struct sock *sk, struct sk_buff *skb); 24 25 /* associated socket ceases to exist */ 26 static void pn_sock_close(struct sock *sk, long timeout) 27 { 28 sk_common_release(sk); 29 } 30 31 static int pn_ioctl(struct sock *sk, int cmd, unsigned long arg) 32 { 33 struct sk_buff *skb; 34 int answ; 35 36 switch (cmd) { 37 case SIOCINQ: 38 lock_sock(sk); 39 skb = skb_peek(&sk->sk_receive_queue); 40 answ = skb ? skb->len : 0; 41 release_sock(sk); 42 return put_user(answ, (int __user *)arg); 43 44 case SIOCPNADDRESOURCE: 45 case SIOCPNDELRESOURCE: { 46 u32 res; 47 if (get_user(res, (u32 __user *)arg)) 48 return -EFAULT; 49 if (res >= 256) 50 return -EINVAL; 51 if (cmd == SIOCPNADDRESOURCE) 52 return pn_sock_bind_res(sk, res); 53 else 54 return pn_sock_unbind_res(sk, res); 55 } 56 } 57 58 return -ENOIOCTLCMD; 59 } 60 61 /* Destroy socket. All references are gone. */ 62 static void pn_destruct(struct sock *sk) 63 { 64 skb_queue_purge(&sk->sk_receive_queue); 65 } 66 67 static int pn_init(struct sock *sk) 68 { 69 sk->sk_destruct = pn_destruct; 70 return 0; 71 } 72 73 static int pn_sendmsg(struct sock *sk, struct msghdr *msg, size_t len) 74 { 75 DECLARE_SOCKADDR(struct sockaddr_pn *, target, msg->msg_name); 76 struct sk_buff *skb; 77 int err; 78 79 if (msg->msg_flags & ~(MSG_DONTWAIT|MSG_EOR|MSG_NOSIGNAL| 80 MSG_CMSG_COMPAT)) 81 return -EOPNOTSUPP; 82 83 if (target == NULL) 84 return -EDESTADDRREQ; 85 86 if (msg->msg_namelen < sizeof(struct sockaddr_pn)) 87 return -EINVAL; 88 89 if (target->spn_family != AF_PHONET) 90 return -EAFNOSUPPORT; 91 92 skb = sock_alloc_send_skb(sk, MAX_PHONET_HEADER + len, 93 msg->msg_flags & MSG_DONTWAIT, &err); 94 if (skb == NULL) 95 return err; 96 skb_reserve(skb, MAX_PHONET_HEADER); 97 98 err = memcpy_from_msg((void *)skb_put(skb, len), msg, len); 99 if (err < 0) { 100 kfree_skb(skb); 101 return err; 102 } 103 104 /* 105 * Fill in the Phonet header and 106 * finally pass the packet forwards. 107 */ 108 err = pn_skb_send(sk, skb, target); 109 110 /* If ok, return len. */ 111 return (err >= 0) ? len : err; 112 } 113 114 static int pn_recvmsg(struct sock *sk, struct msghdr *msg, size_t len, 115 int noblock, int flags, int *addr_len) 116 { 117 struct sk_buff *skb = NULL; 118 struct sockaddr_pn sa; 119 int rval = -EOPNOTSUPP; 120 int copylen; 121 122 if (flags & ~(MSG_PEEK|MSG_TRUNC|MSG_DONTWAIT|MSG_NOSIGNAL| 123 MSG_CMSG_COMPAT)) 124 goto out_nofree; 125 126 skb = skb_recv_datagram(sk, flags, noblock, &rval); 127 if (skb == NULL) 128 goto out_nofree; 129 130 pn_skb_get_src_sockaddr(skb, &sa); 131 132 copylen = skb->len; 133 if (len < copylen) { 134 msg->msg_flags |= MSG_TRUNC; 135 copylen = len; 136 } 137 138 rval = skb_copy_datagram_msg(skb, 0, msg, copylen); 139 if (rval) { 140 rval = -EFAULT; 141 goto out; 142 } 143 144 rval = (flags & MSG_TRUNC) ? skb->len : copylen; 145 146 if (msg->msg_name != NULL) { 147 __sockaddr_check_size(sizeof(sa)); 148 memcpy(msg->msg_name, &sa, sizeof(sa)); 149 *addr_len = sizeof(sa); 150 } 151 152 out: 153 skb_free_datagram(sk, skb); 154 155 out_nofree: 156 return rval; 157 } 158 159 /* Queue an skb for a sock. */ 160 static int pn_backlog_rcv(struct sock *sk, struct sk_buff *skb) 161 { 162 int err = sock_queue_rcv_skb(sk, skb); 163 164 if (err < 0) 165 kfree_skb(skb); 166 return err ? NET_RX_DROP : NET_RX_SUCCESS; 167 } 168 169 /* Module registration */ 170 static struct proto pn_proto = { 171 .close = pn_sock_close, 172 .ioctl = pn_ioctl, 173 .init = pn_init, 174 .sendmsg = pn_sendmsg, 175 .recvmsg = pn_recvmsg, 176 .backlog_rcv = pn_backlog_rcv, 177 .hash = pn_sock_hash, 178 .unhash = pn_sock_unhash, 179 .get_port = pn_sock_get_port, 180 .obj_size = sizeof(struct pn_sock), 181 .owner = THIS_MODULE, 182 .name = "PHONET", 183 }; 184 185 static const struct phonet_protocol pn_dgram_proto = { 186 .ops = &phonet_dgram_ops, 187 .prot = &pn_proto, 188 .sock_type = SOCK_DGRAM, 189 }; 190 191 int __init isi_register(void) 192 { 193 return phonet_proto_register(PN_PROTO_PHONET, &pn_dgram_proto); 194 } 195 196 void __exit isi_unregister(void) 197 { 198 phonet_proto_unregister(PN_PROTO_PHONET, &pn_dgram_proto); 199 } 200