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 <net/datalink.h>
29 #include <net/psnap.h>
31 #include <net/tcp_states.h>
32 #include <net/route.h>
34 #include <net/af_ieee802154.h>
35 #include <net/ieee802154_netdev.h>
37 /* Utility function for families */
38 static struct net_device
*
39 ieee802154_get_dev(struct net
*net
, const struct ieee802154_addr
*addr
)
41 struct net_device
*dev
= NULL
;
42 struct net_device
*tmp
;
43 __le16 pan_id
, short_addr
;
44 u8 hwaddr
[IEEE802154_ADDR_LEN
];
47 case IEEE802154_ADDR_LONG
:
48 ieee802154_devaddr_to_raw(hwaddr
, addr
->extended_addr
);
50 dev
= dev_getbyhwaddr_rcu(net
, ARPHRD_IEEE802154
, hwaddr
);
55 case IEEE802154_ADDR_SHORT
:
56 if (addr
->pan_id
== cpu_to_le16(IEEE802154_PANID_BROADCAST
) ||
57 addr
->short_addr
== cpu_to_le16(IEEE802154_ADDR_UNDEF
) ||
58 addr
->short_addr
== cpu_to_le16(IEEE802154_ADDR_BROADCAST
))
63 for_each_netdev(net
, tmp
) {
64 if (tmp
->type
!= ARPHRD_IEEE802154
)
67 pan_id
= ieee802154_mlme_ops(tmp
)->get_pan_id(tmp
);
69 ieee802154_mlme_ops(tmp
)->get_short_addr(tmp
);
71 if (pan_id
== addr
->pan_id
&&
72 short_addr
== addr
->short_addr
) {
82 pr_warn("Unsupported ieee802154 address type: %d\n",
90 static int ieee802154_sock_release(struct socket
*sock
)
92 struct sock
*sk
= sock
->sk
;
96 sk
->sk_prot
->close(sk
, 0);
101 static int ieee802154_sock_sendmsg(struct kiocb
*iocb
, struct socket
*sock
,
102 struct msghdr
*msg
, size_t len
)
104 struct sock
*sk
= sock
->sk
;
106 return sk
->sk_prot
->sendmsg(iocb
, sk
, msg
, len
);
109 static int ieee802154_sock_bind(struct socket
*sock
, struct sockaddr
*uaddr
,
112 struct sock
*sk
= sock
->sk
;
114 if (sk
->sk_prot
->bind
)
115 return sk
->sk_prot
->bind(sk
, uaddr
, addr_len
);
117 return sock_no_bind(sock
, uaddr
, addr_len
);
120 static int ieee802154_sock_connect(struct socket
*sock
, struct sockaddr
*uaddr
,
121 int addr_len
, int flags
)
123 struct sock
*sk
= sock
->sk
;
125 if (addr_len
< sizeof(uaddr
->sa_family
))
128 if (uaddr
->sa_family
== AF_UNSPEC
)
129 return sk
->sk_prot
->disconnect(sk
, flags
);
131 return sk
->sk_prot
->connect(sk
, uaddr
, addr_len
);
134 static int ieee802154_dev_ioctl(struct sock
*sk
, struct ifreq __user
*arg
,
138 int ret
= -ENOIOCTLCMD
;
139 struct net_device
*dev
;
141 if (copy_from_user(&ifr
, arg
, sizeof(struct ifreq
)))
144 ifr
.ifr_name
[IFNAMSIZ
-1] = 0;
146 dev_load(sock_net(sk
), ifr
.ifr_name
);
147 dev
= dev_get_by_name(sock_net(sk
), ifr
.ifr_name
);
152 if (dev
->type
== ARPHRD_IEEE802154
&& dev
->netdev_ops
->ndo_do_ioctl
)
153 ret
= dev
->netdev_ops
->ndo_do_ioctl(dev
, &ifr
, cmd
);
155 if (!ret
&& copy_to_user(arg
, &ifr
, sizeof(struct ifreq
)))
162 static int ieee802154_sock_ioctl(struct socket
*sock
, unsigned int cmd
,
165 struct sock
*sk
= sock
->sk
;
169 return sock_get_timestamp(sk
, (struct timeval __user
*)arg
);
171 return sock_get_timestampns(sk
, (struct timespec __user
*)arg
);
174 return ieee802154_dev_ioctl(sk
, (struct ifreq __user
*)arg
,
177 if (!sk
->sk_prot
->ioctl
)
179 return sk
->sk_prot
->ioctl(sk
, cmd
, arg
);
183 /* RAW Sockets (802.15.4 created in userspace) */
184 static HLIST_HEAD(raw_head
);
185 static DEFINE_RWLOCK(raw_lock
);
187 static void raw_hash(struct sock
*sk
)
189 write_lock_bh(&raw_lock
);
190 sk_add_node(sk
, &raw_head
);
191 sock_prot_inuse_add(sock_net(sk
), sk
->sk_prot
, 1);
192 write_unlock_bh(&raw_lock
);
195 static void raw_unhash(struct sock
*sk
)
197 write_lock_bh(&raw_lock
);
198 if (sk_del_node_init(sk
))
199 sock_prot_inuse_add(sock_net(sk
), sk
->sk_prot
, -1);
200 write_unlock_bh(&raw_lock
);
203 static void raw_close(struct sock
*sk
, long timeout
)
205 sk_common_release(sk
);
208 static int raw_bind(struct sock
*sk
, struct sockaddr
*_uaddr
, int len
)
210 struct ieee802154_addr addr
;
211 struct sockaddr_ieee802154
*uaddr
= (struct sockaddr_ieee802154
*)_uaddr
;
213 struct net_device
*dev
= NULL
;
215 if (len
< sizeof(*uaddr
))
218 uaddr
= (struct sockaddr_ieee802154
*)_uaddr
;
219 if (uaddr
->family
!= AF_IEEE802154
)
224 ieee802154_addr_from_sa(&addr
, &uaddr
->addr
);
225 dev
= ieee802154_get_dev(sock_net(sk
), &addr
);
231 if (dev
->type
!= ARPHRD_IEEE802154
) {
236 sk
->sk_bound_dev_if
= dev
->ifindex
;
247 static int raw_connect(struct sock
*sk
, struct sockaddr
*uaddr
,
253 static int raw_disconnect(struct sock
*sk
, int flags
)
258 static int raw_sendmsg(struct kiocb
*iocb
, struct sock
*sk
,
259 struct msghdr
*msg
, size_t size
)
261 struct net_device
*dev
;
267 if (msg
->msg_flags
& MSG_OOB
) {
268 pr_debug("msg->msg_flags = 0x%x\n", msg
->msg_flags
);
273 if (!sk
->sk_bound_dev_if
)
274 dev
= dev_getfirstbyhwtype(sock_net(sk
), ARPHRD_IEEE802154
);
276 dev
= dev_get_by_index(sock_net(sk
), sk
->sk_bound_dev_if
);
280 pr_debug("no dev\n");
286 pr_debug("name = %s, mtu = %u\n", dev
->name
, mtu
);
289 pr_debug("size = %Zu, mtu = %u\n", size
, mtu
);
294 hlen
= LL_RESERVED_SPACE(dev
);
295 tlen
= dev
->needed_tailroom
;
296 skb
= sock_alloc_send_skb(sk
, hlen
+ tlen
+ size
,
297 msg
->msg_flags
& MSG_DONTWAIT
, &err
);
301 skb_reserve(skb
, hlen
);
303 skb_reset_mac_header(skb
);
304 skb_reset_network_header(skb
);
306 err
= memcpy_from_msg(skb_put(skb
, size
), msg
, size
);
312 skb
->protocol
= htons(ETH_P_IEEE802154
);
316 err
= dev_queue_xmit(skb
);
318 err
= net_xmit_errno(err
);
330 static int raw_recvmsg(struct kiocb
*iocb
, struct sock
*sk
, struct msghdr
*msg
,
331 size_t len
, int noblock
, int flags
, int *addr_len
)
334 int err
= -EOPNOTSUPP
;
337 skb
= skb_recv_datagram(sk
, flags
, noblock
, &err
);
343 msg
->msg_flags
|= MSG_TRUNC
;
347 err
= skb_copy_datagram_msg(skb
, 0, msg
, copied
);
351 sock_recv_ts_and_drops(msg
, sk
, skb
);
353 if (flags
& MSG_TRUNC
)
356 skb_free_datagram(sk
, skb
);
363 static int raw_rcv_skb(struct sock
*sk
, struct sk_buff
*skb
)
365 skb
= skb_share_check(skb
, GFP_ATOMIC
);
369 if (sock_queue_rcv_skb(sk
, skb
) < 0) {
374 return NET_RX_SUCCESS
;
377 static void ieee802154_raw_deliver(struct net_device
*dev
, struct sk_buff
*skb
)
381 read_lock(&raw_lock
);
382 sk_for_each(sk
, &raw_head
) {
384 if (!sk
->sk_bound_dev_if
||
385 sk
->sk_bound_dev_if
== dev
->ifindex
) {
386 struct sk_buff
*clone
;
388 clone
= skb_clone(skb
, GFP_ATOMIC
);
390 raw_rcv_skb(sk
, clone
);
394 read_unlock(&raw_lock
);
397 static int raw_getsockopt(struct sock
*sk
, int level
, int optname
,
398 char __user
*optval
, int __user
*optlen
)
403 static int raw_setsockopt(struct sock
*sk
, int level
, int optname
,
404 char __user
*optval
, unsigned int optlen
)
409 static struct proto ieee802154_raw_prot
= {
410 .name
= "IEEE-802.15.4-RAW",
411 .owner
= THIS_MODULE
,
412 .obj_size
= sizeof(struct sock
),
415 .sendmsg
= raw_sendmsg
,
416 .recvmsg
= raw_recvmsg
,
418 .unhash
= raw_unhash
,
419 .connect
= raw_connect
,
420 .disconnect
= raw_disconnect
,
421 .getsockopt
= raw_getsockopt
,
422 .setsockopt
= raw_setsockopt
,
425 static const struct proto_ops ieee802154_raw_ops
= {
426 .family
= PF_IEEE802154
,
427 .owner
= THIS_MODULE
,
428 .release
= ieee802154_sock_release
,
429 .bind
= ieee802154_sock_bind
,
430 .connect
= ieee802154_sock_connect
,
431 .socketpair
= sock_no_socketpair
,
432 .accept
= sock_no_accept
,
433 .getname
= sock_no_getname
,
434 .poll
= datagram_poll
,
435 .ioctl
= ieee802154_sock_ioctl
,
436 .listen
= sock_no_listen
,
437 .shutdown
= sock_no_shutdown
,
438 .setsockopt
= sock_common_setsockopt
,
439 .getsockopt
= sock_common_getsockopt
,
440 .sendmsg
= ieee802154_sock_sendmsg
,
441 .recvmsg
= sock_common_recvmsg
,
442 .mmap
= sock_no_mmap
,
443 .sendpage
= sock_no_sendpage
,
445 .compat_setsockopt
= compat_sock_common_setsockopt
,
446 .compat_getsockopt
= compat_sock_common_getsockopt
,
450 /* DGRAM Sockets (802.15.4 dataframes) */
451 static HLIST_HEAD(dgram_head
);
452 static DEFINE_RWLOCK(dgram_lock
);
457 struct ieee802154_addr src_addr
;
458 struct ieee802154_addr dst_addr
;
460 unsigned int bound
:1;
461 unsigned int connected
:1;
462 unsigned int want_ack
:1;
463 unsigned int secen
:1;
464 unsigned int secen_override
:1;
465 unsigned int seclevel
:3;
466 unsigned int seclevel_override
:1;
469 static inline struct dgram_sock
*dgram_sk(const struct sock
*sk
)
471 return container_of(sk
, struct dgram_sock
, sk
);
474 static void dgram_hash(struct sock
*sk
)
476 write_lock_bh(&dgram_lock
);
477 sk_add_node(sk
, &dgram_head
);
478 sock_prot_inuse_add(sock_net(sk
), sk
->sk_prot
, 1);
479 write_unlock_bh(&dgram_lock
);
482 static void dgram_unhash(struct sock
*sk
)
484 write_lock_bh(&dgram_lock
);
485 if (sk_del_node_init(sk
))
486 sock_prot_inuse_add(sock_net(sk
), sk
->sk_prot
, -1);
487 write_unlock_bh(&dgram_lock
);
490 static int dgram_init(struct sock
*sk
)
492 struct dgram_sock
*ro
= dgram_sk(sk
);
498 static void dgram_close(struct sock
*sk
, long timeout
)
500 sk_common_release(sk
);
503 static int dgram_bind(struct sock
*sk
, struct sockaddr
*uaddr
, int len
)
505 struct sockaddr_ieee802154
*addr
= (struct sockaddr_ieee802154
*)uaddr
;
506 struct ieee802154_addr haddr
;
507 struct dgram_sock
*ro
= dgram_sk(sk
);
509 struct net_device
*dev
;
515 if (len
< sizeof(*addr
))
518 if (addr
->family
!= AF_IEEE802154
)
521 ieee802154_addr_from_sa(&haddr
, &addr
->addr
);
522 dev
= ieee802154_get_dev(sock_net(sk
), &haddr
);
528 if (dev
->type
!= ARPHRD_IEEE802154
) {
533 ro
->src_addr
= haddr
;
545 static int dgram_ioctl(struct sock
*sk
, int cmd
, unsigned long arg
)
550 int amount
= sk_wmem_alloc_get(sk
);
552 return put_user(amount
, (int __user
*)arg
);
558 unsigned long amount
;
561 spin_lock_bh(&sk
->sk_receive_queue
.lock
);
562 skb
= skb_peek(&sk
->sk_receive_queue
);
564 /* We will only return the amount
565 * of this packet since that is all
568 amount
= skb
->len
- ieee802154_hdr_length(skb
);
570 spin_unlock_bh(&sk
->sk_receive_queue
.lock
);
571 return put_user(amount
, (int __user
*)arg
);
578 /* FIXME: autobind */
579 static int dgram_connect(struct sock
*sk
, struct sockaddr
*uaddr
,
582 struct sockaddr_ieee802154
*addr
= (struct sockaddr_ieee802154
*)uaddr
;
583 struct dgram_sock
*ro
= dgram_sk(sk
);
586 if (len
< sizeof(*addr
))
589 if (addr
->family
!= AF_IEEE802154
)
599 ieee802154_addr_from_sa(&ro
->dst_addr
, &addr
->addr
);
607 static int dgram_disconnect(struct sock
*sk
, int flags
)
609 struct dgram_sock
*ro
= dgram_sk(sk
);
618 static int dgram_sendmsg(struct kiocb
*iocb
, struct sock
*sk
,
619 struct msghdr
*msg
, size_t size
)
621 struct net_device
*dev
;
624 struct ieee802154_mac_cb
*cb
;
625 struct dgram_sock
*ro
= dgram_sk(sk
);
626 struct ieee802154_addr dst_addr
;
630 if (msg
->msg_flags
& MSG_OOB
) {
631 pr_debug("msg->msg_flags = 0x%x\n", msg
->msg_flags
);
635 if (!ro
->connected
&& !msg
->msg_name
)
636 return -EDESTADDRREQ
;
637 else if (ro
->connected
&& msg
->msg_name
)
641 dev
= dev_getfirstbyhwtype(sock_net(sk
), ARPHRD_IEEE802154
);
643 dev
= ieee802154_get_dev(sock_net(sk
), &ro
->src_addr
);
646 pr_debug("no dev\n");
651 pr_debug("name = %s, mtu = %u\n", dev
->name
, mtu
);
654 pr_debug("size = %Zu, mtu = %u\n", size
, mtu
);
659 hlen
= LL_RESERVED_SPACE(dev
);
660 tlen
= dev
->needed_tailroom
;
661 skb
= sock_alloc_send_skb(sk
, hlen
+ tlen
+ size
,
662 msg
->msg_flags
& MSG_DONTWAIT
,
667 skb_reserve(skb
, hlen
);
669 skb_reset_network_header(skb
);
671 cb
= mac_cb_init(skb
);
672 cb
->type
= IEEE802154_FC_TYPE_DATA
;
673 cb
->ackreq
= ro
->want_ack
;
676 DECLARE_SOCKADDR(struct sockaddr_ieee802154
*,
677 daddr
, msg
->msg_name
);
679 ieee802154_addr_from_sa(&dst_addr
, &daddr
->addr
);
681 dst_addr
= ro
->dst_addr
;
684 cb
->secen
= ro
->secen
;
685 cb
->secen_override
= ro
->secen_override
;
686 cb
->seclevel
= ro
->seclevel
;
687 cb
->seclevel_override
= ro
->seclevel_override
;
689 err
= dev_hard_header(skb
, dev
, ETH_P_IEEE802154
, &dst_addr
,
690 ro
->bound
? &ro
->src_addr
: NULL
, size
);
694 err
= memcpy_from_msg(skb_put(skb
, size
), msg
, size
);
700 skb
->protocol
= htons(ETH_P_IEEE802154
);
704 err
= dev_queue_xmit(skb
);
706 err
= net_xmit_errno(err
);
718 static int dgram_recvmsg(struct kiocb
*iocb
, struct sock
*sk
,
719 struct msghdr
*msg
, size_t len
, int noblock
,
720 int flags
, int *addr_len
)
723 int err
= -EOPNOTSUPP
;
725 DECLARE_SOCKADDR(struct sockaddr_ieee802154
*, saddr
, msg
->msg_name
);
727 skb
= skb_recv_datagram(sk
, flags
, noblock
, &err
);
733 msg
->msg_flags
|= MSG_TRUNC
;
737 /* FIXME: skip headers if necessary ?! */
738 err
= skb_copy_datagram_msg(skb
, 0, msg
, copied
);
742 sock_recv_ts_and_drops(msg
, sk
, skb
);
745 saddr
->family
= AF_IEEE802154
;
746 ieee802154_addr_to_sa(&saddr
->addr
, &mac_cb(skb
)->source
);
747 *addr_len
= sizeof(*saddr
);
750 if (flags
& MSG_TRUNC
)
753 skb_free_datagram(sk
, skb
);
760 static int dgram_rcv_skb(struct sock
*sk
, struct sk_buff
*skb
)
762 skb
= skb_share_check(skb
, GFP_ATOMIC
);
766 if (sock_queue_rcv_skb(sk
, skb
) < 0) {
771 return NET_RX_SUCCESS
;
775 ieee802154_match_sock(__le64 hw_addr
, __le16 pan_id
, __le16 short_addr
,
776 struct dgram_sock
*ro
)
781 if (ro
->src_addr
.mode
== IEEE802154_ADDR_LONG
&&
782 hw_addr
== ro
->src_addr
.extended_addr
)
785 if (ro
->src_addr
.mode
== IEEE802154_ADDR_SHORT
&&
786 pan_id
== ro
->src_addr
.pan_id
&&
787 short_addr
== ro
->src_addr
.short_addr
)
793 static int ieee802154_dgram_deliver(struct net_device
*dev
, struct sk_buff
*skb
)
795 struct sock
*sk
, *prev
= NULL
;
796 int ret
= NET_RX_SUCCESS
;
797 __le16 pan_id
, short_addr
;
800 /* Data frame processing */
801 BUG_ON(dev
->type
!= ARPHRD_IEEE802154
);
803 pan_id
= ieee802154_mlme_ops(dev
)->get_pan_id(dev
);
804 short_addr
= ieee802154_mlme_ops(dev
)->get_short_addr(dev
);
805 hw_addr
= ieee802154_devaddr_from_raw(dev
->dev_addr
);
807 read_lock(&dgram_lock
);
808 sk_for_each(sk
, &dgram_head
) {
809 if (ieee802154_match_sock(hw_addr
, pan_id
, short_addr
,
812 struct sk_buff
*clone
;
814 clone
= skb_clone(skb
, GFP_ATOMIC
);
816 dgram_rcv_skb(prev
, clone
);
824 dgram_rcv_skb(prev
, skb
);
829 read_unlock(&dgram_lock
);
834 static int dgram_getsockopt(struct sock
*sk
, int level
, int optname
,
835 char __user
*optval
, int __user
*optlen
)
837 struct dgram_sock
*ro
= dgram_sk(sk
);
841 if (level
!= SOL_IEEE802154
)
844 if (get_user(len
, optlen
))
847 len
= min_t(unsigned int, len
, sizeof(int));
854 if (!ro
->secen_override
)
855 val
= WPAN_SECURITY_DEFAULT
;
857 val
= WPAN_SECURITY_ON
;
859 val
= WPAN_SECURITY_OFF
;
861 case WPAN_SECURITY_LEVEL
:
862 if (!ro
->seclevel_override
)
863 val
= WPAN_SECURITY_LEVEL_DEFAULT
;
871 if (put_user(len
, optlen
))
873 if (copy_to_user(optval
, &val
, len
))
878 static int dgram_setsockopt(struct sock
*sk
, int level
, int optname
,
879 char __user
*optval
, unsigned int optlen
)
881 struct dgram_sock
*ro
= dgram_sk(sk
);
882 struct net
*net
= sock_net(sk
);
886 if (optlen
< sizeof(int))
889 if (get_user(val
, (int __user
*)optval
))
896 ro
->want_ack
= !!val
;
899 if (!ns_capable(net
->user_ns
, CAP_NET_ADMIN
) &&
900 !ns_capable(net
->user_ns
, CAP_NET_RAW
)) {
906 case WPAN_SECURITY_DEFAULT
:
907 ro
->secen_override
= 0;
909 case WPAN_SECURITY_ON
:
910 ro
->secen_override
= 1;
913 case WPAN_SECURITY_OFF
:
914 ro
->secen_override
= 1;
922 case WPAN_SECURITY_LEVEL
:
923 if (!ns_capable(net
->user_ns
, CAP_NET_ADMIN
) &&
924 !ns_capable(net
->user_ns
, CAP_NET_RAW
)) {
929 if (val
< WPAN_SECURITY_LEVEL_DEFAULT
||
930 val
> IEEE802154_SCF_SECLEVEL_ENC_MIC128
) {
932 } else if (val
== WPAN_SECURITY_LEVEL_DEFAULT
) {
933 ro
->seclevel_override
= 0;
935 ro
->seclevel_override
= 1;
948 static struct proto ieee802154_dgram_prot
= {
949 .name
= "IEEE-802.15.4-MAC",
950 .owner
= THIS_MODULE
,
951 .obj_size
= sizeof(struct dgram_sock
),
953 .close
= dgram_close
,
955 .sendmsg
= dgram_sendmsg
,
956 .recvmsg
= dgram_recvmsg
,
958 .unhash
= dgram_unhash
,
959 .connect
= dgram_connect
,
960 .disconnect
= dgram_disconnect
,
961 .ioctl
= dgram_ioctl
,
962 .getsockopt
= dgram_getsockopt
,
963 .setsockopt
= dgram_setsockopt
,
966 static const struct proto_ops ieee802154_dgram_ops
= {
967 .family
= PF_IEEE802154
,
968 .owner
= THIS_MODULE
,
969 .release
= ieee802154_sock_release
,
970 .bind
= ieee802154_sock_bind
,
971 .connect
= ieee802154_sock_connect
,
972 .socketpair
= sock_no_socketpair
,
973 .accept
= sock_no_accept
,
974 .getname
= sock_no_getname
,
975 .poll
= datagram_poll
,
976 .ioctl
= ieee802154_sock_ioctl
,
977 .listen
= sock_no_listen
,
978 .shutdown
= sock_no_shutdown
,
979 .setsockopt
= sock_common_setsockopt
,
980 .getsockopt
= sock_common_getsockopt
,
981 .sendmsg
= ieee802154_sock_sendmsg
,
982 .recvmsg
= sock_common_recvmsg
,
983 .mmap
= sock_no_mmap
,
984 .sendpage
= sock_no_sendpage
,
986 .compat_setsockopt
= compat_sock_common_setsockopt
,
987 .compat_getsockopt
= compat_sock_common_getsockopt
,
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
) {
1007 proto
= &ieee802154_raw_prot
;
1008 ops
= &ieee802154_raw_ops
;
1011 proto
= &ieee802154_dgram_prot
;
1012 ops
= &ieee802154_dgram_ops
;
1015 rc
= -ESOCKTNOSUPPORT
;
1020 sk
= sk_alloc(net
, PF_IEEE802154
, GFP_KERNEL
, proto
);
1027 sock_init_data(sock
, sk
);
1028 /* FIXME: sk->sk_destruct */
1029 sk
->sk_family
= PF_IEEE802154
;
1031 /* Checksums on by default */
1032 sock_set_flag(sk
, SOCK_ZAPPED
);
1034 if (sk
->sk_prot
->hash
)
1035 sk
->sk_prot
->hash(sk
);
1037 if (sk
->sk_prot
->init
) {
1038 rc
= sk
->sk_prot
->init(sk
);
1040 sk_common_release(sk
);
1046 static const struct net_proto_family ieee802154_family_ops
= {
1047 .family
= PF_IEEE802154
,
1048 .create
= ieee802154_create
,
1049 .owner
= THIS_MODULE
,
1052 static int ieee802154_rcv(struct sk_buff
*skb
, struct net_device
*dev
,
1053 struct packet_type
*pt
, struct net_device
*orig_dev
)
1055 if (!netif_running(dev
))
1057 pr_debug("got frame, type %d, dev %p\n", dev
->type
, dev
);
1059 print_hex_dump_bytes("ieee802154_rcv ",
1060 DUMP_PREFIX_NONE
, skb
->data
, skb
->len
);
1063 if (!net_eq(dev_net(dev
), &init_net
))
1066 ieee802154_raw_deliver(dev
, skb
);
1068 if (dev
->type
!= ARPHRD_IEEE802154
)
1071 if (skb
->pkt_type
!= PACKET_OTHERHOST
)
1072 return ieee802154_dgram_deliver(dev
, skb
);
1079 static struct packet_type ieee802154_packet_type
= {
1080 .type
= htons(ETH_P_IEEE802154
),
1081 .func
= ieee802154_rcv
,
1084 static int __init
af_ieee802154_init(void)
1088 rc
= proto_register(&ieee802154_raw_prot
, 1);
1092 rc
= proto_register(&ieee802154_dgram_prot
, 1);
1096 /* Tell SOCKET that we are alive */
1097 rc
= sock_register(&ieee802154_family_ops
);
1100 dev_add_pack(&ieee802154_packet_type
);
1106 proto_unregister(&ieee802154_dgram_prot
);
1108 proto_unregister(&ieee802154_raw_prot
);
1113 static void __exit
af_ieee802154_remove(void)
1115 dev_remove_pack(&ieee802154_packet_type
);
1116 sock_unregister(PF_IEEE802154
);
1117 proto_unregister(&ieee802154_dgram_prot
);
1118 proto_unregister(&ieee802154_raw_prot
);
1121 module_init(af_ieee802154_init
);
1122 module_exit(af_ieee802154_remove
);
1124 MODULE_LICENSE("GPL");
1125 MODULE_ALIAS_NETPROTO(PF_IEEE802154
);