2 * Copyright 2007-2012 Siemens AG
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License version 2
6 * as published by the Free Software Foundation.
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
13 * You should have received a copy of the GNU General Public License along
14 * with this program; if not, write to the Free Software Foundation, Inc.,
15 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
18 * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com>
19 * Sergey Lapin <slapin@ossfans.org>
20 * Maxim Gorbachyov <maxim.gorbachev@siemens.com>
21 * Alexander Smirnov <alex.bluesman.smirnov@gmail.com>
24 #include <linux/netdevice.h>
25 #include <linux/module.h>
26 #include <linux/if_arp.h>
28 #include <net/rtnetlink.h>
29 #include <linux/nl802154.h>
30 #include <net/af_ieee802154.h>
31 #include <net/mac802154.h>
32 #include <net/ieee802154_netdev.h>
33 #include <net/ieee802154.h>
34 #include <net/wpan-phy.h>
36 #include "mac802154.h"
38 static int mac802154_wpan_update_llsec(struct net_device
*dev
)
40 struct mac802154_sub_if_data
*priv
= netdev_priv(dev
);
41 struct ieee802154_mlme_ops
*ops
= ieee802154_mlme_ops(dev
);
45 struct ieee802154_llsec_params params
;
48 params
.pan_id
= priv
->pan_id
;
49 changed
|= IEEE802154_LLSEC_PARAM_PAN_ID
;
51 params
.hwaddr
= priv
->extended_addr
;
52 changed
|= IEEE802154_LLSEC_PARAM_HWADDR
;
54 rc
= ops
->llsec
->set_params(dev
, ¶ms
, changed
);
61 mac802154_wpan_ioctl(struct net_device
*dev
, struct ifreq
*ifr
, int cmd
)
63 struct mac802154_sub_if_data
*priv
= netdev_priv(dev
);
64 struct sockaddr_ieee802154
*sa
=
65 (struct sockaddr_ieee802154
*)&ifr
->ifr_addr
;
66 int err
= -ENOIOCTLCMD
;
68 spin_lock_bh(&priv
->mib_lock
);
73 u16 pan_id
, short_addr
;
75 pan_id
= le16_to_cpu(priv
->pan_id
);
76 short_addr
= le16_to_cpu(priv
->short_addr
);
77 if (pan_id
== IEEE802154_PANID_BROADCAST
||
78 short_addr
== IEEE802154_ADDR_BROADCAST
) {
83 sa
->family
= AF_IEEE802154
;
84 sa
->addr
.addr_type
= IEEE802154_ADDR_SHORT
;
85 sa
->addr
.pan_id
= pan_id
;
86 sa
->addr
.short_addr
= short_addr
;
93 "Using DEBUGing ioctl SIOCSIFADDR isn't recommened!\n");
94 if (sa
->family
!= AF_IEEE802154
||
95 sa
->addr
.addr_type
!= IEEE802154_ADDR_SHORT
||
96 sa
->addr
.pan_id
== IEEE802154_PANID_BROADCAST
||
97 sa
->addr
.short_addr
== IEEE802154_ADDR_BROADCAST
||
98 sa
->addr
.short_addr
== IEEE802154_ADDR_UNDEF
) {
103 priv
->pan_id
= cpu_to_le16(sa
->addr
.pan_id
);
104 priv
->short_addr
= cpu_to_le16(sa
->addr
.short_addr
);
106 err
= mac802154_wpan_update_llsec(dev
);
110 spin_unlock_bh(&priv
->mib_lock
);
114 static int mac802154_wpan_mac_addr(struct net_device
*dev
, void *p
)
116 struct sockaddr
*addr
= p
;
118 if (netif_running(dev
))
121 /* FIXME: validate addr */
122 memcpy(dev
->dev_addr
, addr
->sa_data
, dev
->addr_len
);
123 mac802154_dev_set_ieee_addr(dev
);
124 return mac802154_wpan_update_llsec(dev
);
127 int mac802154_set_mac_params(struct net_device
*dev
,
128 const struct ieee802154_mac_params
*params
)
130 struct mac802154_sub_if_data
*priv
= netdev_priv(dev
);
132 mutex_lock(&priv
->hw
->slaves_mtx
);
133 priv
->mac_params
= *params
;
134 mutex_unlock(&priv
->hw
->slaves_mtx
);
139 void mac802154_get_mac_params(struct net_device
*dev
,
140 struct ieee802154_mac_params
*params
)
142 struct mac802154_sub_if_data
*priv
= netdev_priv(dev
);
144 mutex_lock(&priv
->hw
->slaves_mtx
);
145 *params
= priv
->mac_params
;
146 mutex_unlock(&priv
->hw
->slaves_mtx
);
149 static int mac802154_wpan_open(struct net_device
*dev
)
152 struct mac802154_sub_if_data
*priv
= netdev_priv(dev
);
153 struct wpan_phy
*phy
= priv
->hw
->phy
;
155 rc
= mac802154_slave_open(dev
);
159 mutex_lock(&phy
->pib_lock
);
161 if (phy
->set_txpower
) {
162 rc
= phy
->set_txpower(phy
, priv
->mac_params
.transmit_power
);
168 rc
= phy
->set_lbt(phy
, priv
->mac_params
.lbt
);
173 if (phy
->set_cca_mode
) {
174 rc
= phy
->set_cca_mode(phy
, priv
->mac_params
.cca_mode
);
179 if (phy
->set_cca_ed_level
) {
180 rc
= phy
->set_cca_ed_level(phy
, priv
->mac_params
.cca_ed_level
);
185 if (phy
->set_csma_params
) {
186 rc
= phy
->set_csma_params(phy
, priv
->mac_params
.min_be
,
187 priv
->mac_params
.max_be
,
188 priv
->mac_params
.csma_retries
);
193 if (phy
->set_frame_retries
) {
194 rc
= phy
->set_frame_retries(phy
,
195 priv
->mac_params
.frame_retries
);
200 mutex_unlock(&phy
->pib_lock
);
204 mutex_unlock(&phy
->pib_lock
);
208 static int mac802154_set_header_security(struct mac802154_sub_if_data
*priv
,
209 struct ieee802154_hdr
*hdr
,
210 const struct ieee802154_mac_cb
*cb
)
212 struct ieee802154_llsec_params params
;
215 mac802154_llsec_get_params(&priv
->sec
, ¶ms
);
217 if (!params
.enabled
&& cb
->secen_override
&& cb
->secen
)
219 if (!params
.enabled
||
220 (cb
->secen_override
&& !cb
->secen
) ||
223 if (cb
->seclevel_override
&& !cb
->seclevel
)
226 level
= cb
->seclevel_override
? cb
->seclevel
: params
.out_level
;
228 hdr
->fc
.security_enabled
= 1;
229 hdr
->sec
.level
= level
;
230 hdr
->sec
.key_id_mode
= params
.out_key
.mode
;
231 if (params
.out_key
.mode
== IEEE802154_SCF_KEY_SHORT_INDEX
)
232 hdr
->sec
.short_src
= params
.out_key
.short_source
;
233 else if (params
.out_key
.mode
== IEEE802154_SCF_KEY_HW_INDEX
)
234 hdr
->sec
.extended_src
= params
.out_key
.extended_source
;
235 hdr
->sec
.key_id
= params
.out_key
.id
;
240 static int mac802154_header_create(struct sk_buff
*skb
,
241 struct net_device
*dev
,
247 struct ieee802154_hdr hdr
;
248 struct mac802154_sub_if_data
*priv
= netdev_priv(dev
);
249 struct ieee802154_mac_cb
*cb
= mac_cb(skb
);
255 memset(&hdr
.fc
, 0, sizeof(hdr
.fc
));
256 hdr
.fc
.type
= cb
->type
;
257 hdr
.fc
.security_enabled
= cb
->secen
;
258 hdr
.fc
.ack_request
= cb
->ackreq
;
259 hdr
.seq
= ieee802154_mlme_ops(dev
)->get_dsn(dev
);
261 if (mac802154_set_header_security(priv
, &hdr
, cb
) < 0)
265 spin_lock_bh(&priv
->mib_lock
);
267 if (priv
->short_addr
== cpu_to_le16(IEEE802154_ADDR_BROADCAST
) ||
268 priv
->short_addr
== cpu_to_le16(IEEE802154_ADDR_UNDEF
) ||
269 priv
->pan_id
== cpu_to_le16(IEEE802154_PANID_BROADCAST
)) {
270 hdr
.source
.mode
= IEEE802154_ADDR_LONG
;
271 hdr
.source
.extended_addr
= priv
->extended_addr
;
273 hdr
.source
.mode
= IEEE802154_ADDR_SHORT
;
274 hdr
.source
.short_addr
= priv
->short_addr
;
277 hdr
.source
.pan_id
= priv
->pan_id
;
279 spin_unlock_bh(&priv
->mib_lock
);
281 hdr
.source
= *(const struct ieee802154_addr
*)saddr
;
284 hdr
.dest
= *(const struct ieee802154_addr
*)daddr
;
286 hlen
= ieee802154_hdr_push(skb
, &hdr
);
290 skb_reset_mac_header(skb
);
293 if (len
> ieee802154_max_payload(&hdr
))
300 mac802154_header_parse(const struct sk_buff
*skb
, unsigned char *haddr
)
302 struct ieee802154_hdr hdr
;
303 struct ieee802154_addr
*addr
= (struct ieee802154_addr
*)haddr
;
305 if (ieee802154_hdr_peek_addrs(skb
, &hdr
) < 0) {
306 pr_debug("malformed packet\n");
311 return sizeof(*addr
);
315 mac802154_wpan_xmit(struct sk_buff
*skb
, struct net_device
*dev
)
317 struct mac802154_sub_if_data
*priv
;
321 priv
= netdev_priv(dev
);
323 spin_lock_bh(&priv
->mib_lock
);
326 spin_unlock_bh(&priv
->mib_lock
);
328 if (chan
== MAC802154_CHAN_NONE
||
329 page
>= WPAN_NUM_PAGES
||
330 chan
>= WPAN_NUM_CHANNELS
) {
335 rc
= mac802154_llsec_encrypt(&priv
->sec
, skb
);
337 pr_warn("encryption failed: %i\n", rc
);
342 skb
->skb_iif
= dev
->ifindex
;
343 dev
->stats
.tx_packets
++;
344 dev
->stats
.tx_bytes
+= skb
->len
;
346 return mac802154_tx(priv
->hw
, skb
, page
, chan
);
349 static struct header_ops mac802154_header_ops
= {
350 .create
= mac802154_header_create
,
351 .parse
= mac802154_header_parse
,
354 static const struct net_device_ops mac802154_wpan_ops
= {
355 .ndo_open
= mac802154_wpan_open
,
356 .ndo_stop
= mac802154_slave_close
,
357 .ndo_start_xmit
= mac802154_wpan_xmit
,
358 .ndo_do_ioctl
= mac802154_wpan_ioctl
,
359 .ndo_set_mac_address
= mac802154_wpan_mac_addr
,
362 static void mac802154_wpan_free(struct net_device
*dev
)
364 struct mac802154_sub_if_data
*priv
= netdev_priv(dev
);
366 mac802154_llsec_destroy(&priv
->sec
);
371 void mac802154_wpan_setup(struct net_device
*dev
)
373 struct mac802154_sub_if_data
*priv
;
375 dev
->addr_len
= IEEE802154_ADDR_LEN
;
376 memset(dev
->broadcast
, 0xff, IEEE802154_ADDR_LEN
);
378 dev
->hard_header_len
= MAC802154_FRAME_HARD_HEADER_LEN
;
379 dev
->header_ops
= &mac802154_header_ops
;
380 dev
->needed_tailroom
= 2 + 16; /* FCS + MIC */
381 dev
->mtu
= IEEE802154_MTU
;
382 dev
->tx_queue_len
= 300;
383 dev
->type
= ARPHRD_IEEE802154
;
384 dev
->flags
= IFF_NOARP
| IFF_BROADCAST
;
385 dev
->watchdog_timeo
= 0;
387 dev
->destructor
= mac802154_wpan_free
;
388 dev
->netdev_ops
= &mac802154_wpan_ops
;
389 dev
->ml_priv
= &mac802154_mlme_wpan
;
391 priv
= netdev_priv(dev
);
392 priv
->type
= IEEE802154_DEV_WPAN
;
394 priv
->chan
= MAC802154_CHAN_NONE
;
397 spin_lock_init(&priv
->mib_lock
);
398 mutex_init(&priv
->sec_mtx
);
400 get_random_bytes(&priv
->bsn
, 1);
401 get_random_bytes(&priv
->dsn
, 1);
403 /* defaults per 802.15.4-2011 */
404 priv
->mac_params
.min_be
= 3;
405 priv
->mac_params
.max_be
= 5;
406 priv
->mac_params
.csma_retries
= 4;
407 priv
->mac_params
.frame_retries
= -1; /* for compatibility, actual default is 3 */
409 priv
->pan_id
= cpu_to_le16(IEEE802154_PANID_BROADCAST
);
410 priv
->short_addr
= cpu_to_le16(IEEE802154_ADDR_BROADCAST
);
412 mac802154_llsec_init(&priv
->sec
);
415 static int mac802154_process_data(struct net_device
*dev
, struct sk_buff
*skb
)
417 return netif_rx_ni(skb
);
421 mac802154_subif_frame(struct mac802154_sub_if_data
*sdata
, struct sk_buff
*skb
,
422 const struct ieee802154_hdr
*hdr
)
427 pr_debug("getting packet via slave interface %s\n", sdata
->dev
->name
);
429 spin_lock_bh(&sdata
->mib_lock
);
431 span
= sdata
->pan_id
;
432 sshort
= sdata
->short_addr
;
434 switch (mac_cb(skb
)->dest
.mode
) {
435 case IEEE802154_ADDR_NONE
:
436 if (mac_cb(skb
)->dest
.mode
!= IEEE802154_ADDR_NONE
)
437 /* FIXME: check if we are PAN coordinator */
438 skb
->pkt_type
= PACKET_OTHERHOST
;
440 /* ACK comes with both addresses empty */
441 skb
->pkt_type
= PACKET_HOST
;
443 case IEEE802154_ADDR_LONG
:
444 if (mac_cb(skb
)->dest
.pan_id
!= span
&&
445 mac_cb(skb
)->dest
.pan_id
!= cpu_to_le16(IEEE802154_PANID_BROADCAST
))
446 skb
->pkt_type
= PACKET_OTHERHOST
;
447 else if (mac_cb(skb
)->dest
.extended_addr
== sdata
->extended_addr
)
448 skb
->pkt_type
= PACKET_HOST
;
450 skb
->pkt_type
= PACKET_OTHERHOST
;
452 case IEEE802154_ADDR_SHORT
:
453 if (mac_cb(skb
)->dest
.pan_id
!= span
&&
454 mac_cb(skb
)->dest
.pan_id
!= cpu_to_le16(IEEE802154_PANID_BROADCAST
))
455 skb
->pkt_type
= PACKET_OTHERHOST
;
456 else if (mac_cb(skb
)->dest
.short_addr
== sshort
)
457 skb
->pkt_type
= PACKET_HOST
;
458 else if (mac_cb(skb
)->dest
.short_addr
==
459 cpu_to_le16(IEEE802154_ADDR_BROADCAST
))
460 skb
->pkt_type
= PACKET_BROADCAST
;
462 skb
->pkt_type
= PACKET_OTHERHOST
;
465 spin_unlock_bh(&sdata
->mib_lock
);
466 pr_debug("invalid dest mode\n");
471 spin_unlock_bh(&sdata
->mib_lock
);
473 skb
->dev
= sdata
->dev
;
475 rc
= mac802154_llsec_decrypt(&sdata
->sec
, skb
);
477 pr_debug("decryption failed: %i\n", rc
);
482 sdata
->dev
->stats
.rx_packets
++;
483 sdata
->dev
->stats
.rx_bytes
+= skb
->len
;
485 switch (mac_cb(skb
)->type
) {
486 case IEEE802154_FC_TYPE_DATA
:
487 return mac802154_process_data(sdata
->dev
, skb
);
489 pr_warn("ieee802154: bad frame received (type = %d)\n",
496 static void mac802154_print_addr(const char *name
,
497 const struct ieee802154_addr
*addr
)
499 if (addr
->mode
== IEEE802154_ADDR_NONE
)
500 pr_debug("%s not present\n", name
);
502 pr_debug("%s PAN ID: %04x\n", name
, le16_to_cpu(addr
->pan_id
));
503 if (addr
->mode
== IEEE802154_ADDR_SHORT
) {
504 pr_debug("%s is short: %04x\n", name
,
505 le16_to_cpu(addr
->short_addr
));
507 u64 hw
= swab64((__force u64
) addr
->extended_addr
);
509 pr_debug("%s is hardware: %8phC\n", name
, &hw
);
513 static int mac802154_parse_frame_start(struct sk_buff
*skb
,
514 struct ieee802154_hdr
*hdr
)
517 struct ieee802154_mac_cb
*cb
= mac_cb_init(skb
);
519 hlen
= ieee802154_hdr_pull(skb
, hdr
);
525 pr_debug("fc: %04x dsn: %02x\n", le16_to_cpup((__le16
*)&hdr
->fc
),
528 cb
->type
= hdr
->fc
.type
;
529 cb
->ackreq
= hdr
->fc
.ack_request
;
530 cb
->secen
= hdr
->fc
.security_enabled
;
532 mac802154_print_addr("destination", &hdr
->dest
);
533 mac802154_print_addr("source", &hdr
->source
);
535 cb
->source
= hdr
->source
;
536 cb
->dest
= hdr
->dest
;
538 if (hdr
->fc
.security_enabled
) {
541 pr_debug("seclevel %i\n", hdr
->sec
.level
);
543 switch (hdr
->sec
.key_id_mode
) {
544 case IEEE802154_SCF_KEY_IMPLICIT
:
545 pr_debug("implicit key\n");
548 case IEEE802154_SCF_KEY_INDEX
:
549 pr_debug("key %02x\n", hdr
->sec
.key_id
);
552 case IEEE802154_SCF_KEY_SHORT_INDEX
:
553 pr_debug("key %04x:%04x %02x\n",
554 le32_to_cpu(hdr
->sec
.short_src
) >> 16,
555 le32_to_cpu(hdr
->sec
.short_src
) & 0xffff,
559 case IEEE802154_SCF_KEY_HW_INDEX
:
560 key
= swab64((__force u64
) hdr
->sec
.extended_src
);
561 pr_debug("key source %8phC %02x\n", &key
,
570 void mac802154_wpans_rx(struct mac802154_priv
*priv
, struct sk_buff
*skb
)
573 struct mac802154_sub_if_data
*sdata
;
574 struct ieee802154_hdr hdr
;
576 ret
= mac802154_parse_frame_start(skb
, &hdr
);
578 pr_debug("got invalid frame\n");
584 list_for_each_entry_rcu(sdata
, &priv
->slaves
, list
) {
585 if (sdata
->type
!= IEEE802154_DEV_WPAN
||
586 !netif_running(sdata
->dev
))
589 mac802154_subif_frame(sdata
, skb
, &hdr
);