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.
14 * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com>
15 * Sergey Lapin <slapin@ossfans.org>
16 * Maxim Gorbachyov <maxim.gorbachev@siemens.com>
17 * Alexander Smirnov <alex.bluesman.smirnov@gmail.com>
20 #include <linux/netdevice.h>
21 #include <linux/module.h>
22 #include <linux/if_arp.h>
23 #include <linux/ieee802154.h>
25 #include <net/rtnetlink.h>
26 #include <linux/nl802154.h>
27 #include <net/mac802154.h>
28 #include <net/ieee802154_netdev.h>
29 #include <net/cfg802154.h>
31 #include "ieee802154_i.h"
32 #include "driver-ops.h"
34 static int mac802154_wpan_update_llsec(struct net_device
*dev
)
36 struct ieee802154_sub_if_data
*sdata
= IEEE802154_DEV_TO_SUB_IF(dev
);
37 struct ieee802154_mlme_ops
*ops
= ieee802154_mlme_ops(dev
);
38 struct wpan_dev
*wpan_dev
= &sdata
->wpan_dev
;
42 struct ieee802154_llsec_params params
;
45 params
.pan_id
= wpan_dev
->pan_id
;
46 changed
|= IEEE802154_LLSEC_PARAM_PAN_ID
;
48 params
.hwaddr
= wpan_dev
->extended_addr
;
49 changed
|= IEEE802154_LLSEC_PARAM_HWADDR
;
51 rc
= ops
->llsec
->set_params(dev
, ¶ms
, changed
);
58 mac802154_wpan_ioctl(struct net_device
*dev
, struct ifreq
*ifr
, int cmd
)
60 struct ieee802154_sub_if_data
*sdata
= IEEE802154_DEV_TO_SUB_IF(dev
);
61 struct wpan_dev
*wpan_dev
= &sdata
->wpan_dev
;
62 struct sockaddr_ieee802154
*sa
=
63 (struct sockaddr_ieee802154
*)&ifr
->ifr_addr
;
64 int err
= -ENOIOCTLCMD
;
66 spin_lock_bh(&sdata
->mib_lock
);
71 u16 pan_id
, short_addr
;
73 pan_id
= le16_to_cpu(wpan_dev
->pan_id
);
74 short_addr
= le16_to_cpu(wpan_dev
->short_addr
);
75 if (pan_id
== IEEE802154_PANID_BROADCAST
||
76 short_addr
== IEEE802154_ADDR_BROADCAST
) {
81 sa
->family
= AF_IEEE802154
;
82 sa
->addr
.addr_type
= IEEE802154_ADDR_SHORT
;
83 sa
->addr
.pan_id
= pan_id
;
84 sa
->addr
.short_addr
= short_addr
;
91 "Using DEBUGing ioctl SIOCSIFADDR isn't recommended!\n");
92 if (sa
->family
!= AF_IEEE802154
||
93 sa
->addr
.addr_type
!= IEEE802154_ADDR_SHORT
||
94 sa
->addr
.pan_id
== IEEE802154_PANID_BROADCAST
||
95 sa
->addr
.short_addr
== IEEE802154_ADDR_BROADCAST
||
96 sa
->addr
.short_addr
== IEEE802154_ADDR_UNDEF
) {
101 wpan_dev
->pan_id
= cpu_to_le16(sa
->addr
.pan_id
);
102 wpan_dev
->short_addr
= cpu_to_le16(sa
->addr
.short_addr
);
104 err
= mac802154_wpan_update_llsec(dev
);
108 spin_unlock_bh(&sdata
->mib_lock
);
112 static int mac802154_wpan_mac_addr(struct net_device
*dev
, void *p
)
114 struct ieee802154_sub_if_data
*sdata
= IEEE802154_DEV_TO_SUB_IF(dev
);
115 struct sockaddr
*addr
= p
;
116 __le64 extended_addr
;
118 if (netif_running(dev
))
121 ieee802154_be64_to_le64(&extended_addr
, addr
->sa_data
);
122 if (!ieee802154_is_valid_extended_addr(extended_addr
))
125 memcpy(dev
->dev_addr
, addr
->sa_data
, dev
->addr_len
);
126 sdata
->wpan_dev
.extended_addr
= extended_addr
;
128 return mac802154_wpan_update_llsec(dev
);
131 static int mac802154_slave_open(struct net_device
*dev
)
133 struct ieee802154_sub_if_data
*sdata
= IEEE802154_DEV_TO_SUB_IF(dev
);
134 struct ieee802154_sub_if_data
*subif
;
135 struct ieee802154_local
*local
= sdata
->local
;
140 if (sdata
->vif
.type
== IEEE802154_DEV_WPAN
) {
141 mutex_lock(&sdata
->local
->iflist_mtx
);
142 list_for_each_entry(subif
, &sdata
->local
->interfaces
, list
) {
143 if (subif
!= sdata
&&
144 subif
->vif
.type
== sdata
->vif
.type
&&
145 ieee802154_sdata_running(subif
)) {
146 mutex_unlock(&sdata
->local
->iflist_mtx
);
150 mutex_unlock(&sdata
->local
->iflist_mtx
);
153 set_bit(SDATA_STATE_RUNNING
, &sdata
->state
);
155 if (!local
->open_count
) {
156 res
= drv_start(local
);
163 netif_start_queue(dev
);
166 /* might already be clear but that doesn't matter */
167 clear_bit(SDATA_STATE_RUNNING
, &sdata
->state
);
172 static int mac802154_wpan_open(struct net_device
*dev
)
175 struct ieee802154_sub_if_data
*sdata
= IEEE802154_DEV_TO_SUB_IF(dev
);
176 struct ieee802154_local
*local
= sdata
->local
;
177 struct wpan_dev
*wpan_dev
= &sdata
->wpan_dev
;
178 struct wpan_phy
*phy
= sdata
->local
->phy
;
180 rc
= mac802154_slave_open(dev
);
184 mutex_lock(&phy
->pib_lock
);
186 if (local
->hw
.flags
& IEEE802154_HW_PROMISCUOUS
) {
187 rc
= drv_set_promiscuous_mode(local
,
188 wpan_dev
->promiscuous_mode
);
193 if (local
->hw
.flags
& IEEE802154_HW_AFILT
) {
194 rc
= drv_set_pan_id(local
, wpan_dev
->pan_id
);
198 rc
= drv_set_extended_addr(local
, wpan_dev
->extended_addr
);
202 rc
= drv_set_short_addr(local
, wpan_dev
->short_addr
);
207 if (local
->hw
.flags
& IEEE802154_HW_LBT
) {
208 rc
= drv_set_lbt_mode(local
, wpan_dev
->lbt
);
213 if (local
->hw
.flags
& IEEE802154_HW_CSMA_PARAMS
) {
214 rc
= drv_set_csma_params(local
, wpan_dev
->min_be
,
216 wpan_dev
->csma_retries
);
221 if (local
->hw
.flags
& IEEE802154_HW_FRAME_RETRIES
) {
222 rc
= drv_set_max_frame_retries(local
, wpan_dev
->frame_retries
);
227 mutex_unlock(&phy
->pib_lock
);
231 mutex_unlock(&phy
->pib_lock
);
235 static int mac802154_slave_close(struct net_device
*dev
)
237 struct ieee802154_sub_if_data
*sdata
= IEEE802154_DEV_TO_SUB_IF(dev
);
238 struct ieee802154_local
*local
= sdata
->local
;
242 netif_stop_queue(dev
);
245 clear_bit(SDATA_STATE_RUNNING
, &sdata
->state
);
247 if (!local
->open_count
)
253 static int mac802154_set_header_security(struct ieee802154_sub_if_data
*sdata
,
254 struct ieee802154_hdr
*hdr
,
255 const struct ieee802154_mac_cb
*cb
)
257 struct ieee802154_llsec_params params
;
260 mac802154_llsec_get_params(&sdata
->sec
, ¶ms
);
262 if (!params
.enabled
&& cb
->secen_override
&& cb
->secen
)
264 if (!params
.enabled
||
265 (cb
->secen_override
&& !cb
->secen
) ||
268 if (cb
->seclevel_override
&& !cb
->seclevel
)
271 level
= cb
->seclevel_override
? cb
->seclevel
: params
.out_level
;
273 hdr
->fc
.security_enabled
= 1;
274 hdr
->sec
.level
= level
;
275 hdr
->sec
.key_id_mode
= params
.out_key
.mode
;
276 if (params
.out_key
.mode
== IEEE802154_SCF_KEY_SHORT_INDEX
)
277 hdr
->sec
.short_src
= params
.out_key
.short_source
;
278 else if (params
.out_key
.mode
== IEEE802154_SCF_KEY_HW_INDEX
)
279 hdr
->sec
.extended_src
= params
.out_key
.extended_source
;
280 hdr
->sec
.key_id
= params
.out_key
.id
;
285 static int mac802154_header_create(struct sk_buff
*skb
,
286 struct net_device
*dev
,
292 struct ieee802154_hdr hdr
;
293 struct ieee802154_sub_if_data
*sdata
= IEEE802154_DEV_TO_SUB_IF(dev
);
294 struct wpan_dev
*wpan_dev
= &sdata
->wpan_dev
;
295 struct ieee802154_mac_cb
*cb
= mac_cb(skb
);
301 memset(&hdr
.fc
, 0, sizeof(hdr
.fc
));
302 hdr
.fc
.type
= cb
->type
;
303 hdr
.fc
.security_enabled
= cb
->secen
;
304 hdr
.fc
.ack_request
= cb
->ackreq
;
305 hdr
.seq
= ieee802154_mlme_ops(dev
)->get_dsn(dev
);
307 if (mac802154_set_header_security(sdata
, &hdr
, cb
) < 0)
311 spin_lock_bh(&sdata
->mib_lock
);
313 if (wpan_dev
->short_addr
== cpu_to_le16(IEEE802154_ADDR_BROADCAST
) ||
314 wpan_dev
->short_addr
== cpu_to_le16(IEEE802154_ADDR_UNDEF
) ||
315 wpan_dev
->pan_id
== cpu_to_le16(IEEE802154_PANID_BROADCAST
)) {
316 hdr
.source
.mode
= IEEE802154_ADDR_LONG
;
317 hdr
.source
.extended_addr
= wpan_dev
->extended_addr
;
319 hdr
.source
.mode
= IEEE802154_ADDR_SHORT
;
320 hdr
.source
.short_addr
= wpan_dev
->short_addr
;
323 hdr
.source
.pan_id
= wpan_dev
->pan_id
;
325 spin_unlock_bh(&sdata
->mib_lock
);
327 hdr
.source
= *(const struct ieee802154_addr
*)saddr
;
330 hdr
.dest
= *(const struct ieee802154_addr
*)daddr
;
332 hlen
= ieee802154_hdr_push(skb
, &hdr
);
336 skb_reset_mac_header(skb
);
339 if (len
> ieee802154_max_payload(&hdr
))
346 mac802154_header_parse(const struct sk_buff
*skb
, unsigned char *haddr
)
348 struct ieee802154_hdr hdr
;
349 struct ieee802154_addr
*addr
= (struct ieee802154_addr
*)haddr
;
351 if (ieee802154_hdr_peek_addrs(skb
, &hdr
) < 0) {
352 pr_debug("malformed packet\n");
357 return sizeof(*addr
);
360 static struct header_ops mac802154_header_ops
= {
361 .create
= mac802154_header_create
,
362 .parse
= mac802154_header_parse
,
365 static const struct net_device_ops mac802154_wpan_ops
= {
366 .ndo_open
= mac802154_wpan_open
,
367 .ndo_stop
= mac802154_slave_close
,
368 .ndo_start_xmit
= ieee802154_subif_start_xmit
,
369 .ndo_do_ioctl
= mac802154_wpan_ioctl
,
370 .ndo_set_mac_address
= mac802154_wpan_mac_addr
,
373 static const struct net_device_ops mac802154_monitor_ops
= {
374 .ndo_open
= mac802154_wpan_open
,
375 .ndo_stop
= mac802154_slave_close
,
376 .ndo_start_xmit
= ieee802154_monitor_start_xmit
,
379 static void mac802154_wpan_free(struct net_device
*dev
)
381 struct ieee802154_sub_if_data
*sdata
= IEEE802154_DEV_TO_SUB_IF(dev
);
383 mac802154_llsec_destroy(&sdata
->sec
);
388 static void ieee802154_if_setup(struct net_device
*dev
)
390 dev
->addr_len
= IEEE802154_EXTENDED_ADDR_LEN
;
391 memset(dev
->broadcast
, 0xff, IEEE802154_EXTENDED_ADDR_LEN
);
393 dev
->hard_header_len
= MAC802154_FRAME_HARD_HEADER_LEN
;
394 dev
->needed_tailroom
= 2 + 16; /* FCS + MIC */
395 dev
->mtu
= IEEE802154_MTU
;
396 dev
->tx_queue_len
= 300;
397 dev
->flags
= IFF_NOARP
| IFF_BROADCAST
;
401 ieee802154_setup_sdata(struct ieee802154_sub_if_data
*sdata
, int type
)
403 struct wpan_dev
*wpan_dev
= &sdata
->wpan_dev
;
405 /* set some type-dependent values */
406 sdata
->vif
.type
= type
;
408 get_random_bytes(&wpan_dev
->bsn
, 1);
409 get_random_bytes(&wpan_dev
->dsn
, 1);
411 /* defaults per 802.15.4-2011 */
412 wpan_dev
->min_be
= 3;
413 wpan_dev
->max_be
= 5;
414 wpan_dev
->csma_retries
= 4;
415 /* for compatibility, actual default is 3 */
416 wpan_dev
->frame_retries
= -1;
418 ieee802154_be64_to_le64(&wpan_dev
->extended_addr
, sdata
->dev
->dev_addr
);
419 wpan_dev
->pan_id
= cpu_to_le16(IEEE802154_PANID_BROADCAST
);
420 wpan_dev
->short_addr
= cpu_to_le16(IEEE802154_ADDR_BROADCAST
);
423 case IEEE802154_DEV_WPAN
:
424 sdata
->dev
->header_ops
= &mac802154_header_ops
;
425 sdata
->dev
->destructor
= mac802154_wpan_free
;
426 sdata
->dev
->netdev_ops
= &mac802154_wpan_ops
;
427 sdata
->dev
->ml_priv
= &mac802154_mlme_wpan
;
428 wpan_dev
->promiscuous_mode
= false;
430 spin_lock_init(&sdata
->mib_lock
);
431 mutex_init(&sdata
->sec_mtx
);
433 mac802154_llsec_init(&sdata
->sec
);
435 case IEEE802154_DEV_MONITOR
:
436 sdata
->dev
->destructor
= free_netdev
;
437 sdata
->dev
->netdev_ops
= &mac802154_monitor_ops
;
438 wpan_dev
->promiscuous_mode
= true;
448 ieee802154_if_add(struct ieee802154_local
*local
, const char *name
,
449 struct wpan_dev
**new_wpan_dev
, int type
)
451 struct net_device
*ndev
= NULL
;
452 struct ieee802154_sub_if_data
*sdata
= NULL
;
457 ndev
= alloc_netdev(sizeof(*sdata
) + local
->hw
.vif_data_size
, name
,
458 NET_NAME_UNKNOWN
, ieee802154_if_setup
);
460 return ERR_PTR(-ENOMEM
);
462 ndev
->needed_headroom
= local
->hw
.extra_tx_headroom
;
464 ret
= dev_alloc_name(ndev
, ndev
->name
);
469 case IEEE802154_DEV_WPAN
:
470 ndev
->type
= ARPHRD_IEEE802154
;
472 case IEEE802154_DEV_MONITOR
:
473 ndev
->type
= ARPHRD_IEEE802154_MONITOR
;
480 ieee802154_le64_to_be64(ndev
->perm_addr
,
481 &local
->hw
.phy
->perm_extended_addr
);
482 memcpy(ndev
->dev_addr
, ndev
->perm_addr
, IEEE802154_EXTENDED_ADDR_LEN
);
483 /* TODO check this */
484 SET_NETDEV_DEV(ndev
, &local
->phy
->dev
);
485 sdata
= netdev_priv(ndev
);
486 ndev
->ieee802154_ptr
= &sdata
->wpan_dev
;
487 memcpy(sdata
->name
, ndev
->name
, IFNAMSIZ
);
489 sdata
->wpan_dev
.wpan_phy
= local
->hw
.phy
;
490 sdata
->local
= local
;
492 /* setup type-dependent data */
493 ret
= ieee802154_setup_sdata(sdata
, type
);
498 ret
= register_netdevice(ndev
);
503 mutex_lock(&local
->iflist_mtx
);
504 list_add_tail_rcu(&sdata
->list
, &local
->interfaces
);
505 mutex_unlock(&local
->iflist_mtx
);
508 *new_wpan_dev
= &sdata
->wpan_dev
;
517 void ieee802154_if_remove(struct ieee802154_sub_if_data
*sdata
)
521 mutex_lock(&sdata
->local
->iflist_mtx
);
522 list_del_rcu(&sdata
->list
);
523 mutex_unlock(&sdata
->local
->iflist_mtx
);
526 unregister_netdevice(sdata
->dev
);