2 * Copyright (C) 2007-2012 Siemens AG
5 * Alexander Smirnov <alex.bluesman.smirnov@gmail.com>
7 * Based on the code from 'linux-zigbee.sourceforge.net' project.
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License version 2
11 * as published by the Free Software Foundation.
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
18 * You should have received a copy of the GNU General Public License along
19 * with this program; if not, write to the Free Software Foundation, Inc.,
20 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
23 #include <linux/kernel.h>
24 #include <linux/module.h>
25 #include <linux/netdevice.h>
27 #include <net/netlink.h>
28 #include <linux/nl802154.h>
29 #include <net/mac802154.h>
30 #include <net/ieee802154_netdev.h>
31 #include <net/route.h>
32 #include <net/wpan-phy.h>
34 #include "mac802154.h"
36 int mac802154_slave_open(struct net_device
*dev
)
38 struct mac802154_sub_if_data
*priv
= netdev_priv(dev
);
39 struct mac802154_sub_if_data
*subif
;
40 struct mac802154_priv
*ipriv
= priv
->hw
;
45 if (priv
->type
== IEEE802154_DEV_WPAN
) {
46 mutex_lock(&priv
->hw
->slaves_mtx
);
47 list_for_each_entry(subif
, &priv
->hw
->slaves
, list
) {
48 if (subif
!= priv
&& subif
->type
== priv
->type
&&
50 mutex_unlock(&priv
->hw
->slaves_mtx
);
54 mutex_unlock(&priv
->hw
->slaves_mtx
);
57 mutex_lock(&priv
->hw
->slaves_mtx
);
59 mutex_unlock(&priv
->hw
->slaves_mtx
);
61 if (ipriv
->open_count
++ == 0) {
62 res
= ipriv
->ops
->start(&ipriv
->hw
);
68 if (ipriv
->ops
->ieee_addr
) {
69 __le64 addr
= ieee802154_devaddr_from_raw(dev
->dev_addr
);
71 res
= ipriv
->ops
->ieee_addr(&ipriv
->hw
, addr
);
75 mac802154_dev_set_ieee_addr(dev
);
78 netif_start_queue(dev
);
81 priv
->hw
->open_count
--;
86 int mac802154_slave_close(struct net_device
*dev
)
88 struct mac802154_sub_if_data
*priv
= netdev_priv(dev
);
89 struct mac802154_priv
*ipriv
= priv
->hw
;
93 netif_stop_queue(dev
);
95 mutex_lock(&priv
->hw
->slaves_mtx
);
96 priv
->running
= false;
97 mutex_unlock(&priv
->hw
->slaves_mtx
);
99 if (!--ipriv
->open_count
)
100 ipriv
->ops
->stop(&ipriv
->hw
);
106 mac802154_netdev_register(struct wpan_phy
*phy
, struct net_device
*dev
)
108 struct mac802154_sub_if_data
*priv
;
109 struct mac802154_priv
*ipriv
;
112 ipriv
= wpan_phy_priv(phy
);
114 priv
= netdev_priv(dev
);
118 dev
->needed_headroom
= ipriv
->hw
.extra_tx_headroom
;
120 SET_NETDEV_DEV(dev
, &ipriv
->phy
->dev
);
122 mutex_lock(&ipriv
->slaves_mtx
);
123 if (!ipriv
->running
) {
124 mutex_unlock(&ipriv
->slaves_mtx
);
127 mutex_unlock(&ipriv
->slaves_mtx
);
129 err
= register_netdev(dev
);
134 mutex_lock(&ipriv
->slaves_mtx
);
135 list_add_tail_rcu(&priv
->list
, &ipriv
->slaves
);
136 mutex_unlock(&ipriv
->slaves_mtx
);
143 mac802154_del_iface(struct wpan_phy
*phy
, struct net_device
*dev
)
145 struct mac802154_sub_if_data
*sdata
;
148 sdata
= netdev_priv(dev
);
150 BUG_ON(sdata
->hw
->phy
!= phy
);
152 mutex_lock(&sdata
->hw
->slaves_mtx
);
153 list_del_rcu(&sdata
->list
);
154 mutex_unlock(&sdata
->hw
->slaves_mtx
);
157 unregister_netdevice(sdata
->dev
);
160 static struct net_device
*
161 mac802154_add_iface(struct wpan_phy
*phy
, const char *name
, int type
)
163 struct net_device
*dev
;
167 case IEEE802154_DEV_MONITOR
:
168 dev
= alloc_netdev(sizeof(struct mac802154_sub_if_data
),
169 name
, mac802154_monitor_setup
);
171 case IEEE802154_DEV_WPAN
:
172 dev
= alloc_netdev(sizeof(struct mac802154_sub_if_data
),
173 name
, mac802154_wpan_setup
);
183 err
= mac802154_netdev_register(phy
, dev
);
187 dev_hold(dev
); /* we return an incremented device refcount */
196 static int mac802154_set_txpower(struct wpan_phy
*phy
, int db
)
198 struct mac802154_priv
*priv
= wpan_phy_priv(phy
);
200 return priv
->ops
->set_txpower(&priv
->hw
, db
);
203 static int mac802154_set_lbt(struct wpan_phy
*phy
, bool on
)
205 struct mac802154_priv
*priv
= wpan_phy_priv(phy
);
207 return priv
->ops
->set_lbt(&priv
->hw
, on
);
210 static int mac802154_set_cca_mode(struct wpan_phy
*phy
, u8 mode
)
212 struct mac802154_priv
*priv
= wpan_phy_priv(phy
);
214 return priv
->ops
->set_cca_mode(&priv
->hw
, mode
);
217 static int mac802154_set_cca_ed_level(struct wpan_phy
*phy
, s32 level
)
219 struct mac802154_priv
*priv
= wpan_phy_priv(phy
);
221 return priv
->ops
->set_cca_ed_level(&priv
->hw
, level
);
224 static int mac802154_set_csma_params(struct wpan_phy
*phy
, u8 min_be
,
225 u8 max_be
, u8 retries
)
227 struct mac802154_priv
*priv
= wpan_phy_priv(phy
);
229 return priv
->ops
->set_csma_params(&priv
->hw
, min_be
, max_be
, retries
);
232 static int mac802154_set_frame_retries(struct wpan_phy
*phy
, s8 retries
)
234 struct mac802154_priv
*priv
= wpan_phy_priv(phy
);
236 return priv
->ops
->set_frame_retries(&priv
->hw
, retries
);
239 struct ieee802154_dev
*
240 ieee802154_alloc_device(size_t priv_data_len
, struct ieee802154_ops
*ops
)
242 struct wpan_phy
*phy
;
243 struct mac802154_priv
*priv
;
246 if (!ops
|| !ops
->xmit
|| !ops
->ed
|| !ops
->start
||
247 !ops
->stop
|| !ops
->set_channel
) {
248 pr_err("undefined IEEE802.15.4 device operations\n");
252 /* Ensure 32-byte alignment of our private data and hw private data.
253 * We use the wpan_phy priv data for both our mac802154_priv and for
254 * the driver's private data
256 * in memory it'll be like this:
258 * +-----------------------+
259 * | struct wpan_phy |
260 * +-----------------------+
261 * | struct mac802154_priv |
262 * +-----------------------+
263 * | driver's private data |
264 * +-----------------------+
266 * Due to ieee802154 layer isn't aware of driver and MAC structures,
267 * so lets allign them here.
270 priv_size
= ALIGN(sizeof(*priv
), NETDEV_ALIGN
) + priv_data_len
;
272 phy
= wpan_phy_alloc(priv_size
);
274 pr_err("failure to allocate master IEEE802.15.4 device\n");
278 priv
= wpan_phy_priv(phy
);
279 priv
->hw
.phy
= priv
->phy
= phy
;
280 priv
->hw
.priv
= (char *)priv
+ ALIGN(sizeof(*priv
), NETDEV_ALIGN
);
283 INIT_LIST_HEAD(&priv
->slaves
);
284 mutex_init(&priv
->slaves_mtx
);
288 EXPORT_SYMBOL(ieee802154_alloc_device
);
290 void ieee802154_free_device(struct ieee802154_dev
*hw
)
292 struct mac802154_priv
*priv
= mac802154_to_priv(hw
);
294 BUG_ON(!list_empty(&priv
->slaves
));
296 mutex_destroy(&priv
->slaves_mtx
);
298 wpan_phy_free(priv
->phy
);
300 EXPORT_SYMBOL(ieee802154_free_device
);
302 int ieee802154_register_device(struct ieee802154_dev
*dev
)
304 struct mac802154_priv
*priv
= mac802154_to_priv(dev
);
307 priv
->dev_workqueue
=
308 create_singlethread_workqueue(wpan_phy_name(priv
->phy
));
309 if (!priv
->dev_workqueue
)
312 wpan_phy_set_dev(priv
->phy
, priv
->hw
.parent
);
314 priv
->phy
->add_iface
= mac802154_add_iface
;
315 priv
->phy
->del_iface
= mac802154_del_iface
;
316 if (priv
->ops
->set_txpower
)
317 priv
->phy
->set_txpower
= mac802154_set_txpower
;
318 if (priv
->ops
->set_lbt
)
319 priv
->phy
->set_lbt
= mac802154_set_lbt
;
320 if (priv
->ops
->set_cca_mode
)
321 priv
->phy
->set_cca_mode
= mac802154_set_cca_mode
;
322 if (priv
->ops
->set_cca_ed_level
)
323 priv
->phy
->set_cca_ed_level
= mac802154_set_cca_ed_level
;
324 if (priv
->ops
->set_csma_params
)
325 priv
->phy
->set_csma_params
= mac802154_set_csma_params
;
326 if (priv
->ops
->set_frame_retries
)
327 priv
->phy
->set_frame_retries
= mac802154_set_frame_retries
;
329 rc
= wpan_phy_register(priv
->phy
);
335 mutex_lock(&priv
->slaves_mtx
);
336 priv
->running
= MAC802154_DEVICE_RUN
;
337 mutex_unlock(&priv
->slaves_mtx
);
344 destroy_workqueue(priv
->dev_workqueue
);
348 EXPORT_SYMBOL(ieee802154_register_device
);
350 void ieee802154_unregister_device(struct ieee802154_dev
*dev
)
352 struct mac802154_priv
*priv
= mac802154_to_priv(dev
);
353 struct mac802154_sub_if_data
*sdata
, *next
;
355 flush_workqueue(priv
->dev_workqueue
);
356 destroy_workqueue(priv
->dev_workqueue
);
360 mutex_lock(&priv
->slaves_mtx
);
361 priv
->running
= MAC802154_DEVICE_STOPPED
;
362 mutex_unlock(&priv
->slaves_mtx
);
364 list_for_each_entry_safe(sdata
, next
, &priv
->slaves
, list
) {
365 mutex_lock(&sdata
->hw
->slaves_mtx
);
366 list_del(&sdata
->list
);
367 mutex_unlock(&sdata
->hw
->slaves_mtx
);
369 unregister_netdevice(sdata
->dev
);
374 wpan_phy_unregister(priv
->phy
);
376 EXPORT_SYMBOL(ieee802154_unregister_device
);
378 MODULE_DESCRIPTION("IEEE 802.15.4 implementation");
379 MODULE_LICENSE("GPL v2");