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 ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
114 struct sockaddr *addr = p;
115 __le64 extended_addr;
117 if (netif_running(dev))
120 extended_addr = ieee802154_netdev_to_extended_addr(addr->sa_data);
121 if (!ieee802154_is_valid_extended_addr(extended_addr))
124 memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);
125 sdata->extended_addr = extended_addr;
127 return mac802154_wpan_update_llsec(dev);
130 static int mac802154_slave_open(struct net_device *dev)
132 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
133 struct ieee802154_sub_if_data *subif;
134 struct ieee802154_local *local = sdata->local;
139 if (sdata->type == IEEE802154_DEV_WPAN) {
140 mutex_lock(&sdata->local->iflist_mtx);
141 list_for_each_entry(subif, &sdata->local->interfaces, list) {
142 if (subif != sdata && subif->type == sdata->type &&
143 ieee802154_sdata_running(subif)) {
144 mutex_unlock(&sdata->local->iflist_mtx);
148 mutex_unlock(&sdata->local->iflist_mtx);
151 set_bit(SDATA_STATE_RUNNING, &sdata->state);
153 if (!local->open_count) {
154 res = drv_start(local);
161 netif_start_queue(dev);
164 /* might already be clear but that doesn't matter */
165 clear_bit(SDATA_STATE_RUNNING, &sdata->state);
170 static int mac802154_wpan_open(struct net_device *dev)
173 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
174 struct ieee802154_local *local = sdata->local;
175 struct wpan_phy *phy = sdata->local->phy;
177 rc = mac802154_slave_open(dev);
181 mutex_lock(&phy->pib_lock);
183 if (local->hw.flags & IEEE802154_HW_PROMISCUOUS) {
184 rc = drv_set_promiscuous_mode(local, sdata->promisuous_mode);
189 if (local->hw.flags & IEEE802154_HW_AFILT) {
190 rc = drv_set_pan_id(local, sdata->pan_id);
194 rc = drv_set_extended_addr(local, sdata->extended_addr);
198 rc = drv_set_short_addr(local, sdata->short_addr);
203 if (local->hw.flags & IEEE802154_HW_LBT) {
204 rc = drv_set_lbt_mode(local, sdata->mac_params.lbt);
209 if (local->hw.flags & IEEE802154_HW_CSMA_PARAMS) {
210 rc = drv_set_csma_params(local, sdata->mac_params.min_be,
211 sdata->mac_params.max_be,
212 sdata->mac_params.csma_retries);
217 if (local->hw.flags & IEEE802154_HW_FRAME_RETRIES) {
218 rc = drv_set_max_frame_retries(local,
219 sdata->mac_params.frame_retries);
224 mutex_unlock(&phy->pib_lock);
228 mutex_unlock(&phy->pib_lock);
232 static int mac802154_slave_close(struct net_device *dev)
234 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
235 struct ieee802154_local *local = sdata->local;
239 netif_stop_queue(dev);
242 clear_bit(SDATA_STATE_RUNNING, &sdata->state);
244 if (!local->open_count)
250 static int mac802154_set_header_security(struct ieee802154_sub_if_data *sdata,
251 struct ieee802154_hdr *hdr,
252 const struct ieee802154_mac_cb *cb)
254 struct ieee802154_llsec_params params;
257 mac802154_llsec_get_params(&sdata->sec, ¶ms);
259 if (!params.enabled && cb->secen_override && cb->secen)
261 if (!params.enabled ||
262 (cb->secen_override && !cb->secen) ||
265 if (cb->seclevel_override && !cb->seclevel)
268 level = cb->seclevel_override ? cb->seclevel : params.out_level;
270 hdr->fc.security_enabled = 1;
271 hdr->sec.level = level;
272 hdr->sec.key_id_mode = params.out_key.mode;
273 if (params.out_key.mode == IEEE802154_SCF_KEY_SHORT_INDEX)
274 hdr->sec.short_src = params.out_key.short_source;
275 else if (params.out_key.mode == IEEE802154_SCF_KEY_HW_INDEX)
276 hdr->sec.extended_src = params.out_key.extended_source;
277 hdr->sec.key_id = params.out_key.id;
282 static int mac802154_header_create(struct sk_buff *skb,
283 struct net_device *dev,
289 struct ieee802154_hdr hdr;
290 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
291 struct ieee802154_mac_cb *cb = mac_cb(skb);
297 memset(&hdr.fc, 0, sizeof(hdr.fc));
298 hdr.fc.type = cb->type;
299 hdr.fc.security_enabled = cb->secen;
300 hdr.fc.ack_request = cb->ackreq;
301 hdr.seq = ieee802154_mlme_ops(dev)->get_dsn(dev);
303 if (mac802154_set_header_security(sdata, &hdr, cb) < 0)
307 spin_lock_bh(&sdata->mib_lock);
309 if (sdata->short_addr == cpu_to_le16(IEEE802154_ADDR_BROADCAST) ||
310 sdata->short_addr == cpu_to_le16(IEEE802154_ADDR_UNDEF) ||
311 sdata->pan_id == cpu_to_le16(IEEE802154_PANID_BROADCAST)) {
312 hdr.source.mode = IEEE802154_ADDR_LONG;
313 hdr.source.extended_addr = sdata->extended_addr;
315 hdr.source.mode = IEEE802154_ADDR_SHORT;
316 hdr.source.short_addr = sdata->short_addr;
319 hdr.source.pan_id = sdata->pan_id;
321 spin_unlock_bh(&sdata->mib_lock);
323 hdr.source = *(const struct ieee802154_addr *)saddr;
326 hdr.dest = *(const struct ieee802154_addr *)daddr;
328 hlen = ieee802154_hdr_push(skb, &hdr);
332 skb_reset_mac_header(skb);
335 if (len > ieee802154_max_payload(&hdr))
342 mac802154_header_parse(const struct sk_buff *skb, unsigned char *haddr)
344 struct ieee802154_hdr hdr;
345 struct ieee802154_addr *addr = (struct ieee802154_addr *)haddr;
347 if (ieee802154_hdr_peek_addrs(skb, &hdr) < 0) {
348 pr_debug("malformed packet\n");
353 return sizeof(*addr);
356 static struct header_ops mac802154_header_ops = {
357 .create = mac802154_header_create,
358 .parse = mac802154_header_parse,
361 static const struct net_device_ops mac802154_wpan_ops = {
362 .ndo_open = mac802154_wpan_open,
363 .ndo_stop = mac802154_slave_close,
364 .ndo_start_xmit = ieee802154_subif_start_xmit,
365 .ndo_do_ioctl = mac802154_wpan_ioctl,
366 .ndo_set_mac_address = mac802154_wpan_mac_addr,
369 static const struct net_device_ops mac802154_monitor_ops = {
370 .ndo_open = mac802154_wpan_open,
371 .ndo_stop = mac802154_slave_close,
372 .ndo_start_xmit = ieee802154_monitor_start_xmit,
375 static void mac802154_wpan_free(struct net_device *dev)
377 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
379 mac802154_llsec_destroy(&sdata->sec);
384 void mac802154_wpan_setup(struct net_device *dev)
386 struct ieee802154_sub_if_data *sdata;
388 dev->addr_len = IEEE802154_ADDR_LEN;
389 memset(dev->broadcast, 0xff, IEEE802154_ADDR_LEN);
391 dev->hard_header_len = MAC802154_FRAME_HARD_HEADER_LEN;
392 dev->header_ops = &mac802154_header_ops;
393 dev->needed_tailroom = 2 + 16; /* FCS + MIC */
394 dev->mtu = IEEE802154_MTU;
395 dev->tx_queue_len = 300;
396 dev->type = ARPHRD_IEEE802154;
397 dev->flags = IFF_NOARP | IFF_BROADCAST;
399 dev->destructor = mac802154_wpan_free;
400 dev->netdev_ops = &mac802154_wpan_ops;
401 dev->ml_priv = &mac802154_mlme_wpan;
403 sdata = IEEE802154_DEV_TO_SUB_IF(dev);
404 sdata->type = IEEE802154_DEV_WPAN;
406 spin_lock_init(&sdata->mib_lock);
407 mutex_init(&sdata->sec_mtx);
409 get_random_bytes(&sdata->bsn, 1);
410 get_random_bytes(&sdata->dsn, 1);
412 /* defaults per 802.15.4-2011 */
413 sdata->mac_params.min_be = 3;
414 sdata->mac_params.max_be = 5;
415 sdata->mac_params.csma_retries = 4;
416 /* for compatibility, actual default is 3 */
417 sdata->mac_params.frame_retries = -1;
419 sdata->pan_id = cpu_to_le16(IEEE802154_PANID_BROADCAST);
420 sdata->short_addr = cpu_to_le16(IEEE802154_ADDR_BROADCAST);
422 sdata->promisuous_mode = false;
424 mac802154_llsec_init(&sdata->sec);
427 void mac802154_monitor_setup(struct net_device *dev)
429 struct ieee802154_sub_if_data *sdata;
431 dev->needed_tailroom = 2; /* room for FCS */
432 dev->mtu = IEEE802154_MTU;
433 dev->tx_queue_len = 10;
434 dev->type = ARPHRD_IEEE802154_MONITOR;
435 dev->flags = IFF_NOARP | IFF_BROADCAST;
437 dev->destructor = free_netdev;
438 dev->netdev_ops = &mac802154_monitor_ops;
439 dev->ml_priv = &mac802154_mlme_reduced;
441 sdata = IEEE802154_DEV_TO_SUB_IF(dev);
442 sdata->type = IEEE802154_DEV_MONITOR;
444 sdata->promisuous_mode = true;