Blame view
net/ieee802154/raw.c
5.44 KB
9ec767160 net: add IEEE 802... |
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 |
/* * Raw IEEE 802.15.4 sockets * * Copyright 2007, 2008 Siemens AG * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 * as published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License along * with this program; if not, write to the Free Software Foundation, Inc., * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. * * Written by: * Sergey Lapin <slapin@ossfans.org> * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com> */ #include <linux/net.h> #include <linux/module.h> #include <linux/if_arp.h> #include <linux/list.h> |
5a0e3ad6a include cleanup: ... |
28 |
#include <linux/slab.h> |
9ec767160 net: add IEEE 802... |
29 |
#include <net/sock.h> |
f0166e5e3 ieee802154: move ... |
30 |
#include <net/af_ieee802154.h> |
9ec767160 net: add IEEE 802... |
31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 |
#include "af802154.h" static HLIST_HEAD(raw_head); static DEFINE_RWLOCK(raw_lock); static void raw_hash(struct sock *sk) { write_lock_bh(&raw_lock); sk_add_node(sk, &raw_head); sock_prot_inuse_add(sock_net(sk), sk->sk_prot, 1); write_unlock_bh(&raw_lock); } static void raw_unhash(struct sock *sk) { write_lock_bh(&raw_lock); if (sk_del_node_init(sk)) sock_prot_inuse_add(sock_net(sk), sk->sk_prot, -1); write_unlock_bh(&raw_lock); } static void raw_close(struct sock *sk, long timeout) { sk_common_release(sk); } static int raw_bind(struct sock *sk, struct sockaddr *uaddr, int len) { struct sockaddr_ieee802154 *addr = (struct sockaddr_ieee802154 *)uaddr; int err = 0; struct net_device *dev = NULL; if (len < sizeof(*addr)) return -EINVAL; if (addr->family != AF_IEEE802154) return -EINVAL; lock_sock(sk); dev = ieee802154_get_dev(sock_net(sk), &addr->addr); if (!dev) { err = -ENODEV; goto out; } |
929122cdd Drop ARPHRD_IEEE8... |
77 |
if (dev->type != ARPHRD_IEEE802154) { |
9ec767160 net: add IEEE 802... |
78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 |
err = -ENODEV; goto out_put; } sk->sk_bound_dev_if = dev->ifindex; sk_dst_reset(sk); out_put: dev_put(dev); out: release_sock(sk); return err; } static int raw_connect(struct sock *sk, struct sockaddr *uaddr, int addr_len) { return -ENOTSUPP; } static int raw_disconnect(struct sock *sk, int flags) { return 0; } static int raw_sendmsg(struct kiocb *iocb, struct sock *sk, struct msghdr *msg, size_t size) { struct net_device *dev; |
95c961747 net: cleanup unsi... |
108 |
unsigned int mtu; |
9ec767160 net: add IEEE 802... |
109 |
struct sk_buff *skb; |
ae641949d net: Remove all u... |
110 |
int hlen, tlen; |
9ec767160 net: add IEEE 802... |
111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 |
int err; if (msg->msg_flags & MSG_OOB) { pr_debug("msg->msg_flags = 0x%x ", msg->msg_flags); return -EOPNOTSUPP; } lock_sock(sk); if (!sk->sk_bound_dev_if) dev = dev_getfirstbyhwtype(sock_net(sk), ARPHRD_IEEE802154); else dev = dev_get_by_index(sock_net(sk), sk->sk_bound_dev_if); release_sock(sk); if (!dev) { pr_debug("no dev "); err = -ENXIO; goto out; } mtu = dev->mtu; pr_debug("name = %s, mtu = %u ", dev->name, mtu); if (size > mtu) { |
e5241c448 ieee802154: Use '... |
138 139 |
pr_debug("size = %Zu, mtu = %u ", size, mtu); |
9ec767160 net: add IEEE 802... |
140 141 142 |
err = -EINVAL; goto out_dev; } |
ae641949d net: Remove all u... |
143 144 145 |
hlen = LL_RESERVED_SPACE(dev); tlen = dev->needed_tailroom; skb = sock_alloc_send_skb(sk, hlen + tlen + size, |
9ec767160 net: add IEEE 802... |
146 147 148 |
msg->msg_flags & MSG_DONTWAIT, &err); if (!skb) goto out_dev; |
ae641949d net: Remove all u... |
149 |
skb_reserve(skb, hlen); |
9ec767160 net: add IEEE 802... |
150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 |
skb_reset_mac_header(skb); skb_reset_network_header(skb); err = memcpy_fromiovec(skb_put(skb, size), msg->msg_iov, size); if (err < 0) goto out_skb; skb->dev = dev; skb->sk = sk; skb->protocol = htons(ETH_P_IEEE802154); dev_put(dev); err = dev_queue_xmit(skb); if (err > 0) err = net_xmit_errno(err); return err ?: size; out_skb: kfree_skb(skb); out_dev: dev_put(dev); out: return err; } static int raw_recvmsg(struct kiocb *iocb, struct sock *sk, struct msghdr *msg, size_t len, int noblock, int flags, int *addr_len) { size_t copied = 0; int err = -EOPNOTSUPP; struct sk_buff *skb; skb = skb_recv_datagram(sk, flags, noblock, &err); if (!skb) goto out; copied = skb->len; if (len < copied) { msg->msg_flags |= MSG_TRUNC; copied = len; } err = skb_copy_datagram_iovec(skb, 0, msg->msg_iov, copied); if (err) goto done; |
3b885787e net: Generalize s... |
198 |
sock_recv_ts_and_drops(msg, sk, skb); |
9ec767160 net: add IEEE 802... |
199 200 201 202 203 204 205 206 207 208 209 210 211 212 |
if (flags & MSG_TRUNC) copied = skb->len; done: skb_free_datagram(sk, skb); out: if (err) return err; return copied; } static int raw_rcv_skb(struct sock *sk, struct sk_buff *skb) { if (sock_queue_rcv_skb(sk, skb) < 0) { |
9ec767160 net: add IEEE 802... |
213 214 215 216 217 218 219 220 221 222 223 |
kfree_skb(skb); return NET_RX_DROP; } return NET_RX_SUCCESS; } void ieee802154_raw_deliver(struct net_device *dev, struct sk_buff *skb) { struct sock *sk; |
9ec767160 net: add IEEE 802... |
224 225 |
read_lock(&raw_lock); |
b67bfe0d4 hlist: drop the n... |
226 |
sk_for_each(sk, &raw_head) { |
9ec767160 net: add IEEE 802... |
227 228 229 230 231 232 233 234 235 236 237 238 239 240 |
bh_lock_sock(sk); if (!sk->sk_bound_dev_if || sk->sk_bound_dev_if == dev->ifindex) { struct sk_buff *clone; clone = skb_clone(skb, GFP_ATOMIC); if (clone) raw_rcv_skb(sk, clone); } bh_unlock_sock(sk); } read_unlock(&raw_lock); } |
a9dfac335 af_ieee802154: pr... |
241 242 243 244 245 246 247 |
static int raw_getsockopt(struct sock *sk, int level, int optname, char __user *optval, int __user *optlen) { return -EOPNOTSUPP; } static int raw_setsockopt(struct sock *sk, int level, int optname, |
b7058842c net: Make setsock... |
248 |
char __user *optval, unsigned int optlen) |
a9dfac335 af_ieee802154: pr... |
249 250 251 |
{ return -EOPNOTSUPP; } |
9ec767160 net: add IEEE 802... |
252 253 254 255 256 257 258 259 260 261 262 263 |
struct proto ieee802154_raw_prot = { .name = "IEEE-802.15.4-RAW", .owner = THIS_MODULE, .obj_size = sizeof(struct sock), .close = raw_close, .bind = raw_bind, .sendmsg = raw_sendmsg, .recvmsg = raw_recvmsg, .hash = raw_hash, .unhash = raw_unhash, .connect = raw_connect, .disconnect = raw_disconnect, |
a9dfac335 af_ieee802154: pr... |
264 265 |
.getsockopt = raw_getsockopt, .setsockopt = raw_setsockopt, |
9ec767160 net: add IEEE 802... |
266 |
}; |