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>
39 /* Utility function for families */
41 ieee802154_get_dev(struct net
*net
, const struct ieee802154_addr
*addr
)
43 struct net_device
*dev
= NULL
;
44 struct net_device
*tmp
;
45 __le16 pan_id
, short_addr
;
46 u8 hwaddr
[IEEE802154_ADDR_LEN
];
49 case IEEE802154_ADDR_LONG
:
50 ieee802154_devaddr_to_raw(hwaddr
, addr
->extended_addr
);
52 dev
= dev_getbyhwaddr_rcu(net
, ARPHRD_IEEE802154
, hwaddr
);
57 case IEEE802154_ADDR_SHORT
:
58 if (addr
->pan_id
== cpu_to_le16(IEEE802154_PANID_BROADCAST
) ||
59 addr
->short_addr
== cpu_to_le16(IEEE802154_ADDR_UNDEF
) ||
60 addr
->short_addr
== cpu_to_le16(IEEE802154_ADDR_BROADCAST
))
65 for_each_netdev(net
, tmp
) {
66 if (tmp
->type
!= ARPHRD_IEEE802154
)
69 pan_id
= ieee802154_mlme_ops(tmp
)->get_pan_id(tmp
);
71 ieee802154_mlme_ops(tmp
)->get_short_addr(tmp
);
73 if (pan_id
== addr
->pan_id
&&
74 short_addr
== addr
->short_addr
) {
84 pr_warn("Unsupported ieee802154 address type: %d\n",
92 static int ieee802154_sock_release(struct socket
*sock
)
94 struct sock
*sk
= sock
->sk
;
98 sk
->sk_prot
->close(sk
, 0);
103 static int ieee802154_sock_sendmsg(struct kiocb
*iocb
, struct socket
*sock
,
104 struct msghdr
*msg
, size_t len
)
106 struct sock
*sk
= sock
->sk
;
108 return sk
->sk_prot
->sendmsg(iocb
, sk
, msg
, len
);
111 static int ieee802154_sock_bind(struct socket
*sock
, struct sockaddr
*uaddr
,
114 struct sock
*sk
= sock
->sk
;
116 if (sk
->sk_prot
->bind
)
117 return sk
->sk_prot
->bind(sk
, uaddr
, addr_len
);
119 return sock_no_bind(sock
, uaddr
, addr_len
);
122 static int ieee802154_sock_connect(struct socket
*sock
, struct sockaddr
*uaddr
,
123 int addr_len
, int flags
)
125 struct sock
*sk
= sock
->sk
;
127 if (addr_len
< sizeof(uaddr
->sa_family
))
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
);
154 if (dev
->type
== ARPHRD_IEEE802154
&& dev
->netdev_ops
->ndo_do_ioctl
)
155 ret
= dev
->netdev_ops
->ndo_do_ioctl(dev
, &ifr
, cmd
);
157 if (!ret
&& copy_to_user(arg
, &ifr
, sizeof(struct ifreq
)))
164 static int ieee802154_sock_ioctl(struct socket
*sock
, unsigned int cmd
,
167 struct sock
*sk
= sock
->sk
;
171 return sock_get_timestamp(sk
, (struct timeval __user
*)arg
);
173 return sock_get_timestampns(sk
, (struct timespec __user
*)arg
);
176 return ieee802154_dev_ioctl(sk
, (struct ifreq __user
*)arg
,
179 if (!sk
->sk_prot
->ioctl
)
181 return sk
->sk_prot
->ioctl(sk
, cmd
, arg
);
185 static const struct proto_ops ieee802154_raw_ops
= {
186 .family
= PF_IEEE802154
,
187 .owner
= THIS_MODULE
,
188 .release
= ieee802154_sock_release
,
189 .bind
= ieee802154_sock_bind
,
190 .connect
= ieee802154_sock_connect
,
191 .socketpair
= sock_no_socketpair
,
192 .accept
= sock_no_accept
,
193 .getname
= sock_no_getname
,
194 .poll
= datagram_poll
,
195 .ioctl
= ieee802154_sock_ioctl
,
196 .listen
= sock_no_listen
,
197 .shutdown
= sock_no_shutdown
,
198 .setsockopt
= sock_common_setsockopt
,
199 .getsockopt
= sock_common_getsockopt
,
200 .sendmsg
= ieee802154_sock_sendmsg
,
201 .recvmsg
= sock_common_recvmsg
,
202 .mmap
= sock_no_mmap
,
203 .sendpage
= sock_no_sendpage
,
205 .compat_setsockopt
= compat_sock_common_setsockopt
,
206 .compat_getsockopt
= compat_sock_common_getsockopt
,
210 static const struct proto_ops ieee802154_dgram_ops
= {
211 .family
= PF_IEEE802154
,
212 .owner
= THIS_MODULE
,
213 .release
= ieee802154_sock_release
,
214 .bind
= ieee802154_sock_bind
,
215 .connect
= ieee802154_sock_connect
,
216 .socketpair
= sock_no_socketpair
,
217 .accept
= sock_no_accept
,
218 .getname
= sock_no_getname
,
219 .poll
= datagram_poll
,
220 .ioctl
= ieee802154_sock_ioctl
,
221 .listen
= sock_no_listen
,
222 .shutdown
= sock_no_shutdown
,
223 .setsockopt
= sock_common_setsockopt
,
224 .getsockopt
= sock_common_getsockopt
,
225 .sendmsg
= ieee802154_sock_sendmsg
,
226 .recvmsg
= sock_common_recvmsg
,
227 .mmap
= sock_no_mmap
,
228 .sendpage
= sock_no_sendpage
,
230 .compat_setsockopt
= compat_sock_common_setsockopt
,
231 .compat_getsockopt
= compat_sock_common_getsockopt
,
235 /* Create a socket. Initialise the socket, blank the addresses
238 static int ieee802154_create(struct net
*net
, struct socket
*sock
,
239 int protocol
, int kern
)
244 const struct proto_ops
*ops
;
246 if (!net_eq(net
, &init_net
))
247 return -EAFNOSUPPORT
;
249 switch (sock
->type
) {
251 proto
= &ieee802154_raw_prot
;
252 ops
= &ieee802154_raw_ops
;
255 proto
= &ieee802154_dgram_prot
;
256 ops
= &ieee802154_dgram_ops
;
259 rc
= -ESOCKTNOSUPPORT
;
264 sk
= sk_alloc(net
, PF_IEEE802154
, GFP_KERNEL
, proto
);
271 sock_init_data(sock
, sk
);
272 /* FIXME: sk->sk_destruct */
273 sk
->sk_family
= PF_IEEE802154
;
275 /* Checksums on by default */
276 sock_set_flag(sk
, SOCK_ZAPPED
);
278 if (sk
->sk_prot
->hash
)
279 sk
->sk_prot
->hash(sk
);
281 if (sk
->sk_prot
->init
) {
282 rc
= sk
->sk_prot
->init(sk
);
284 sk_common_release(sk
);
290 static const struct net_proto_family ieee802154_family_ops
= {
291 .family
= PF_IEEE802154
,
292 .create
= ieee802154_create
,
293 .owner
= THIS_MODULE
,
296 static int ieee802154_rcv(struct sk_buff
*skb
, struct net_device
*dev
,
297 struct packet_type
*pt
, struct net_device
*orig_dev
)
299 if (!netif_running(dev
))
301 pr_debug("got frame, type %d, dev %p\n", dev
->type
, dev
);
303 print_hex_dump_bytes("ieee802154_rcv ",
304 DUMP_PREFIX_NONE
, skb
->data
, skb
->len
);
307 if (!net_eq(dev_net(dev
), &init_net
))
310 ieee802154_raw_deliver(dev
, skb
);
312 if (dev
->type
!= ARPHRD_IEEE802154
)
315 if (skb
->pkt_type
!= PACKET_OTHERHOST
)
316 return ieee802154_dgram_deliver(dev
, skb
);
323 static struct packet_type ieee802154_packet_type
= {
324 .type
= htons(ETH_P_IEEE802154
),
325 .func
= ieee802154_rcv
,
328 static int __init
af_ieee802154_init(void)
332 rc
= proto_register(&ieee802154_raw_prot
, 1);
336 rc
= proto_register(&ieee802154_dgram_prot
, 1);
340 /* Tell SOCKET that we are alive */
341 rc
= sock_register(&ieee802154_family_ops
);
344 dev_add_pack(&ieee802154_packet_type
);
350 proto_unregister(&ieee802154_dgram_prot
);
352 proto_unregister(&ieee802154_raw_prot
);
357 static void __exit
af_ieee802154_remove(void)
359 dev_remove_pack(&ieee802154_packet_type
);
360 sock_unregister(PF_IEEE802154
);
361 proto_unregister(&ieee802154_dgram_prot
);
362 proto_unregister(&ieee802154_raw_prot
);
365 module_init(af_ieee802154_init
);
366 module_exit(af_ieee802154_remove
);
368 MODULE_LICENSE("GPL");
369 MODULE_ALIAS_NETPROTO(PF_IEEE802154
);