2 * IEEE 802.15.4 dgram socket interface
4 * Copyright 2007, 2008 Siemens AG
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2
8 * as published by the Free Software Foundation.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
15 * You should have received a copy of the GNU General Public License along
16 * with this program; if not, write to the Free Software Foundation, Inc.,
17 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
20 * Sergey Lapin <slapin@ossfans.org>
21 * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com>
24 #include <linux/net.h>
25 #include <linux/module.h>
26 #include <linux/if_arp.h>
27 #include <linux/list.h>
28 #include <linux/slab.h>
30 #include <net/af_ieee802154.h>
31 #include <net/ieee802154.h>
32 #include <net/ieee802154_netdev.h>
34 #include <asm/ioctls.h>
38 static HLIST_HEAD(dgram_head
);
39 static DEFINE_RWLOCK(dgram_lock
);
44 struct ieee802154_addr src_addr
;
45 struct ieee802154_addr dst_addr
;
48 unsigned int want_ack
:1;
51 static inline struct dgram_sock
*dgram_sk(const struct sock
*sk
)
53 return container_of(sk
, struct dgram_sock
, sk
);
56 static void dgram_hash(struct sock
*sk
)
58 write_lock_bh(&dgram_lock
);
59 sk_add_node(sk
, &dgram_head
);
60 sock_prot_inuse_add(sock_net(sk
), sk
->sk_prot
, 1);
61 write_unlock_bh(&dgram_lock
);
64 static void dgram_unhash(struct sock
*sk
)
66 write_lock_bh(&dgram_lock
);
67 if (sk_del_node_init(sk
))
68 sock_prot_inuse_add(sock_net(sk
), sk
->sk_prot
, -1);
69 write_unlock_bh(&dgram_lock
);
72 static int dgram_init(struct sock
*sk
)
74 struct dgram_sock
*ro
= dgram_sk(sk
);
76 ro
->dst_addr
.mode
= IEEE802154_ADDR_LONG
;
77 ro
->dst_addr
.pan_id
= cpu_to_le16(IEEE802154_PANID_BROADCAST
);
79 memset(&ro
->dst_addr
.extended_addr
, 0xff, IEEE802154_ADDR_LEN
);
83 static void dgram_close(struct sock
*sk
, long timeout
)
85 sk_common_release(sk
);
88 static int dgram_bind(struct sock
*sk
, struct sockaddr
*uaddr
, int len
)
90 struct sockaddr_ieee802154
*addr
= (struct sockaddr_ieee802154
*)uaddr
;
91 struct ieee802154_addr haddr
;
92 struct dgram_sock
*ro
= dgram_sk(sk
);
94 struct net_device
*dev
;
100 if (len
< sizeof(*addr
))
103 if (addr
->family
!= AF_IEEE802154
)
106 ieee802154_addr_from_sa(&haddr
, &addr
->addr
);
107 dev
= ieee802154_get_dev(sock_net(sk
), &haddr
);
113 if (dev
->type
!= ARPHRD_IEEE802154
) {
118 ro
->src_addr
= haddr
;
130 static int dgram_ioctl(struct sock
*sk
, int cmd
, unsigned long arg
)
135 int amount
= sk_wmem_alloc_get(sk
);
137 return put_user(amount
, (int __user
*)arg
);
143 unsigned long amount
;
146 spin_lock_bh(&sk
->sk_receive_queue
.lock
);
147 skb
= skb_peek(&sk
->sk_receive_queue
);
150 * We will only return the amount
151 * of this packet since that is all
154 amount
= skb
->len
- ieee802154_hdr_length(skb
);
156 spin_unlock_bh(&sk
->sk_receive_queue
.lock
);
157 return put_user(amount
, (int __user
*)arg
);
164 /* FIXME: autobind */
165 static int dgram_connect(struct sock
*sk
, struct sockaddr
*uaddr
,
168 struct sockaddr_ieee802154
*addr
= (struct sockaddr_ieee802154
*)uaddr
;
169 struct dgram_sock
*ro
= dgram_sk(sk
);
172 if (len
< sizeof(*addr
))
175 if (addr
->family
!= AF_IEEE802154
)
185 ieee802154_addr_from_sa(&ro
->dst_addr
, &addr
->addr
);
192 static int dgram_disconnect(struct sock
*sk
, int flags
)
194 struct dgram_sock
*ro
= dgram_sk(sk
);
198 ro
->dst_addr
.mode
= IEEE802154_ADDR_LONG
;
199 memset(&ro
->dst_addr
.extended_addr
, 0xff, IEEE802154_ADDR_LEN
);
206 static int dgram_sendmsg(struct kiocb
*iocb
, struct sock
*sk
,
207 struct msghdr
*msg
, size_t size
)
209 struct net_device
*dev
;
212 struct dgram_sock
*ro
= dgram_sk(sk
);
216 if (msg
->msg_flags
& MSG_OOB
) {
217 pr_debug("msg->msg_flags = 0x%x\n", msg
->msg_flags
);
222 dev
= dev_getfirstbyhwtype(sock_net(sk
), ARPHRD_IEEE802154
);
224 dev
= ieee802154_get_dev(sock_net(sk
), &ro
->src_addr
);
227 pr_debug("no dev\n");
232 pr_debug("name = %s, mtu = %u\n", dev
->name
, mtu
);
235 pr_debug("size = %Zu, mtu = %u\n", size
, mtu
);
240 hlen
= LL_RESERVED_SPACE(dev
);
241 tlen
= dev
->needed_tailroom
;
242 skb
= sock_alloc_send_skb(sk
, hlen
+ tlen
+ size
,
243 msg
->msg_flags
& MSG_DONTWAIT
,
248 skb_reserve(skb
, hlen
);
250 skb_reset_network_header(skb
);
252 mac_cb(skb
)->flags
= IEEE802154_FC_TYPE_DATA
;
254 mac_cb(skb
)->flags
|= MAC_CB_FLAG_ACKREQ
;
256 mac_cb(skb
)->seq
= ieee802154_mlme_ops(dev
)->get_dsn(dev
);
257 err
= dev_hard_header(skb
, dev
, ETH_P_IEEE802154
, &ro
->dst_addr
,
258 ro
->bound
? &ro
->src_addr
: NULL
, size
);
262 skb_reset_mac_header(skb
);
264 err
= memcpy_fromiovec(skb_put(skb
, size
), msg
->msg_iov
, size
);
270 skb
->protocol
= htons(ETH_P_IEEE802154
);
274 err
= dev_queue_xmit(skb
);
276 err
= net_xmit_errno(err
);
288 static int dgram_recvmsg(struct kiocb
*iocb
, struct sock
*sk
,
289 struct msghdr
*msg
, size_t len
, int noblock
, int flags
,
293 int err
= -EOPNOTSUPP
;
295 DECLARE_SOCKADDR(struct sockaddr_ieee802154
*, saddr
, msg
->msg_name
);
297 skb
= skb_recv_datagram(sk
, flags
, noblock
, &err
);
303 msg
->msg_flags
|= MSG_TRUNC
;
307 /* FIXME: skip headers if necessary ?! */
308 err
= skb_copy_datagram_iovec(skb
, 0, msg
->msg_iov
, copied
);
312 sock_recv_ts_and_drops(msg
, sk
, skb
);
315 saddr
->family
= AF_IEEE802154
;
316 ieee802154_addr_to_sa(&saddr
->addr
, &mac_cb(skb
)->source
);
317 *addr_len
= sizeof(*saddr
);
320 if (flags
& MSG_TRUNC
)
323 skb_free_datagram(sk
, skb
);
330 static int dgram_rcv_skb(struct sock
*sk
, struct sk_buff
*skb
)
332 skb
= skb_share_check(skb
, GFP_ATOMIC
);
336 if (sock_queue_rcv_skb(sk
, skb
) < 0) {
341 return NET_RX_SUCCESS
;
345 ieee802154_match_sock(__le64 hw_addr
, __le16 pan_id
, __le16 short_addr
,
346 struct dgram_sock
*ro
)
351 if (ro
->src_addr
.mode
== IEEE802154_ADDR_LONG
&&
352 hw_addr
== ro
->src_addr
.extended_addr
)
355 if (ro
->src_addr
.mode
== IEEE802154_ADDR_SHORT
&&
356 pan_id
== ro
->src_addr
.pan_id
&&
357 short_addr
== ro
->src_addr
.short_addr
)
363 int ieee802154_dgram_deliver(struct net_device
*dev
, struct sk_buff
*skb
)
365 struct sock
*sk
, *prev
= NULL
;
366 int ret
= NET_RX_SUCCESS
;
367 __le16 pan_id
, short_addr
;
370 /* Data frame processing */
371 BUG_ON(dev
->type
!= ARPHRD_IEEE802154
);
373 pan_id
= ieee802154_mlme_ops(dev
)->get_pan_id(dev
);
374 short_addr
= ieee802154_mlme_ops(dev
)->get_short_addr(dev
);
375 hw_addr
= ieee802154_devaddr_from_raw(dev
->dev_addr
);
377 read_lock(&dgram_lock
);
378 sk_for_each(sk
, &dgram_head
) {
379 if (ieee802154_match_sock(hw_addr
, pan_id
, short_addr
,
382 struct sk_buff
*clone
;
383 clone
= skb_clone(skb
, GFP_ATOMIC
);
385 dgram_rcv_skb(prev
, clone
);
393 dgram_rcv_skb(prev
, skb
);
398 read_unlock(&dgram_lock
);
403 static int dgram_getsockopt(struct sock
*sk
, int level
, int optname
,
404 char __user
*optval
, int __user
*optlen
)
406 struct dgram_sock
*ro
= dgram_sk(sk
);
410 if (level
!= SOL_IEEE802154
)
413 if (get_user(len
, optlen
))
416 len
= min_t(unsigned int, len
, sizeof(int));
426 if (put_user(len
, optlen
))
428 if (copy_to_user(optval
, &val
, len
))
433 static int dgram_setsockopt(struct sock
*sk
, int level
, int optname
,
434 char __user
*optval
, unsigned int optlen
)
436 struct dgram_sock
*ro
= dgram_sk(sk
);
440 if (optlen
< sizeof(int))
443 if (get_user(val
, (int __user
*)optval
))
450 ro
->want_ack
= !!val
;
461 struct proto ieee802154_dgram_prot
= {
462 .name
= "IEEE-802.15.4-MAC",
463 .owner
= THIS_MODULE
,
464 .obj_size
= sizeof(struct dgram_sock
),
466 .close
= dgram_close
,
468 .sendmsg
= dgram_sendmsg
,
469 .recvmsg
= dgram_recvmsg
,
471 .unhash
= dgram_unhash
,
472 .connect
= dgram_connect
,
473 .disconnect
= dgram_disconnect
,
474 .ioctl
= dgram_ioctl
,
475 .getsockopt
= dgram_getsockopt
,
476 .setsockopt
= dgram_setsockopt
,