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/af_ieee802154.h>
28 #include <net/mac802154.h>
29 #include <net/ieee802154_netdev.h>
30 #include <net/cfg802154.h>
32 #include "ieee802154_i.h"
33 #include "driver-ops.h"
35 static int mac802154_wpan_update_llsec(struct net_device
*dev
)
37 struct ieee802154_sub_if_data
*sdata
= IEEE802154_DEV_TO_SUB_IF(dev
);
38 struct ieee802154_mlme_ops
*ops
= ieee802154_mlme_ops(dev
);
42 struct ieee802154_llsec_params params
;
45 params
.pan_id
= sdata
->pan_id
;
46 changed
|= IEEE802154_LLSEC_PARAM_PAN_ID
;
48 params
.hwaddr
= sdata
->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 sockaddr_ieee802154
*sa
=
62 (struct sockaddr_ieee802154
*)&ifr
->ifr_addr
;
63 int err
= -ENOIOCTLCMD
;
65 spin_lock_bh(&sdata
->mib_lock
);
70 u16 pan_id
, short_addr
;
72 pan_id
= le16_to_cpu(sdata
->pan_id
);
73 short_addr
= le16_to_cpu(sdata
->short_addr
);
74 if (pan_id
== IEEE802154_PANID_BROADCAST
||
75 short_addr
== IEEE802154_ADDR_BROADCAST
) {
80 sa
->family
= AF_IEEE802154
;
81 sa
->addr
.addr_type
= IEEE802154_ADDR_SHORT
;
82 sa
->addr
.pan_id
= pan_id
;
83 sa
->addr
.short_addr
= short_addr
;
90 "Using DEBUGing ioctl SIOCSIFADDR isn't recommended!\n");
91 if (sa
->family
!= AF_IEEE802154
||
92 sa
->addr
.addr_type
!= IEEE802154_ADDR_SHORT
||
93 sa
->addr
.pan_id
== IEEE802154_PANID_BROADCAST
||
94 sa
->addr
.short_addr
== IEEE802154_ADDR_BROADCAST
||
95 sa
->addr
.short_addr
== IEEE802154_ADDR_UNDEF
) {
100 sdata
->pan_id
= cpu_to_le16(sa
->addr
.pan_id
);
101 sdata
->short_addr
= cpu_to_le16(sa
->addr
.short_addr
);
103 err
= mac802154_wpan_update_llsec(dev
);
107 spin_unlock_bh(&sdata
->mib_lock
);
111 static int mac802154_wpan_mac_addr(struct net_device
*dev
, void *p
)
113 struct sockaddr
*addr
= p
;
115 if (netif_running(dev
))
118 /* FIXME: validate addr */
119 memcpy(dev
->dev_addr
, addr
->sa_data
, dev
->addr_len
);
120 mac802154_dev_set_ieee_addr(dev
);
121 return mac802154_wpan_update_llsec(dev
);
124 int mac802154_set_mac_params(struct net_device
*dev
,
125 const struct ieee802154_mac_params
*params
)
127 struct ieee802154_sub_if_data
*sdata
= IEEE802154_DEV_TO_SUB_IF(dev
);
129 mutex_lock(&sdata
->local
->iflist_mtx
);
130 sdata
->mac_params
= *params
;
131 mutex_unlock(&sdata
->local
->iflist_mtx
);
136 void mac802154_get_mac_params(struct net_device
*dev
,
137 struct ieee802154_mac_params
*params
)
139 struct ieee802154_sub_if_data
*sdata
= IEEE802154_DEV_TO_SUB_IF(dev
);
141 mutex_lock(&sdata
->local
->iflist_mtx
);
142 *params
= sdata
->mac_params
;
143 mutex_unlock(&sdata
->local
->iflist_mtx
);
146 static int mac802154_slave_open(struct net_device
*dev
)
148 struct ieee802154_sub_if_data
*sdata
= IEEE802154_DEV_TO_SUB_IF(dev
);
149 struct ieee802154_sub_if_data
*subif
;
150 struct ieee802154_local
*local
= sdata
->local
;
155 if (sdata
->type
== IEEE802154_DEV_WPAN
) {
156 mutex_lock(&sdata
->local
->iflist_mtx
);
157 list_for_each_entry(subif
, &sdata
->local
->interfaces
, list
) {
158 if (subif
!= sdata
&& subif
->type
== sdata
->type
&&
160 mutex_unlock(&sdata
->local
->iflist_mtx
);
164 mutex_unlock(&sdata
->local
->iflist_mtx
);
167 mutex_lock(&sdata
->local
->iflist_mtx
);
168 sdata
->running
= true;
169 mutex_unlock(&sdata
->local
->iflist_mtx
);
171 if (local
->open_count
++ == 0) {
172 res
= drv_start(local
);
178 netif_start_queue(dev
);
181 sdata
->local
->open_count
--;
186 static int mac802154_wpan_open(struct net_device
*dev
)
189 struct ieee802154_sub_if_data
*sdata
= IEEE802154_DEV_TO_SUB_IF(dev
);
190 struct ieee802154_local
*local
= sdata
->local
;
191 struct wpan_phy
*phy
= sdata
->local
->phy
;
193 rc
= mac802154_slave_open(dev
);
197 mutex_lock(&phy
->pib_lock
);
199 if (local
->hw
.flags
& IEEE802154_HW_TXPOWER
) {
200 rc
= drv_set_tx_power(local
, sdata
->mac_params
.transmit_power
);
205 if (local
->hw
.flags
& IEEE802154_HW_LBT
) {
206 rc
= drv_set_lbt_mode(local
, sdata
->mac_params
.lbt
);
211 if (local
->hw
.flags
& IEEE802154_HW_CCA_MODE
) {
212 rc
= drv_set_cca_mode(local
, sdata
->mac_params
.cca_mode
);
217 if (local
->hw
.flags
& IEEE802154_HW_CCA_ED_LEVEL
) {
218 rc
= drv_set_cca_ed_level(local
,
219 sdata
->mac_params
.cca_ed_level
);
224 if (local
->hw
.flags
& IEEE802154_HW_CSMA_PARAMS
) {
225 rc
= drv_set_csma_params(local
, sdata
->mac_params
.min_be
,
226 sdata
->mac_params
.max_be
,
227 sdata
->mac_params
.csma_retries
);
232 if (local
->hw
.flags
& IEEE802154_HW_FRAME_RETRIES
) {
233 rc
= drv_set_max_frame_retries(local
,
234 sdata
->mac_params
.frame_retries
);
239 mutex_unlock(&phy
->pib_lock
);
243 mutex_unlock(&phy
->pib_lock
);
247 static int mac802154_slave_close(struct net_device
*dev
)
249 struct ieee802154_sub_if_data
*sdata
= IEEE802154_DEV_TO_SUB_IF(dev
);
250 struct ieee802154_local
*local
= sdata
->local
;
254 netif_stop_queue(dev
);
256 mutex_lock(&sdata
->local
->iflist_mtx
);
257 sdata
->running
= false;
258 mutex_unlock(&sdata
->local
->iflist_mtx
);
260 if (!--local
->open_count
)
266 static int mac802154_set_header_security(struct ieee802154_sub_if_data
*sdata
,
267 struct ieee802154_hdr
*hdr
,
268 const struct ieee802154_mac_cb
*cb
)
270 struct ieee802154_llsec_params params
;
273 mac802154_llsec_get_params(&sdata
->sec
, ¶ms
);
275 if (!params
.enabled
&& cb
->secen_override
&& cb
->secen
)
277 if (!params
.enabled
||
278 (cb
->secen_override
&& !cb
->secen
) ||
281 if (cb
->seclevel_override
&& !cb
->seclevel
)
284 level
= cb
->seclevel_override
? cb
->seclevel
: params
.out_level
;
286 hdr
->fc
.security_enabled
= 1;
287 hdr
->sec
.level
= level
;
288 hdr
->sec
.key_id_mode
= params
.out_key
.mode
;
289 if (params
.out_key
.mode
== IEEE802154_SCF_KEY_SHORT_INDEX
)
290 hdr
->sec
.short_src
= params
.out_key
.short_source
;
291 else if (params
.out_key
.mode
== IEEE802154_SCF_KEY_HW_INDEX
)
292 hdr
->sec
.extended_src
= params
.out_key
.extended_source
;
293 hdr
->sec
.key_id
= params
.out_key
.id
;
298 static int mac802154_header_create(struct sk_buff
*skb
,
299 struct net_device
*dev
,
305 struct ieee802154_hdr hdr
;
306 struct ieee802154_sub_if_data
*sdata
= IEEE802154_DEV_TO_SUB_IF(dev
);
307 struct ieee802154_mac_cb
*cb
= mac_cb(skb
);
313 memset(&hdr
.fc
, 0, sizeof(hdr
.fc
));
314 hdr
.fc
.type
= cb
->type
;
315 hdr
.fc
.security_enabled
= cb
->secen
;
316 hdr
.fc
.ack_request
= cb
->ackreq
;
317 hdr
.seq
= ieee802154_mlme_ops(dev
)->get_dsn(dev
);
319 if (mac802154_set_header_security(sdata
, &hdr
, cb
) < 0)
323 spin_lock_bh(&sdata
->mib_lock
);
325 if (sdata
->short_addr
== cpu_to_le16(IEEE802154_ADDR_BROADCAST
) ||
326 sdata
->short_addr
== cpu_to_le16(IEEE802154_ADDR_UNDEF
) ||
327 sdata
->pan_id
== cpu_to_le16(IEEE802154_PANID_BROADCAST
)) {
328 hdr
.source
.mode
= IEEE802154_ADDR_LONG
;
329 hdr
.source
.extended_addr
= sdata
->extended_addr
;
331 hdr
.source
.mode
= IEEE802154_ADDR_SHORT
;
332 hdr
.source
.short_addr
= sdata
->short_addr
;
335 hdr
.source
.pan_id
= sdata
->pan_id
;
337 spin_unlock_bh(&sdata
->mib_lock
);
339 hdr
.source
= *(const struct ieee802154_addr
*)saddr
;
342 hdr
.dest
= *(const struct ieee802154_addr
*)daddr
;
344 hlen
= ieee802154_hdr_push(skb
, &hdr
);
348 skb_reset_mac_header(skb
);
351 if (len
> ieee802154_max_payload(&hdr
))
358 mac802154_header_parse(const struct sk_buff
*skb
, unsigned char *haddr
)
360 struct ieee802154_hdr hdr
;
361 struct ieee802154_addr
*addr
= (struct ieee802154_addr
*)haddr
;
363 if (ieee802154_hdr_peek_addrs(skb
, &hdr
) < 0) {
364 pr_debug("malformed packet\n");
369 return sizeof(*addr
);
372 static struct header_ops mac802154_header_ops
= {
373 .create
= mac802154_header_create
,
374 .parse
= mac802154_header_parse
,
377 static const struct net_device_ops mac802154_wpan_ops
= {
378 .ndo_open
= mac802154_wpan_open
,
379 .ndo_stop
= mac802154_slave_close
,
380 .ndo_start_xmit
= ieee802154_subif_start_xmit
,
381 .ndo_do_ioctl
= mac802154_wpan_ioctl
,
382 .ndo_set_mac_address
= mac802154_wpan_mac_addr
,
385 static const struct net_device_ops mac802154_monitor_ops
= {
386 .ndo_open
= mac802154_slave_open
,
387 .ndo_stop
= mac802154_slave_close
,
388 .ndo_start_xmit
= ieee802154_monitor_start_xmit
,
391 static void mac802154_wpan_free(struct net_device
*dev
)
393 struct ieee802154_sub_if_data
*sdata
= IEEE802154_DEV_TO_SUB_IF(dev
);
395 mac802154_llsec_destroy(&sdata
->sec
);
400 void mac802154_wpan_setup(struct net_device
*dev
)
402 struct ieee802154_sub_if_data
*sdata
;
404 dev
->addr_len
= IEEE802154_ADDR_LEN
;
405 memset(dev
->broadcast
, 0xff, IEEE802154_ADDR_LEN
);
407 dev
->hard_header_len
= MAC802154_FRAME_HARD_HEADER_LEN
;
408 dev
->header_ops
= &mac802154_header_ops
;
409 dev
->needed_tailroom
= 2 + 16; /* FCS + MIC */
410 dev
->mtu
= IEEE802154_MTU
;
411 dev
->tx_queue_len
= 300;
412 dev
->type
= ARPHRD_IEEE802154
;
413 dev
->flags
= IFF_NOARP
| IFF_BROADCAST
;
414 dev
->watchdog_timeo
= 0;
416 dev
->destructor
= mac802154_wpan_free
;
417 dev
->netdev_ops
= &mac802154_wpan_ops
;
418 dev
->ml_priv
= &mac802154_mlme_wpan
;
420 sdata
= IEEE802154_DEV_TO_SUB_IF(dev
);
421 sdata
->type
= IEEE802154_DEV_WPAN
;
423 sdata
->chan
= MAC802154_CHAN_NONE
;
426 spin_lock_init(&sdata
->mib_lock
);
427 mutex_init(&sdata
->sec_mtx
);
429 get_random_bytes(&sdata
->bsn
, 1);
430 get_random_bytes(&sdata
->dsn
, 1);
432 /* defaults per 802.15.4-2011 */
433 sdata
->mac_params
.min_be
= 3;
434 sdata
->mac_params
.max_be
= 5;
435 sdata
->mac_params
.csma_retries
= 4;
436 /* for compatibility, actual default is 3 */
437 sdata
->mac_params
.frame_retries
= -1;
439 sdata
->pan_id
= cpu_to_le16(IEEE802154_PANID_BROADCAST
);
440 sdata
->short_addr
= cpu_to_le16(IEEE802154_ADDR_BROADCAST
);
442 mac802154_llsec_init(&sdata
->sec
);
445 void mac802154_monitor_setup(struct net_device
*dev
)
447 struct ieee802154_sub_if_data
*sdata
;
450 dev
->hard_header_len
= 0;
451 dev
->needed_tailroom
= 2; /* room for FCS */
452 dev
->mtu
= IEEE802154_MTU
;
453 dev
->tx_queue_len
= 10;
454 dev
->type
= ARPHRD_IEEE802154_MONITOR
;
455 dev
->flags
= IFF_NOARP
| IFF_BROADCAST
;
456 dev
->watchdog_timeo
= 0;
458 dev
->destructor
= free_netdev
;
459 dev
->netdev_ops
= &mac802154_monitor_ops
;
460 dev
->ml_priv
= &mac802154_mlme_reduced
;
462 sdata
= IEEE802154_DEV_TO_SUB_IF(dev
);
463 sdata
->type
= IEEE802154_DEV_MONITOR
;
465 sdata
->chan
= MAC802154_CHAN_NONE
; /* not initialized */