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.
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 * Maxim Gorbachyov <maxim.gorbachev@siemens.com>
24 #include <linux/net.h>
25 #include <linux/capability.h>
26 #include <linux/module.h>
27 #include <linux/if_arp.h>
29 #include <linux/termios.h> /* For TIOCOUTQ/INQ */
30 #include <linux/list.h>
31 #include <linux/slab.h>
32 #include <net/datalink.h>
33 #include <net/psnap.h>
35 #include <net/tcp_states.h>
36 #include <net/route.h>
38 #include <net/af_ieee802154.h>
39 #include <net/ieee802154_netdev.h>
44 * Utility function for families
46 struct net_device
*ieee802154_get_dev(struct net
*net
,
47 struct ieee802154_addr
*addr
)
49 struct net_device
*dev
= NULL
;
50 struct net_device
*tmp
;
51 u16 pan_id
, short_addr
;
53 switch (addr
->addr_type
) {
54 case IEEE802154_ADDR_LONG
:
56 dev
= dev_getbyhwaddr(net
, ARPHRD_IEEE802154
, addr
->hwaddr
);
61 case IEEE802154_ADDR_SHORT
:
62 if (addr
->pan_id
== 0xffff ||
63 addr
->short_addr
== IEEE802154_ADDR_UNDEF
||
64 addr
->short_addr
== 0xffff)
69 for_each_netdev(net
, tmp
) {
70 if (tmp
->type
!= ARPHRD_IEEE802154
)
73 pan_id
= ieee802154_mlme_ops(tmp
)->get_pan_id(tmp
);
75 ieee802154_mlme_ops(tmp
)->get_short_addr(tmp
);
77 if (pan_id
== addr
->pan_id
&&
78 short_addr
== addr
->short_addr
) {
88 pr_warning("Unsupported ieee802154 address type: %d\n",
96 static int ieee802154_sock_release(struct socket
*sock
)
98 struct sock
*sk
= sock
->sk
;
102 sk
->sk_prot
->close(sk
, 0);
106 static int ieee802154_sock_sendmsg(struct kiocb
*iocb
, struct socket
*sock
,
107 struct msghdr
*msg
, size_t len
)
109 struct sock
*sk
= sock
->sk
;
111 return sk
->sk_prot
->sendmsg(iocb
, sk
, msg
, len
);
114 static int ieee802154_sock_bind(struct socket
*sock
, struct sockaddr
*uaddr
,
117 struct sock
*sk
= sock
->sk
;
119 if (sk
->sk_prot
->bind
)
120 return sk
->sk_prot
->bind(sk
, uaddr
, addr_len
);
122 return sock_no_bind(sock
, uaddr
, addr_len
);
125 static int ieee802154_sock_connect(struct socket
*sock
, struct sockaddr
*uaddr
,
126 int addr_len
, int flags
)
128 struct sock
*sk
= sock
->sk
;
130 if (uaddr
->sa_family
== AF_UNSPEC
)
131 return sk
->sk_prot
->disconnect(sk
, flags
);
133 return sk
->sk_prot
->connect(sk
, uaddr
, addr_len
);
136 static int ieee802154_dev_ioctl(struct sock
*sk
, struct ifreq __user
*arg
,
140 int ret
= -ENOIOCTLCMD
;
141 struct net_device
*dev
;
143 if (copy_from_user(&ifr
, arg
, sizeof(struct ifreq
)))
146 ifr
.ifr_name
[IFNAMSIZ
-1] = 0;
148 dev_load(sock_net(sk
), ifr
.ifr_name
);
149 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
;
168 return sock_get_timestamp(sk
, (struct timeval __user
*)arg
);
170 return sock_get_timestampns(sk
, (struct timespec __user
*)arg
);
173 return ieee802154_dev_ioctl(sk
, (struct ifreq __user
*)arg
,
176 if (!sk
->sk_prot
->ioctl
)
178 return sk
->sk_prot
->ioctl(sk
, cmd
, arg
);
182 static const struct proto_ops ieee802154_raw_ops
= {
183 .family
= PF_IEEE802154
,
184 .owner
= THIS_MODULE
,
185 .release
= ieee802154_sock_release
,
186 .bind
= ieee802154_sock_bind
,
187 .connect
= ieee802154_sock_connect
,
188 .socketpair
= sock_no_socketpair
,
189 .accept
= sock_no_accept
,
190 .getname
= sock_no_getname
,
191 .poll
= datagram_poll
,
192 .ioctl
= ieee802154_sock_ioctl
,
193 .listen
= sock_no_listen
,
194 .shutdown
= sock_no_shutdown
,
195 .setsockopt
= sock_common_setsockopt
,
196 .getsockopt
= sock_common_getsockopt
,
197 .sendmsg
= ieee802154_sock_sendmsg
,
198 .recvmsg
= sock_common_recvmsg
,
199 .mmap
= sock_no_mmap
,
200 .sendpage
= sock_no_sendpage
,
202 .compat_setsockopt
= compat_sock_common_setsockopt
,
203 .compat_getsockopt
= compat_sock_common_getsockopt
,
207 static const struct proto_ops ieee802154_dgram_ops
= {
208 .family
= PF_IEEE802154
,
209 .owner
= THIS_MODULE
,
210 .release
= ieee802154_sock_release
,
211 .bind
= ieee802154_sock_bind
,
212 .connect
= ieee802154_sock_connect
,
213 .socketpair
= sock_no_socketpair
,
214 .accept
= sock_no_accept
,
215 .getname
= sock_no_getname
,
216 .poll
= datagram_poll
,
217 .ioctl
= ieee802154_sock_ioctl
,
218 .listen
= sock_no_listen
,
219 .shutdown
= sock_no_shutdown
,
220 .setsockopt
= sock_common_setsockopt
,
221 .getsockopt
= sock_common_getsockopt
,
222 .sendmsg
= ieee802154_sock_sendmsg
,
223 .recvmsg
= sock_common_recvmsg
,
224 .mmap
= sock_no_mmap
,
225 .sendpage
= sock_no_sendpage
,
227 .compat_setsockopt
= compat_sock_common_setsockopt
,
228 .compat_getsockopt
= compat_sock_common_getsockopt
,
234 * Create a socket. Initialise the socket, blank the addresses
237 static int ieee802154_create(struct net
*net
, struct socket
*sock
,
238 int protocol
, int kern
)
243 const struct proto_ops
*ops
;
245 if (!net_eq(net
, &init_net
))
246 return -EAFNOSUPPORT
;
248 switch (sock
->type
) {
250 proto
= &ieee802154_raw_prot
;
251 ops
= &ieee802154_raw_ops
;
254 proto
= &ieee802154_dgram_prot
;
255 ops
= &ieee802154_dgram_ops
;
258 rc
= -ESOCKTNOSUPPORT
;
263 sk
= sk_alloc(net
, PF_IEEE802154
, GFP_KERNEL
, proto
);
270 sock_init_data(sock
, sk
);
271 /* FIXME: sk->sk_destruct */
272 sk
->sk_family
= PF_IEEE802154
;
274 /* Checksums on by default */
275 sock_set_flag(sk
, SOCK_ZAPPED
);
277 if (sk
->sk_prot
->hash
)
278 sk
->sk_prot
->hash(sk
);
280 if (sk
->sk_prot
->init
) {
281 rc
= sk
->sk_prot
->init(sk
);
283 sk_common_release(sk
);
289 static const struct net_proto_family ieee802154_family_ops
= {
290 .family
= PF_IEEE802154
,
291 .create
= ieee802154_create
,
292 .owner
= THIS_MODULE
,
295 static int ieee802154_rcv(struct sk_buff
*skb
, struct net_device
*dev
,
296 struct packet_type
*pt
, struct net_device
*orig_dev
)
298 if (!netif_running(dev
))
300 pr_debug("got frame, type %d, dev %p\n", dev
->type
, dev
);
302 print_hex_dump_bytes("ieee802154_rcv ", DUMP_PREFIX_NONE
, skb
->data
, skb
->len
);
305 if (!net_eq(dev_net(dev
), &init_net
))
308 ieee802154_raw_deliver(dev
, skb
);
310 if (dev
->type
!= ARPHRD_IEEE802154
)
313 if (skb
->pkt_type
!= PACKET_OTHERHOST
)
314 return ieee802154_dgram_deliver(dev
, skb
);
322 static struct packet_type ieee802154_packet_type
= {
323 .type
= __constant_htons(ETH_P_IEEE802154
),
324 .func
= ieee802154_rcv
,
327 static int __init
af_ieee802154_init(void)
331 rc
= proto_register(&ieee802154_raw_prot
, 1);
335 rc
= proto_register(&ieee802154_dgram_prot
, 1);
339 /* Tell SOCKET that we are alive */
340 rc
= sock_register(&ieee802154_family_ops
);
343 dev_add_pack(&ieee802154_packet_type
);
349 proto_unregister(&ieee802154_dgram_prot
);
351 proto_unregister(&ieee802154_raw_prot
);
355 static void __exit
af_ieee802154_remove(void)
357 dev_remove_pack(&ieee802154_packet_type
);
358 sock_unregister(PF_IEEE802154
);
359 proto_unregister(&ieee802154_dgram_prot
);
360 proto_unregister(&ieee802154_raw_prot
);
363 module_init(af_ieee802154_init
);
364 module_exit(af_ieee802154_remove
);
366 MODULE_LICENSE("GPL");
367 MODULE_ALIAS_NETPROTO(PF_IEEE802154
);