2 * IEEE802154.4 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.
16 * Sergey Lapin <slapin@ossfans.org>
17 * Maxim Gorbachyov <maxim.gorbachev@siemens.com>
20 #include <linux/net.h>
21 #include <linux/capability.h>
22 #include <linux/module.h>
23 #include <linux/if_arp.h>
25 #include <linux/termios.h> /* For TIOCOUTQ/INQ */
26 #include <linux/list.h>
27 #include <linux/slab.h>
28 #include <linux/socket.h>
29 #include <net/datalink.h>
30 #include <net/psnap.h>
32 #include <net/tcp_states.h>
33 #include <net/route.h>
35 #include <net/af_ieee802154.h>
36 #include <net/ieee802154_netdev.h>
38 /* Utility function for families */
39 static struct net_device
*
40 ieee802154_get_dev(struct net
*net
, const struct ieee802154_addr
*addr
)
42 struct net_device
*dev
= NULL
;
43 struct net_device
*tmp
;
44 __le16 pan_id
, short_addr
;
45 u8 hwaddr
[IEEE802154_ADDR_LEN
];
48 case IEEE802154_ADDR_LONG
:
49 ieee802154_devaddr_to_raw(hwaddr
, addr
->extended_addr
);
51 dev
= dev_getbyhwaddr_rcu(net
, ARPHRD_IEEE802154
, hwaddr
);
56 case IEEE802154_ADDR_SHORT
:
57 if (addr
->pan_id
== cpu_to_le16(IEEE802154_PANID_BROADCAST
) ||
58 addr
->short_addr
== cpu_to_le16(IEEE802154_ADDR_UNDEF
) ||
59 addr
->short_addr
== cpu_to_le16(IEEE802154_ADDR_BROADCAST
))
64 for_each_netdev(net
, tmp
) {
65 if (tmp
->type
!= ARPHRD_IEEE802154
)
68 pan_id
= tmp
->ieee802154_ptr
->pan_id
;
69 short_addr
= tmp
->ieee802154_ptr
->short_addr
;
70 if (pan_id
== addr
->pan_id
&&
71 short_addr
== addr
->short_addr
) {
81 pr_warn("Unsupported ieee802154 address type: %d\n",
89 static int ieee802154_sock_release(struct socket
*sock
)
91 struct sock
*sk
= sock
->sk
;
95 sk
->sk_prot
->close(sk
, 0);
100 static int ieee802154_sock_sendmsg(struct socket
*sock
, struct msghdr
*msg
,
103 struct sock
*sk
= sock
->sk
;
105 return sk
->sk_prot
->sendmsg(sk
, msg
, len
);
108 static int ieee802154_sock_bind(struct socket
*sock
, struct sockaddr
*uaddr
,
111 struct sock
*sk
= sock
->sk
;
113 if (sk
->sk_prot
->bind
)
114 return sk
->sk_prot
->bind(sk
, uaddr
, addr_len
);
116 return sock_no_bind(sock
, uaddr
, addr_len
);
119 static int ieee802154_sock_connect(struct socket
*sock
, struct sockaddr
*uaddr
,
120 int addr_len
, int flags
)
122 struct sock
*sk
= sock
->sk
;
124 if (addr_len
< sizeof(uaddr
->sa_family
))
127 if (uaddr
->sa_family
== AF_UNSPEC
)
128 return sk
->sk_prot
->disconnect(sk
, flags
);
130 return sk
->sk_prot
->connect(sk
, uaddr
, addr_len
);
133 static int ieee802154_dev_ioctl(struct sock
*sk
, struct ifreq __user
*arg
,
137 int ret
= -ENOIOCTLCMD
;
138 struct net_device
*dev
;
140 if (copy_from_user(&ifr
, arg
, sizeof(struct ifreq
)))
143 ifr
.ifr_name
[IFNAMSIZ
-1] = 0;
145 dev_load(sock_net(sk
), ifr
.ifr_name
);
146 dev
= dev_get_by_name(sock_net(sk
), ifr
.ifr_name
);
151 if (dev
->type
== ARPHRD_IEEE802154
&& dev
->netdev_ops
->ndo_do_ioctl
)
152 ret
= dev
->netdev_ops
->ndo_do_ioctl(dev
, &ifr
, cmd
);
154 if (!ret
&& copy_to_user(arg
, &ifr
, sizeof(struct ifreq
)))
161 static int ieee802154_sock_ioctl(struct socket
*sock
, unsigned int cmd
,
164 struct sock
*sk
= sock
->sk
;
169 return ieee802154_dev_ioctl(sk
, (struct ifreq __user
*)arg
,
172 if (!sk
->sk_prot
->ioctl
)
174 return sk
->sk_prot
->ioctl(sk
, cmd
, arg
);
178 /* RAW Sockets (802.15.4 created in userspace) */
179 static HLIST_HEAD(raw_head
);
180 static DEFINE_RWLOCK(raw_lock
);
182 static int raw_hash(struct sock
*sk
)
184 write_lock_bh(&raw_lock
);
185 sk_add_node(sk
, &raw_head
);
186 sock_prot_inuse_add(sock_net(sk
), sk
->sk_prot
, 1);
187 write_unlock_bh(&raw_lock
);
192 static void raw_unhash(struct sock
*sk
)
194 write_lock_bh(&raw_lock
);
195 if (sk_del_node_init(sk
))
196 sock_prot_inuse_add(sock_net(sk
), sk
->sk_prot
, -1);
197 write_unlock_bh(&raw_lock
);
200 static void raw_close(struct sock
*sk
, long timeout
)
202 sk_common_release(sk
);
205 static int raw_bind(struct sock
*sk
, struct sockaddr
*_uaddr
, int len
)
207 struct ieee802154_addr addr
;
208 struct sockaddr_ieee802154
*uaddr
= (struct sockaddr_ieee802154
*)_uaddr
;
210 struct net_device
*dev
= NULL
;
212 if (len
< sizeof(*uaddr
))
215 uaddr
= (struct sockaddr_ieee802154
*)_uaddr
;
216 if (uaddr
->family
!= AF_IEEE802154
)
221 ieee802154_addr_from_sa(&addr
, &uaddr
->addr
);
222 dev
= ieee802154_get_dev(sock_net(sk
), &addr
);
228 sk
->sk_bound_dev_if
= dev
->ifindex
;
238 static int raw_connect(struct sock
*sk
, struct sockaddr
*uaddr
,
244 static int raw_disconnect(struct sock
*sk
, int flags
)
249 static int raw_sendmsg(struct sock
*sk
, struct msghdr
*msg
, size_t size
)
251 struct net_device
*dev
;
257 if (msg
->msg_flags
& MSG_OOB
) {
258 pr_debug("msg->msg_flags = 0x%x\n", msg
->msg_flags
);
263 if (!sk
->sk_bound_dev_if
)
264 dev
= dev_getfirstbyhwtype(sock_net(sk
), ARPHRD_IEEE802154
);
266 dev
= dev_get_by_index(sock_net(sk
), sk
->sk_bound_dev_if
);
270 pr_debug("no dev\n");
275 mtu
= IEEE802154_MTU
;
276 pr_debug("name = %s, mtu = %u\n", dev
->name
, mtu
);
279 pr_debug("size = %zu, mtu = %u\n", size
, mtu
);
284 hlen
= LL_RESERVED_SPACE(dev
);
285 tlen
= dev
->needed_tailroom
;
286 skb
= sock_alloc_send_skb(sk
, hlen
+ tlen
+ size
,
287 msg
->msg_flags
& MSG_DONTWAIT
, &err
);
291 skb_reserve(skb
, hlen
);
293 skb_reset_mac_header(skb
);
294 skb_reset_network_header(skb
);
296 err
= memcpy_from_msg(skb_put(skb
, size
), msg
, size
);
301 skb
->protocol
= htons(ETH_P_IEEE802154
);
303 err
= dev_queue_xmit(skb
);
305 err
= net_xmit_errno(err
);
319 static int raw_recvmsg(struct sock
*sk
, struct msghdr
*msg
, size_t len
,
320 int noblock
, int flags
, int *addr_len
)
323 int err
= -EOPNOTSUPP
;
326 skb
= skb_recv_datagram(sk
, flags
, noblock
, &err
);
332 msg
->msg_flags
|= MSG_TRUNC
;
336 err
= skb_copy_datagram_msg(skb
, 0, msg
, copied
);
340 sock_recv_ts_and_drops(msg
, sk
, skb
);
342 if (flags
& MSG_TRUNC
)
345 skb_free_datagram(sk
, skb
);
352 static int raw_rcv_skb(struct sock
*sk
, struct sk_buff
*skb
)
354 skb
= skb_share_check(skb
, GFP_ATOMIC
);
358 if (sock_queue_rcv_skb(sk
, skb
) < 0) {
363 return NET_RX_SUCCESS
;
366 static void ieee802154_raw_deliver(struct net_device
*dev
, struct sk_buff
*skb
)
370 read_lock(&raw_lock
);
371 sk_for_each(sk
, &raw_head
) {
373 if (!sk
->sk_bound_dev_if
||
374 sk
->sk_bound_dev_if
== dev
->ifindex
) {
375 struct sk_buff
*clone
;
377 clone
= skb_clone(skb
, GFP_ATOMIC
);
379 raw_rcv_skb(sk
, clone
);
383 read_unlock(&raw_lock
);
386 static int raw_getsockopt(struct sock
*sk
, int level
, int optname
,
387 char __user
*optval
, int __user
*optlen
)
392 static int raw_setsockopt(struct sock
*sk
, int level
, int optname
,
393 char __user
*optval
, unsigned int optlen
)
398 static struct proto ieee802154_raw_prot
= {
399 .name
= "IEEE-802.15.4-RAW",
400 .owner
= THIS_MODULE
,
401 .obj_size
= sizeof(struct sock
),
404 .sendmsg
= raw_sendmsg
,
405 .recvmsg
= raw_recvmsg
,
407 .unhash
= raw_unhash
,
408 .connect
= raw_connect
,
409 .disconnect
= raw_disconnect
,
410 .getsockopt
= raw_getsockopt
,
411 .setsockopt
= raw_setsockopt
,
414 static const struct proto_ops ieee802154_raw_ops
= {
415 .family
= PF_IEEE802154
,
416 .owner
= THIS_MODULE
,
417 .release
= ieee802154_sock_release
,
418 .bind
= ieee802154_sock_bind
,
419 .connect
= ieee802154_sock_connect
,
420 .socketpair
= sock_no_socketpair
,
421 .accept
= sock_no_accept
,
422 .getname
= sock_no_getname
,
423 .poll
= datagram_poll
,
424 .ioctl
= ieee802154_sock_ioctl
,
425 .gettstamp
= sock_gettstamp
,
426 .listen
= sock_no_listen
,
427 .shutdown
= sock_no_shutdown
,
428 .setsockopt
= sock_common_setsockopt
,
429 .getsockopt
= sock_common_getsockopt
,
430 .sendmsg
= ieee802154_sock_sendmsg
,
431 .recvmsg
= sock_common_recvmsg
,
432 .mmap
= sock_no_mmap
,
433 .sendpage
= sock_no_sendpage
,
435 .compat_setsockopt
= compat_sock_common_setsockopt
,
436 .compat_getsockopt
= compat_sock_common_getsockopt
,
440 /* DGRAM Sockets (802.15.4 dataframes) */
441 static HLIST_HEAD(dgram_head
);
442 static DEFINE_RWLOCK(dgram_lock
);
447 struct ieee802154_addr src_addr
;
448 struct ieee802154_addr dst_addr
;
450 unsigned int bound
:1;
451 unsigned int connected
:1;
452 unsigned int want_ack
:1;
453 unsigned int want_lqi
:1;
454 unsigned int secen
:1;
455 unsigned int secen_override
:1;
456 unsigned int seclevel
:3;
457 unsigned int seclevel_override
:1;
460 static inline struct dgram_sock
*dgram_sk(const struct sock
*sk
)
462 return container_of(sk
, struct dgram_sock
, sk
);
465 static int dgram_hash(struct sock
*sk
)
467 write_lock_bh(&dgram_lock
);
468 sk_add_node(sk
, &dgram_head
);
469 sock_prot_inuse_add(sock_net(sk
), sk
->sk_prot
, 1);
470 write_unlock_bh(&dgram_lock
);
475 static void dgram_unhash(struct sock
*sk
)
477 write_lock_bh(&dgram_lock
);
478 if (sk_del_node_init(sk
))
479 sock_prot_inuse_add(sock_net(sk
), sk
->sk_prot
, -1);
480 write_unlock_bh(&dgram_lock
);
483 static int dgram_init(struct sock
*sk
)
485 struct dgram_sock
*ro
= dgram_sk(sk
);
492 static void dgram_close(struct sock
*sk
, long timeout
)
494 sk_common_release(sk
);
497 static int dgram_bind(struct sock
*sk
, struct sockaddr
*uaddr
, int len
)
499 struct sockaddr_ieee802154
*addr
= (struct sockaddr_ieee802154
*)uaddr
;
500 struct ieee802154_addr haddr
;
501 struct dgram_sock
*ro
= dgram_sk(sk
);
503 struct net_device
*dev
;
509 if (len
< sizeof(*addr
))
512 if (addr
->family
!= AF_IEEE802154
)
515 ieee802154_addr_from_sa(&haddr
, &addr
->addr
);
516 dev
= ieee802154_get_dev(sock_net(sk
), &haddr
);
522 if (dev
->type
!= ARPHRD_IEEE802154
) {
527 ro
->src_addr
= haddr
;
539 static int dgram_ioctl(struct sock
*sk
, int cmd
, unsigned long arg
)
544 int amount
= sk_wmem_alloc_get(sk
);
546 return put_user(amount
, (int __user
*)arg
);
552 unsigned long amount
;
555 spin_lock_bh(&sk
->sk_receive_queue
.lock
);
556 skb
= skb_peek(&sk
->sk_receive_queue
);
558 /* We will only return the amount
559 * of this packet since that is all
562 amount
= skb
->len
- ieee802154_hdr_length(skb
);
564 spin_unlock_bh(&sk
->sk_receive_queue
.lock
);
565 return put_user(amount
, (int __user
*)arg
);
572 /* FIXME: autobind */
573 static int dgram_connect(struct sock
*sk
, struct sockaddr
*uaddr
,
576 struct sockaddr_ieee802154
*addr
= (struct sockaddr_ieee802154
*)uaddr
;
577 struct dgram_sock
*ro
= dgram_sk(sk
);
580 if (len
< sizeof(*addr
))
583 if (addr
->family
!= AF_IEEE802154
)
593 ieee802154_addr_from_sa(&ro
->dst_addr
, &addr
->addr
);
601 static int dgram_disconnect(struct sock
*sk
, int flags
)
603 struct dgram_sock
*ro
= dgram_sk(sk
);
612 static int dgram_sendmsg(struct sock
*sk
, struct msghdr
*msg
, size_t size
)
614 struct net_device
*dev
;
617 struct ieee802154_mac_cb
*cb
;
618 struct dgram_sock
*ro
= dgram_sk(sk
);
619 struct ieee802154_addr dst_addr
;
623 if (msg
->msg_flags
& MSG_OOB
) {
624 pr_debug("msg->msg_flags = 0x%x\n", msg
->msg_flags
);
628 if (!ro
->connected
&& !msg
->msg_name
)
629 return -EDESTADDRREQ
;
630 else if (ro
->connected
&& msg
->msg_name
)
634 dev
= dev_getfirstbyhwtype(sock_net(sk
), ARPHRD_IEEE802154
);
636 dev
= ieee802154_get_dev(sock_net(sk
), &ro
->src_addr
);
639 pr_debug("no dev\n");
643 mtu
= IEEE802154_MTU
;
644 pr_debug("name = %s, mtu = %u\n", dev
->name
, mtu
);
647 pr_debug("size = %zu, mtu = %u\n", size
, mtu
);
652 hlen
= LL_RESERVED_SPACE(dev
);
653 tlen
= dev
->needed_tailroom
;
654 skb
= sock_alloc_send_skb(sk
, hlen
+ tlen
+ size
,
655 msg
->msg_flags
& MSG_DONTWAIT
,
660 skb_reserve(skb
, hlen
);
662 skb_reset_network_header(skb
);
664 cb
= mac_cb_init(skb
);
665 cb
->type
= IEEE802154_FC_TYPE_DATA
;
666 cb
->ackreq
= ro
->want_ack
;
669 DECLARE_SOCKADDR(struct sockaddr_ieee802154
*,
670 daddr
, msg
->msg_name
);
672 ieee802154_addr_from_sa(&dst_addr
, &daddr
->addr
);
674 dst_addr
= ro
->dst_addr
;
677 cb
->secen
= ro
->secen
;
678 cb
->secen_override
= ro
->secen_override
;
679 cb
->seclevel
= ro
->seclevel
;
680 cb
->seclevel_override
= ro
->seclevel_override
;
682 err
= wpan_dev_hard_header(skb
, dev
, &dst_addr
,
683 ro
->bound
? &ro
->src_addr
: NULL
, size
);
687 err
= memcpy_from_msg(skb_put(skb
, size
), msg
, size
);
692 skb
->protocol
= htons(ETH_P_IEEE802154
);
694 err
= dev_queue_xmit(skb
);
696 err
= net_xmit_errno(err
);
710 static int dgram_recvmsg(struct sock
*sk
, struct msghdr
*msg
, size_t len
,
711 int noblock
, int flags
, int *addr_len
)
714 int err
= -EOPNOTSUPP
;
716 struct dgram_sock
*ro
= dgram_sk(sk
);
717 DECLARE_SOCKADDR(struct sockaddr_ieee802154
*, saddr
, msg
->msg_name
);
719 skb
= skb_recv_datagram(sk
, flags
, noblock
, &err
);
725 msg
->msg_flags
|= MSG_TRUNC
;
729 /* FIXME: skip headers if necessary ?! */
730 err
= skb_copy_datagram_msg(skb
, 0, msg
, copied
);
734 sock_recv_ts_and_drops(msg
, sk
, skb
);
737 /* Clear the implicit padding in struct sockaddr_ieee802154
738 * (16 bits between 'family' and 'addr') and in struct
739 * ieee802154_addr_sa (16 bits at the end of the structure).
741 memset(saddr
, 0, sizeof(*saddr
));
743 saddr
->family
= AF_IEEE802154
;
744 ieee802154_addr_to_sa(&saddr
->addr
, &mac_cb(skb
)->source
);
745 *addr_len
= sizeof(*saddr
);
749 err
= put_cmsg(msg
, SOL_IEEE802154
, WPAN_WANTLQI
,
750 sizeof(uint8_t), &(mac_cb(skb
)->lqi
));
755 if (flags
& MSG_TRUNC
)
758 skb_free_datagram(sk
, skb
);
765 static int dgram_rcv_skb(struct sock
*sk
, struct sk_buff
*skb
)
767 skb
= skb_share_check(skb
, GFP_ATOMIC
);
771 if (sock_queue_rcv_skb(sk
, skb
) < 0) {
776 return NET_RX_SUCCESS
;
780 ieee802154_match_sock(__le64 hw_addr
, __le16 pan_id
, __le16 short_addr
,
781 struct dgram_sock
*ro
)
786 if (ro
->src_addr
.mode
== IEEE802154_ADDR_LONG
&&
787 hw_addr
== ro
->src_addr
.extended_addr
)
790 if (ro
->src_addr
.mode
== IEEE802154_ADDR_SHORT
&&
791 pan_id
== ro
->src_addr
.pan_id
&&
792 short_addr
== ro
->src_addr
.short_addr
)
798 static int ieee802154_dgram_deliver(struct net_device
*dev
, struct sk_buff
*skb
)
800 struct sock
*sk
, *prev
= NULL
;
801 int ret
= NET_RX_SUCCESS
;
802 __le16 pan_id
, short_addr
;
805 /* Data frame processing */
806 BUG_ON(dev
->type
!= ARPHRD_IEEE802154
);
808 pan_id
= dev
->ieee802154_ptr
->pan_id
;
809 short_addr
= dev
->ieee802154_ptr
->short_addr
;
810 hw_addr
= dev
->ieee802154_ptr
->extended_addr
;
812 read_lock(&dgram_lock
);
813 sk_for_each(sk
, &dgram_head
) {
814 if (ieee802154_match_sock(hw_addr
, pan_id
, short_addr
,
817 struct sk_buff
*clone
;
819 clone
= skb_clone(skb
, GFP_ATOMIC
);
821 dgram_rcv_skb(prev
, clone
);
829 dgram_rcv_skb(prev
, skb
);
834 read_unlock(&dgram_lock
);
839 static int dgram_getsockopt(struct sock
*sk
, int level
, int optname
,
840 char __user
*optval
, int __user
*optlen
)
842 struct dgram_sock
*ro
= dgram_sk(sk
);
846 if (level
!= SOL_IEEE802154
)
849 if (get_user(len
, optlen
))
852 len
= min_t(unsigned int, len
, sizeof(int));
862 if (!ro
->secen_override
)
863 val
= WPAN_SECURITY_DEFAULT
;
865 val
= WPAN_SECURITY_ON
;
867 val
= WPAN_SECURITY_OFF
;
869 case WPAN_SECURITY_LEVEL
:
870 if (!ro
->seclevel_override
)
871 val
= WPAN_SECURITY_LEVEL_DEFAULT
;
879 if (put_user(len
, optlen
))
881 if (copy_to_user(optval
, &val
, len
))
886 static int dgram_setsockopt(struct sock
*sk
, int level
, int optname
,
887 char __user
*optval
, unsigned int optlen
)
889 struct dgram_sock
*ro
= dgram_sk(sk
);
890 struct net
*net
= sock_net(sk
);
894 if (optlen
< sizeof(int))
897 if (get_user(val
, (int __user
*)optval
))
904 ro
->want_ack
= !!val
;
907 ro
->want_lqi
= !!val
;
910 if (!ns_capable(net
->user_ns
, CAP_NET_ADMIN
) &&
911 !ns_capable(net
->user_ns
, CAP_NET_RAW
)) {
917 case WPAN_SECURITY_DEFAULT
:
918 ro
->secen_override
= 0;
920 case WPAN_SECURITY_ON
:
921 ro
->secen_override
= 1;
924 case WPAN_SECURITY_OFF
:
925 ro
->secen_override
= 1;
933 case WPAN_SECURITY_LEVEL
:
934 if (!ns_capable(net
->user_ns
, CAP_NET_ADMIN
) &&
935 !ns_capable(net
->user_ns
, CAP_NET_RAW
)) {
940 if (val
< WPAN_SECURITY_LEVEL_DEFAULT
||
941 val
> IEEE802154_SCF_SECLEVEL_ENC_MIC128
) {
943 } else if (val
== WPAN_SECURITY_LEVEL_DEFAULT
) {
944 ro
->seclevel_override
= 0;
946 ro
->seclevel_override
= 1;
959 static struct proto ieee802154_dgram_prot
= {
960 .name
= "IEEE-802.15.4-MAC",
961 .owner
= THIS_MODULE
,
962 .obj_size
= sizeof(struct dgram_sock
),
964 .close
= dgram_close
,
966 .sendmsg
= dgram_sendmsg
,
967 .recvmsg
= dgram_recvmsg
,
969 .unhash
= dgram_unhash
,
970 .connect
= dgram_connect
,
971 .disconnect
= dgram_disconnect
,
972 .ioctl
= dgram_ioctl
,
973 .getsockopt
= dgram_getsockopt
,
974 .setsockopt
= dgram_setsockopt
,
977 static const struct proto_ops ieee802154_dgram_ops
= {
978 .family
= PF_IEEE802154
,
979 .owner
= THIS_MODULE
,
980 .release
= ieee802154_sock_release
,
981 .bind
= ieee802154_sock_bind
,
982 .connect
= ieee802154_sock_connect
,
983 .socketpair
= sock_no_socketpair
,
984 .accept
= sock_no_accept
,
985 .getname
= sock_no_getname
,
986 .poll
= datagram_poll
,
987 .ioctl
= ieee802154_sock_ioctl
,
988 .gettstamp
= sock_gettstamp
,
989 .listen
= sock_no_listen
,
990 .shutdown
= sock_no_shutdown
,
991 .setsockopt
= sock_common_setsockopt
,
992 .getsockopt
= sock_common_getsockopt
,
993 .sendmsg
= ieee802154_sock_sendmsg
,
994 .recvmsg
= sock_common_recvmsg
,
995 .mmap
= sock_no_mmap
,
996 .sendpage
= sock_no_sendpage
,
998 .compat_setsockopt
= compat_sock_common_setsockopt
,
999 .compat_getsockopt
= compat_sock_common_getsockopt
,
1003 /* Create a socket. Initialise the socket, blank the addresses
1006 static int ieee802154_create(struct net
*net
, struct socket
*sock
,
1007 int protocol
, int kern
)
1011 struct proto
*proto
;
1012 const struct proto_ops
*ops
;
1014 if (!net_eq(net
, &init_net
))
1015 return -EAFNOSUPPORT
;
1017 switch (sock
->type
) {
1019 proto
= &ieee802154_raw_prot
;
1020 ops
= &ieee802154_raw_ops
;
1023 proto
= &ieee802154_dgram_prot
;
1024 ops
= &ieee802154_dgram_ops
;
1027 rc
= -ESOCKTNOSUPPORT
;
1032 sk
= sk_alloc(net
, PF_IEEE802154
, GFP_KERNEL
, proto
, kern
);
1039 sock_init_data(sock
, sk
);
1040 /* FIXME: sk->sk_destruct */
1041 sk
->sk_family
= PF_IEEE802154
;
1043 /* Checksums on by default */
1044 sock_set_flag(sk
, SOCK_ZAPPED
);
1046 if (sk
->sk_prot
->hash
) {
1047 rc
= sk
->sk_prot
->hash(sk
);
1049 sk_common_release(sk
);
1054 if (sk
->sk_prot
->init
) {
1055 rc
= sk
->sk_prot
->init(sk
);
1057 sk_common_release(sk
);
1063 static const struct net_proto_family ieee802154_family_ops
= {
1064 .family
= PF_IEEE802154
,
1065 .create
= ieee802154_create
,
1066 .owner
= THIS_MODULE
,
1069 static int ieee802154_rcv(struct sk_buff
*skb
, struct net_device
*dev
,
1070 struct packet_type
*pt
, struct net_device
*orig_dev
)
1072 if (!netif_running(dev
))
1074 pr_debug("got frame, type %d, dev %p\n", dev
->type
, dev
);
1076 print_hex_dump_bytes("ieee802154_rcv ",
1077 DUMP_PREFIX_NONE
, skb
->data
, skb
->len
);
1080 if (!net_eq(dev_net(dev
), &init_net
))
1083 ieee802154_raw_deliver(dev
, skb
);
1085 if (dev
->type
!= ARPHRD_IEEE802154
)
1088 if (skb
->pkt_type
!= PACKET_OTHERHOST
)
1089 return ieee802154_dgram_deliver(dev
, skb
);
1096 static struct packet_type ieee802154_packet_type
= {
1097 .type
= htons(ETH_P_IEEE802154
),
1098 .func
= ieee802154_rcv
,
1101 static int __init
af_ieee802154_init(void)
1105 rc
= proto_register(&ieee802154_raw_prot
, 1);
1109 rc
= proto_register(&ieee802154_dgram_prot
, 1);
1113 /* Tell SOCKET that we are alive */
1114 rc
= sock_register(&ieee802154_family_ops
);
1117 dev_add_pack(&ieee802154_packet_type
);
1123 proto_unregister(&ieee802154_dgram_prot
);
1125 proto_unregister(&ieee802154_raw_prot
);
1130 static void __exit
af_ieee802154_remove(void)
1132 dev_remove_pack(&ieee802154_packet_type
);
1133 sock_unregister(PF_IEEE802154
);
1134 proto_unregister(&ieee802154_dgram_prot
);
1135 proto_unregister(&ieee802154_raw_prot
);
1138 module_init(af_ieee802154_init
);
1139 module_exit(af_ieee802154_remove
);
1141 MODULE_LICENSE("GPL");
1142 MODULE_ALIAS_NETPROTO(PF_IEEE802154
);