1 // SPDX-License-Identifier: GPL-2.0-only
3 * IEEE802154.4 socket interface
5 * Copyright 2007, 2008 Siemens AG
8 * Sergey Lapin <slapin@ossfans.org>
9 * Maxim Gorbachyov <maxim.gorbachev@siemens.com>
12 #include <linux/net.h>
13 #include <linux/capability.h>
14 #include <linux/module.h>
15 #include <linux/if_arp.h>
17 #include <linux/termios.h> /* For TIOCOUTQ/INQ */
18 #include <linux/list.h>
19 #include <linux/slab.h>
20 #include <linux/socket.h>
21 #include <net/datalink.h>
22 #include <net/psnap.h>
24 #include <net/tcp_states.h>
25 #include <net/route.h>
27 #include <net/af_ieee802154.h>
28 #include <net/ieee802154_netdev.h>
30 /* Utility function for families */
31 static struct net_device
*
32 ieee802154_get_dev(struct net
*net
, const struct ieee802154_addr
*addr
)
34 struct net_device
*dev
= NULL
;
35 struct net_device
*tmp
;
36 __le16 pan_id
, short_addr
;
37 u8 hwaddr
[IEEE802154_ADDR_LEN
];
40 case IEEE802154_ADDR_LONG
:
41 ieee802154_devaddr_to_raw(hwaddr
, addr
->extended_addr
);
43 dev
= dev_getbyhwaddr_rcu(net
, ARPHRD_IEEE802154
, hwaddr
);
47 case IEEE802154_ADDR_SHORT
:
48 if (addr
->pan_id
== cpu_to_le16(IEEE802154_PANID_BROADCAST
) ||
49 addr
->short_addr
== cpu_to_le16(IEEE802154_ADDR_UNDEF
) ||
50 addr
->short_addr
== cpu_to_le16(IEEE802154_ADDR_BROADCAST
))
55 for_each_netdev(net
, tmp
) {
56 if (tmp
->type
!= ARPHRD_IEEE802154
)
59 pan_id
= tmp
->ieee802154_ptr
->pan_id
;
60 short_addr
= tmp
->ieee802154_ptr
->short_addr
;
61 if (pan_id
== addr
->pan_id
&&
62 short_addr
== addr
->short_addr
) {
72 pr_warn("Unsupported ieee802154 address type: %d\n",
80 static int ieee802154_sock_release(struct socket
*sock
)
82 struct sock
*sk
= sock
->sk
;
86 sk
->sk_prot
->close(sk
, 0);
91 static int ieee802154_sock_sendmsg(struct socket
*sock
, struct msghdr
*msg
,
94 struct sock
*sk
= sock
->sk
;
96 return sk
->sk_prot
->sendmsg(sk
, msg
, len
);
99 static int ieee802154_sock_bind(struct socket
*sock
, struct sockaddr
*uaddr
,
102 struct sock
*sk
= sock
->sk
;
104 if (sk
->sk_prot
->bind
)
105 return sk
->sk_prot
->bind(sk
, uaddr
, addr_len
);
107 return sock_no_bind(sock
, uaddr
, addr_len
);
110 static int ieee802154_sock_connect(struct socket
*sock
, struct sockaddr
*uaddr
,
111 int addr_len
, int flags
)
113 struct sock
*sk
= sock
->sk
;
115 if (addr_len
< sizeof(uaddr
->sa_family
))
118 if (uaddr
->sa_family
== AF_UNSPEC
)
119 return sk
->sk_prot
->disconnect(sk
, flags
);
121 return sk
->sk_prot
->connect(sk
, uaddr
, addr_len
);
124 static int ieee802154_dev_ioctl(struct sock
*sk
, struct ifreq __user
*arg
,
128 int ret
= -ENOIOCTLCMD
;
129 struct net_device
*dev
;
131 if (get_user_ifreq(&ifr
, NULL
, arg
))
134 ifr
.ifr_name
[IFNAMSIZ
-1] = 0;
136 dev_load(sock_net(sk
), ifr
.ifr_name
);
137 dev
= dev_get_by_name(sock_net(sk
), ifr
.ifr_name
);
142 if (dev
->type
== ARPHRD_IEEE802154
&& dev
->netdev_ops
->ndo_do_ioctl
)
143 ret
= dev
->netdev_ops
->ndo_do_ioctl(dev
, &ifr
, cmd
);
145 if (!ret
&& put_user_ifreq(&ifr
, arg
))
152 static int ieee802154_sock_ioctl(struct socket
*sock
, unsigned int cmd
,
155 struct sock
*sk
= sock
->sk
;
160 return ieee802154_dev_ioctl(sk
, (struct ifreq __user
*)arg
,
163 if (!sk
->sk_prot
->ioctl
)
165 return sk
->sk_prot
->ioctl(sk
, cmd
, arg
);
169 /* RAW Sockets (802.15.4 created in userspace) */
170 static HLIST_HEAD(raw_head
);
171 static DEFINE_RWLOCK(raw_lock
);
173 static int raw_hash(struct sock
*sk
)
175 write_lock_bh(&raw_lock
);
176 sk_add_node(sk
, &raw_head
);
177 sock_prot_inuse_add(sock_net(sk
), sk
->sk_prot
, 1);
178 write_unlock_bh(&raw_lock
);
183 static void raw_unhash(struct sock
*sk
)
185 write_lock_bh(&raw_lock
);
186 if (sk_del_node_init(sk
))
187 sock_prot_inuse_add(sock_net(sk
), sk
->sk_prot
, -1);
188 write_unlock_bh(&raw_lock
);
191 static void raw_close(struct sock
*sk
, long timeout
)
193 sk_common_release(sk
);
196 static int raw_bind(struct sock
*sk
, struct sockaddr
*_uaddr
, int len
)
198 struct ieee802154_addr addr
;
199 struct sockaddr_ieee802154
*uaddr
= (struct sockaddr_ieee802154
*)_uaddr
;
201 struct net_device
*dev
= NULL
;
203 if (len
< sizeof(*uaddr
))
206 uaddr
= (struct sockaddr_ieee802154
*)_uaddr
;
207 if (uaddr
->family
!= AF_IEEE802154
)
212 ieee802154_addr_from_sa(&addr
, &uaddr
->addr
);
213 dev
= ieee802154_get_dev(sock_net(sk
), &addr
);
219 sk
->sk_bound_dev_if
= dev
->ifindex
;
229 static int raw_connect(struct sock
*sk
, struct sockaddr
*uaddr
,
235 static int raw_disconnect(struct sock
*sk
, int flags
)
240 static int raw_sendmsg(struct sock
*sk
, struct msghdr
*msg
, size_t size
)
242 struct net_device
*dev
;
248 if (msg
->msg_flags
& MSG_OOB
) {
249 pr_debug("msg->msg_flags = 0x%x\n", msg
->msg_flags
);
254 if (!sk
->sk_bound_dev_if
)
255 dev
= dev_getfirstbyhwtype(sock_net(sk
), ARPHRD_IEEE802154
);
257 dev
= dev_get_by_index(sock_net(sk
), sk
->sk_bound_dev_if
);
261 pr_debug("no dev\n");
266 mtu
= IEEE802154_MTU
;
267 pr_debug("name = %s, mtu = %u\n", dev
->name
, mtu
);
270 pr_debug("size = %zu, mtu = %u\n", size
, mtu
);
275 hlen
= LL_RESERVED_SPACE(dev
);
276 tlen
= dev
->needed_tailroom
;
277 skb
= sock_alloc_send_skb(sk
, hlen
+ tlen
+ size
,
278 msg
->msg_flags
& MSG_DONTWAIT
, &err
);
282 skb_reserve(skb
, hlen
);
284 skb_reset_mac_header(skb
);
285 skb_reset_network_header(skb
);
287 err
= memcpy_from_msg(skb_put(skb
, size
), msg
, size
);
292 skb
->protocol
= htons(ETH_P_IEEE802154
);
294 err
= dev_queue_xmit(skb
);
296 err
= net_xmit_errno(err
);
310 static int raw_recvmsg(struct sock
*sk
, struct msghdr
*msg
, size_t len
,
311 int noblock
, int flags
, int *addr_len
)
314 int err
= -EOPNOTSUPP
;
317 skb
= skb_recv_datagram(sk
, flags
, noblock
, &err
);
323 msg
->msg_flags
|= MSG_TRUNC
;
327 err
= skb_copy_datagram_msg(skb
, 0, msg
, copied
);
331 sock_recv_ts_and_drops(msg
, sk
, skb
);
333 if (flags
& MSG_TRUNC
)
336 skb_free_datagram(sk
, skb
);
343 static int raw_rcv_skb(struct sock
*sk
, struct sk_buff
*skb
)
345 skb
= skb_share_check(skb
, GFP_ATOMIC
);
349 if (sock_queue_rcv_skb(sk
, skb
) < 0) {
354 return NET_RX_SUCCESS
;
357 static void ieee802154_raw_deliver(struct net_device
*dev
, struct sk_buff
*skb
)
361 read_lock(&raw_lock
);
362 sk_for_each(sk
, &raw_head
) {
364 if (!sk
->sk_bound_dev_if
||
365 sk
->sk_bound_dev_if
== dev
->ifindex
) {
366 struct sk_buff
*clone
;
368 clone
= skb_clone(skb
, GFP_ATOMIC
);
370 raw_rcv_skb(sk
, clone
);
374 read_unlock(&raw_lock
);
377 static int raw_getsockopt(struct sock
*sk
, int level
, int optname
,
378 char __user
*optval
, int __user
*optlen
)
383 static int raw_setsockopt(struct sock
*sk
, int level
, int optname
,
384 sockptr_t optval
, unsigned int optlen
)
389 static struct proto ieee802154_raw_prot
= {
390 .name
= "IEEE-802.15.4-RAW",
391 .owner
= THIS_MODULE
,
392 .obj_size
= sizeof(struct sock
),
395 .sendmsg
= raw_sendmsg
,
396 .recvmsg
= raw_recvmsg
,
398 .unhash
= raw_unhash
,
399 .connect
= raw_connect
,
400 .disconnect
= raw_disconnect
,
401 .getsockopt
= raw_getsockopt
,
402 .setsockopt
= raw_setsockopt
,
405 static const struct proto_ops ieee802154_raw_ops
= {
406 .family
= PF_IEEE802154
,
407 .owner
= THIS_MODULE
,
408 .release
= ieee802154_sock_release
,
409 .bind
= ieee802154_sock_bind
,
410 .connect
= ieee802154_sock_connect
,
411 .socketpair
= sock_no_socketpair
,
412 .accept
= sock_no_accept
,
413 .getname
= sock_no_getname
,
414 .poll
= datagram_poll
,
415 .ioctl
= ieee802154_sock_ioctl
,
416 .gettstamp
= sock_gettstamp
,
417 .listen
= sock_no_listen
,
418 .shutdown
= sock_no_shutdown
,
419 .setsockopt
= sock_common_setsockopt
,
420 .getsockopt
= sock_common_getsockopt
,
421 .sendmsg
= ieee802154_sock_sendmsg
,
422 .recvmsg
= sock_common_recvmsg
,
423 .mmap
= sock_no_mmap
,
424 .sendpage
= sock_no_sendpage
,
427 /* DGRAM Sockets (802.15.4 dataframes) */
428 static HLIST_HEAD(dgram_head
);
429 static DEFINE_RWLOCK(dgram_lock
);
434 struct ieee802154_addr src_addr
;
435 struct ieee802154_addr dst_addr
;
437 unsigned int bound
:1;
438 unsigned int connected
:1;
439 unsigned int want_ack
:1;
440 unsigned int want_lqi
:1;
441 unsigned int secen
:1;
442 unsigned int secen_override
:1;
443 unsigned int seclevel
:3;
444 unsigned int seclevel_override
:1;
447 static inline struct dgram_sock
*dgram_sk(const struct sock
*sk
)
449 return container_of(sk
, struct dgram_sock
, sk
);
452 static int dgram_hash(struct sock
*sk
)
454 write_lock_bh(&dgram_lock
);
455 sk_add_node(sk
, &dgram_head
);
456 sock_prot_inuse_add(sock_net(sk
), sk
->sk_prot
, 1);
457 write_unlock_bh(&dgram_lock
);
462 static void dgram_unhash(struct sock
*sk
)
464 write_lock_bh(&dgram_lock
);
465 if (sk_del_node_init(sk
))
466 sock_prot_inuse_add(sock_net(sk
), sk
->sk_prot
, -1);
467 write_unlock_bh(&dgram_lock
);
470 static int dgram_init(struct sock
*sk
)
472 struct dgram_sock
*ro
= dgram_sk(sk
);
479 static void dgram_close(struct sock
*sk
, long timeout
)
481 sk_common_release(sk
);
484 static int dgram_bind(struct sock
*sk
, struct sockaddr
*uaddr
, int len
)
486 struct sockaddr_ieee802154
*addr
= (struct sockaddr_ieee802154
*)uaddr
;
487 struct ieee802154_addr haddr
;
488 struct dgram_sock
*ro
= dgram_sk(sk
);
490 struct net_device
*dev
;
496 if (len
< sizeof(*addr
))
499 if (addr
->family
!= AF_IEEE802154
)
502 ieee802154_addr_from_sa(&haddr
, &addr
->addr
);
503 dev
= ieee802154_get_dev(sock_net(sk
), &haddr
);
509 if (dev
->type
!= ARPHRD_IEEE802154
) {
514 ro
->src_addr
= haddr
;
526 static int dgram_ioctl(struct sock
*sk
, int cmd
, unsigned long arg
)
531 int amount
= sk_wmem_alloc_get(sk
);
533 return put_user(amount
, (int __user
*)arg
);
539 unsigned long amount
;
542 spin_lock_bh(&sk
->sk_receive_queue
.lock
);
543 skb
= skb_peek(&sk
->sk_receive_queue
);
545 /* We will only return the amount
546 * of this packet since that is all
549 amount
= skb
->len
- ieee802154_hdr_length(skb
);
551 spin_unlock_bh(&sk
->sk_receive_queue
.lock
);
552 return put_user(amount
, (int __user
*)arg
);
559 /* FIXME: autobind */
560 static int dgram_connect(struct sock
*sk
, struct sockaddr
*uaddr
,
563 struct sockaddr_ieee802154
*addr
= (struct sockaddr_ieee802154
*)uaddr
;
564 struct dgram_sock
*ro
= dgram_sk(sk
);
567 if (len
< sizeof(*addr
))
570 if (addr
->family
!= AF_IEEE802154
)
580 ieee802154_addr_from_sa(&ro
->dst_addr
, &addr
->addr
);
588 static int dgram_disconnect(struct sock
*sk
, int flags
)
590 struct dgram_sock
*ro
= dgram_sk(sk
);
599 static int dgram_sendmsg(struct sock
*sk
, struct msghdr
*msg
, size_t size
)
601 struct net_device
*dev
;
604 struct ieee802154_mac_cb
*cb
;
605 struct dgram_sock
*ro
= dgram_sk(sk
);
606 struct ieee802154_addr dst_addr
;
610 if (msg
->msg_flags
& MSG_OOB
) {
611 pr_debug("msg->msg_flags = 0x%x\n", msg
->msg_flags
);
615 if (!ro
->connected
&& !msg
->msg_name
)
616 return -EDESTADDRREQ
;
617 else if (ro
->connected
&& msg
->msg_name
)
621 dev
= dev_getfirstbyhwtype(sock_net(sk
), ARPHRD_IEEE802154
);
623 dev
= ieee802154_get_dev(sock_net(sk
), &ro
->src_addr
);
626 pr_debug("no dev\n");
630 mtu
= IEEE802154_MTU
;
631 pr_debug("name = %s, mtu = %u\n", dev
->name
, mtu
);
634 pr_debug("size = %zu, mtu = %u\n", size
, mtu
);
639 hlen
= LL_RESERVED_SPACE(dev
);
640 tlen
= dev
->needed_tailroom
;
641 skb
= sock_alloc_send_skb(sk
, hlen
+ tlen
+ size
,
642 msg
->msg_flags
& MSG_DONTWAIT
,
647 skb_reserve(skb
, hlen
);
649 skb_reset_network_header(skb
);
651 cb
= mac_cb_init(skb
);
652 cb
->type
= IEEE802154_FC_TYPE_DATA
;
653 cb
->ackreq
= ro
->want_ack
;
656 DECLARE_SOCKADDR(struct sockaddr_ieee802154
*,
657 daddr
, msg
->msg_name
);
659 ieee802154_addr_from_sa(&dst_addr
, &daddr
->addr
);
661 dst_addr
= ro
->dst_addr
;
664 cb
->secen
= ro
->secen
;
665 cb
->secen_override
= ro
->secen_override
;
666 cb
->seclevel
= ro
->seclevel
;
667 cb
->seclevel_override
= ro
->seclevel_override
;
669 err
= wpan_dev_hard_header(skb
, dev
, &dst_addr
,
670 ro
->bound
? &ro
->src_addr
: NULL
, size
);
674 err
= memcpy_from_msg(skb_put(skb
, size
), msg
, size
);
679 skb
->protocol
= htons(ETH_P_IEEE802154
);
681 err
= dev_queue_xmit(skb
);
683 err
= net_xmit_errno(err
);
697 static int dgram_recvmsg(struct sock
*sk
, struct msghdr
*msg
, size_t len
,
698 int noblock
, int flags
, int *addr_len
)
701 int err
= -EOPNOTSUPP
;
703 struct dgram_sock
*ro
= dgram_sk(sk
);
704 DECLARE_SOCKADDR(struct sockaddr_ieee802154
*, saddr
, msg
->msg_name
);
706 skb
= skb_recv_datagram(sk
, flags
, noblock
, &err
);
712 msg
->msg_flags
|= MSG_TRUNC
;
716 /* FIXME: skip headers if necessary ?! */
717 err
= skb_copy_datagram_msg(skb
, 0, msg
, copied
);
721 sock_recv_ts_and_drops(msg
, sk
, skb
);
724 /* Clear the implicit padding in struct sockaddr_ieee802154
725 * (16 bits between 'family' and 'addr') and in struct
726 * ieee802154_addr_sa (16 bits at the end of the structure).
728 memset(saddr
, 0, sizeof(*saddr
));
730 saddr
->family
= AF_IEEE802154
;
731 ieee802154_addr_to_sa(&saddr
->addr
, &mac_cb(skb
)->source
);
732 *addr_len
= sizeof(*saddr
);
736 err
= put_cmsg(msg
, SOL_IEEE802154
, WPAN_WANTLQI
,
737 sizeof(uint8_t), &(mac_cb(skb
)->lqi
));
742 if (flags
& MSG_TRUNC
)
745 skb_free_datagram(sk
, skb
);
752 static int dgram_rcv_skb(struct sock
*sk
, struct sk_buff
*skb
)
754 skb
= skb_share_check(skb
, GFP_ATOMIC
);
758 if (sock_queue_rcv_skb(sk
, skb
) < 0) {
763 return NET_RX_SUCCESS
;
767 ieee802154_match_sock(__le64 hw_addr
, __le16 pan_id
, __le16 short_addr
,
768 struct dgram_sock
*ro
)
773 if (ro
->src_addr
.mode
== IEEE802154_ADDR_LONG
&&
774 hw_addr
== ro
->src_addr
.extended_addr
)
777 if (ro
->src_addr
.mode
== IEEE802154_ADDR_SHORT
&&
778 pan_id
== ro
->src_addr
.pan_id
&&
779 short_addr
== ro
->src_addr
.short_addr
)
785 static int ieee802154_dgram_deliver(struct net_device
*dev
, struct sk_buff
*skb
)
787 struct sock
*sk
, *prev
= NULL
;
788 int ret
= NET_RX_SUCCESS
;
789 __le16 pan_id
, short_addr
;
792 /* Data frame processing */
793 BUG_ON(dev
->type
!= ARPHRD_IEEE802154
);
795 pan_id
= dev
->ieee802154_ptr
->pan_id
;
796 short_addr
= dev
->ieee802154_ptr
->short_addr
;
797 hw_addr
= dev
->ieee802154_ptr
->extended_addr
;
799 read_lock(&dgram_lock
);
800 sk_for_each(sk
, &dgram_head
) {
801 if (ieee802154_match_sock(hw_addr
, pan_id
, short_addr
,
804 struct sk_buff
*clone
;
806 clone
= skb_clone(skb
, GFP_ATOMIC
);
808 dgram_rcv_skb(prev
, clone
);
816 dgram_rcv_skb(prev
, skb
);
821 read_unlock(&dgram_lock
);
826 static int dgram_getsockopt(struct sock
*sk
, int level
, int optname
,
827 char __user
*optval
, int __user
*optlen
)
829 struct dgram_sock
*ro
= dgram_sk(sk
);
833 if (level
!= SOL_IEEE802154
)
836 if (get_user(len
, optlen
))
839 len
= min_t(unsigned int, len
, sizeof(int));
849 if (!ro
->secen_override
)
850 val
= WPAN_SECURITY_DEFAULT
;
852 val
= WPAN_SECURITY_ON
;
854 val
= WPAN_SECURITY_OFF
;
856 case WPAN_SECURITY_LEVEL
:
857 if (!ro
->seclevel_override
)
858 val
= WPAN_SECURITY_LEVEL_DEFAULT
;
866 if (put_user(len
, optlen
))
868 if (copy_to_user(optval
, &val
, len
))
873 static int dgram_setsockopt(struct sock
*sk
, int level
, int optname
,
874 sockptr_t optval
, unsigned int optlen
)
876 struct dgram_sock
*ro
= dgram_sk(sk
);
877 struct net
*net
= sock_net(sk
);
881 if (optlen
< sizeof(int))
884 if (copy_from_sockptr(&val
, optval
, sizeof(int)))
891 ro
->want_ack
= !!val
;
894 ro
->want_lqi
= !!val
;
897 if (!ns_capable(net
->user_ns
, CAP_NET_ADMIN
) &&
898 !ns_capable(net
->user_ns
, CAP_NET_RAW
)) {
904 case WPAN_SECURITY_DEFAULT
:
905 ro
->secen_override
= 0;
907 case WPAN_SECURITY_ON
:
908 ro
->secen_override
= 1;
911 case WPAN_SECURITY_OFF
:
912 ro
->secen_override
= 1;
920 case WPAN_SECURITY_LEVEL
:
921 if (!ns_capable(net
->user_ns
, CAP_NET_ADMIN
) &&
922 !ns_capable(net
->user_ns
, CAP_NET_RAW
)) {
927 if (val
< WPAN_SECURITY_LEVEL_DEFAULT
||
928 val
> IEEE802154_SCF_SECLEVEL_ENC_MIC128
) {
930 } else if (val
== WPAN_SECURITY_LEVEL_DEFAULT
) {
931 ro
->seclevel_override
= 0;
933 ro
->seclevel_override
= 1;
946 static struct proto ieee802154_dgram_prot
= {
947 .name
= "IEEE-802.15.4-MAC",
948 .owner
= THIS_MODULE
,
949 .obj_size
= sizeof(struct dgram_sock
),
951 .close
= dgram_close
,
953 .sendmsg
= dgram_sendmsg
,
954 .recvmsg
= dgram_recvmsg
,
956 .unhash
= dgram_unhash
,
957 .connect
= dgram_connect
,
958 .disconnect
= dgram_disconnect
,
959 .ioctl
= dgram_ioctl
,
960 .getsockopt
= dgram_getsockopt
,
961 .setsockopt
= dgram_setsockopt
,
964 static const struct proto_ops ieee802154_dgram_ops
= {
965 .family
= PF_IEEE802154
,
966 .owner
= THIS_MODULE
,
967 .release
= ieee802154_sock_release
,
968 .bind
= ieee802154_sock_bind
,
969 .connect
= ieee802154_sock_connect
,
970 .socketpair
= sock_no_socketpair
,
971 .accept
= sock_no_accept
,
972 .getname
= sock_no_getname
,
973 .poll
= datagram_poll
,
974 .ioctl
= ieee802154_sock_ioctl
,
975 .gettstamp
= sock_gettstamp
,
976 .listen
= sock_no_listen
,
977 .shutdown
= sock_no_shutdown
,
978 .setsockopt
= sock_common_setsockopt
,
979 .getsockopt
= sock_common_getsockopt
,
980 .sendmsg
= ieee802154_sock_sendmsg
,
981 .recvmsg
= sock_common_recvmsg
,
982 .mmap
= sock_no_mmap
,
983 .sendpage
= sock_no_sendpage
,
986 static void ieee802154_sock_destruct(struct sock
*sk
)
988 skb_queue_purge(&sk
->sk_receive_queue
);
991 /* Create a socket. Initialise the socket, blank the addresses
994 static int ieee802154_create(struct net
*net
, struct socket
*sock
,
995 int protocol
, int kern
)
1000 const struct proto_ops
*ops
;
1002 if (!net_eq(net
, &init_net
))
1003 return -EAFNOSUPPORT
;
1005 switch (sock
->type
) {
1008 if (!capable(CAP_NET_RAW
))
1010 proto
= &ieee802154_raw_prot
;
1011 ops
= &ieee802154_raw_ops
;
1014 proto
= &ieee802154_dgram_prot
;
1015 ops
= &ieee802154_dgram_ops
;
1018 rc
= -ESOCKTNOSUPPORT
;
1023 sk
= sk_alloc(net
, PF_IEEE802154
, GFP_KERNEL
, proto
, kern
);
1030 sock_init_data(sock
, sk
);
1031 sk
->sk_destruct
= ieee802154_sock_destruct
;
1032 sk
->sk_family
= PF_IEEE802154
;
1034 /* Checksums on by default */
1035 sock_set_flag(sk
, SOCK_ZAPPED
);
1037 if (sk
->sk_prot
->hash
) {
1038 rc
= sk
->sk_prot
->hash(sk
);
1040 sk_common_release(sk
);
1045 if (sk
->sk_prot
->init
) {
1046 rc
= sk
->sk_prot
->init(sk
);
1048 sk_common_release(sk
);
1054 static const struct net_proto_family ieee802154_family_ops
= {
1055 .family
= PF_IEEE802154
,
1056 .create
= ieee802154_create
,
1057 .owner
= THIS_MODULE
,
1060 static int ieee802154_rcv(struct sk_buff
*skb
, struct net_device
*dev
,
1061 struct packet_type
*pt
, struct net_device
*orig_dev
)
1063 if (!netif_running(dev
))
1065 pr_debug("got frame, type %d, dev %p\n", dev
->type
, dev
);
1067 print_hex_dump_bytes("ieee802154_rcv ",
1068 DUMP_PREFIX_NONE
, skb
->data
, skb
->len
);
1071 if (!net_eq(dev_net(dev
), &init_net
))
1074 ieee802154_raw_deliver(dev
, skb
);
1076 if (dev
->type
!= ARPHRD_IEEE802154
)
1079 if (skb
->pkt_type
!= PACKET_OTHERHOST
)
1080 return ieee802154_dgram_deliver(dev
, skb
);
1087 static struct packet_type ieee802154_packet_type
= {
1088 .type
= htons(ETH_P_IEEE802154
),
1089 .func
= ieee802154_rcv
,
1092 static int __init
af_ieee802154_init(void)
1096 rc
= proto_register(&ieee802154_raw_prot
, 1);
1100 rc
= proto_register(&ieee802154_dgram_prot
, 1);
1104 /* Tell SOCKET that we are alive */
1105 rc
= sock_register(&ieee802154_family_ops
);
1108 dev_add_pack(&ieee802154_packet_type
);
1114 proto_unregister(&ieee802154_dgram_prot
);
1116 proto_unregister(&ieee802154_raw_prot
);
1121 static void __exit
af_ieee802154_remove(void)
1123 dev_remove_pack(&ieee802154_packet_type
);
1124 sock_unregister(PF_IEEE802154
);
1125 proto_unregister(&ieee802154_dgram_prot
);
1126 proto_unregister(&ieee802154_raw_prot
);
1129 module_init(af_ieee802154_init
);
1130 module_exit(af_ieee802154_remove
);
1132 MODULE_LICENSE("GPL");
1133 MODULE_ALIAS_NETPROTO(PF_IEEE802154
);