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
;
149 sdata
= netdev_priv(dev
);
151 BUG_ON(sdata
->hw
->phy
!= phy
);
153 mutex_lock(&sdata
->hw
->slaves_mtx
);
154 list_del_rcu(&sdata
->list
);
155 mutex_unlock(&sdata
->hw
->slaves_mtx
);
158 unregister_netdevice(sdata
->dev
);
161 static struct net_device
*
162 mac802154_add_iface(struct wpan_phy
*phy
, const char *name
, int type
)
164 struct net_device
*dev
;
168 case IEEE802154_DEV_MONITOR
:
169 dev
= alloc_netdev(sizeof(struct mac802154_sub_if_data
),
170 name
, mac802154_monitor_setup
);
172 case IEEE802154_DEV_WPAN
:
173 dev
= alloc_netdev(sizeof(struct mac802154_sub_if_data
),
174 name
, mac802154_wpan_setup
);
184 err
= mac802154_netdev_register(phy
, dev
);
188 dev_hold(dev
); /* we return an incremented device refcount */
197 static int mac802154_set_txpower(struct wpan_phy
*phy
, int db
)
199 struct mac802154_priv
*priv
= wpan_phy_priv(phy
);
201 return priv
->ops
->set_txpower(&priv
->hw
, db
);
204 static int mac802154_set_lbt(struct wpan_phy
*phy
, bool on
)
206 struct mac802154_priv
*priv
= wpan_phy_priv(phy
);
208 return priv
->ops
->set_lbt(&priv
->hw
, on
);
211 static int mac802154_set_cca_mode(struct wpan_phy
*phy
, u8 mode
)
213 struct mac802154_priv
*priv
= wpan_phy_priv(phy
);
215 return priv
->ops
->set_cca_mode(&priv
->hw
, mode
);
218 static int mac802154_set_cca_ed_level(struct wpan_phy
*phy
, s32 level
)
220 struct mac802154_priv
*priv
= wpan_phy_priv(phy
);
222 return priv
->ops
->set_cca_ed_level(&priv
->hw
, level
);
225 static int mac802154_set_csma_params(struct wpan_phy
*phy
, u8 min_be
,
226 u8 max_be
, u8 retries
)
228 struct mac802154_priv
*priv
= wpan_phy_priv(phy
);
230 return priv
->ops
->set_csma_params(&priv
->hw
, min_be
, max_be
, retries
);
233 static int mac802154_set_frame_retries(struct wpan_phy
*phy
, s8 retries
)
235 struct mac802154_priv
*priv
= wpan_phy_priv(phy
);
237 return priv
->ops
->set_frame_retries(&priv
->hw
, retries
);
240 struct ieee802154_dev
*
241 ieee802154_alloc_device(size_t priv_data_len
, struct ieee802154_ops
*ops
)
243 struct wpan_phy
*phy
;
244 struct mac802154_priv
*priv
;
247 if (!ops
|| !ops
->xmit
|| !ops
->ed
|| !ops
->start
||
248 !ops
->stop
|| !ops
->set_channel
) {
249 pr_err("undefined IEEE802.15.4 device operations\n");
253 /* Ensure 32-byte alignment of our private data and hw private data.
254 * We use the wpan_phy priv data for both our mac802154_priv and for
255 * the driver's private data
257 * in memory it'll be like this:
259 * +-----------------------+
260 * | struct wpan_phy |
261 * +-----------------------+
262 * | struct mac802154_priv |
263 * +-----------------------+
264 * | driver's private data |
265 * +-----------------------+
267 * Due to ieee802154 layer isn't aware of driver and MAC structures,
268 * so lets allign them here.
271 priv_size
= ALIGN(sizeof(*priv
), NETDEV_ALIGN
) + priv_data_len
;
273 phy
= wpan_phy_alloc(priv_size
);
275 pr_err("failure to allocate master IEEE802.15.4 device\n");
279 priv
= wpan_phy_priv(phy
);
281 priv
->hw
.phy
= priv
->phy
;
282 priv
->hw
.priv
= (char *)priv
+ ALIGN(sizeof(*priv
), NETDEV_ALIGN
);
285 INIT_LIST_HEAD(&priv
->slaves
);
286 mutex_init(&priv
->slaves_mtx
);
290 EXPORT_SYMBOL(ieee802154_alloc_device
);
292 void ieee802154_free_device(struct ieee802154_dev
*hw
)
294 struct mac802154_priv
*priv
= mac802154_to_priv(hw
);
296 BUG_ON(!list_empty(&priv
->slaves
));
298 mutex_destroy(&priv
->slaves_mtx
);
300 wpan_phy_free(priv
->phy
);
302 EXPORT_SYMBOL(ieee802154_free_device
);
304 int ieee802154_register_device(struct ieee802154_dev
*dev
)
306 struct mac802154_priv
*priv
= mac802154_to_priv(dev
);
309 priv
->dev_workqueue
=
310 create_singlethread_workqueue(wpan_phy_name(priv
->phy
));
311 if (!priv
->dev_workqueue
)
314 wpan_phy_set_dev(priv
->phy
, priv
->hw
.parent
);
316 priv
->phy
->add_iface
= mac802154_add_iface
;
317 priv
->phy
->del_iface
= mac802154_del_iface
;
318 if (priv
->ops
->set_txpower
)
319 priv
->phy
->set_txpower
= mac802154_set_txpower
;
320 if (priv
->ops
->set_lbt
)
321 priv
->phy
->set_lbt
= mac802154_set_lbt
;
322 if (priv
->ops
->set_cca_mode
)
323 priv
->phy
->set_cca_mode
= mac802154_set_cca_mode
;
324 if (priv
->ops
->set_cca_ed_level
)
325 priv
->phy
->set_cca_ed_level
= mac802154_set_cca_ed_level
;
326 if (priv
->ops
->set_csma_params
)
327 priv
->phy
->set_csma_params
= mac802154_set_csma_params
;
328 if (priv
->ops
->set_frame_retries
)
329 priv
->phy
->set_frame_retries
= mac802154_set_frame_retries
;
331 rc
= wpan_phy_register(priv
->phy
);
337 mutex_lock(&priv
->slaves_mtx
);
338 priv
->running
= MAC802154_DEVICE_RUN
;
339 mutex_unlock(&priv
->slaves_mtx
);
346 destroy_workqueue(priv
->dev_workqueue
);
350 EXPORT_SYMBOL(ieee802154_register_device
);
352 void ieee802154_unregister_device(struct ieee802154_dev
*dev
)
354 struct mac802154_priv
*priv
= mac802154_to_priv(dev
);
355 struct mac802154_sub_if_data
*sdata
, *next
;
357 flush_workqueue(priv
->dev_workqueue
);
358 destroy_workqueue(priv
->dev_workqueue
);
362 mutex_lock(&priv
->slaves_mtx
);
363 priv
->running
= MAC802154_DEVICE_STOPPED
;
364 mutex_unlock(&priv
->slaves_mtx
);
366 list_for_each_entry_safe(sdata
, next
, &priv
->slaves
, list
) {
367 mutex_lock(&sdata
->hw
->slaves_mtx
);
368 list_del(&sdata
->list
);
369 mutex_unlock(&sdata
->hw
->slaves_mtx
);
371 unregister_netdevice(sdata
->dev
);
376 wpan_phy_unregister(priv
->phy
);
378 EXPORT_SYMBOL(ieee802154_unregister_device
);
380 MODULE_DESCRIPTION("IEEE 802.15.4 implementation");
381 MODULE_LICENSE("GPL v2");