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/route.h>
31 #include <net/wpan-phy.h>
33 #include "mac802154.h"
35 int mac802154_slave_open(struct net_device
*dev
)
37 struct mac802154_sub_if_data
*priv
= netdev_priv(dev
);
38 struct mac802154_priv
*ipriv
= priv
->hw
;
41 if (ipriv
->open_count
++ == 0) {
42 res
= ipriv
->ops
->start(&ipriv
->hw
);
48 if (ipriv
->ops
->ieee_addr
) {
49 res
= ipriv
->ops
->ieee_addr(&ipriv
->hw
, dev
->dev_addr
);
53 mac802154_dev_set_ieee_addr(dev
);
56 netif_start_queue(dev
);
59 priv
->hw
->open_count
--;
64 int mac802154_slave_close(struct net_device
*dev
)
66 struct mac802154_sub_if_data
*priv
= netdev_priv(dev
);
67 struct mac802154_priv
*ipriv
= priv
->hw
;
69 netif_stop_queue(dev
);
71 if (!--ipriv
->open_count
)
72 ipriv
->ops
->stop(&ipriv
->hw
);
78 mac802154_netdev_register(struct wpan_phy
*phy
, struct net_device
*dev
)
80 struct mac802154_sub_if_data
*priv
;
81 struct mac802154_priv
*ipriv
;
84 ipriv
= wpan_phy_priv(phy
);
86 priv
= netdev_priv(dev
);
90 dev
->needed_headroom
= ipriv
->hw
.extra_tx_headroom
;
92 SET_NETDEV_DEV(dev
, &ipriv
->phy
->dev
);
94 mutex_lock(&ipriv
->slaves_mtx
);
95 if (!ipriv
->running
) {
96 mutex_unlock(&ipriv
->slaves_mtx
);
99 mutex_unlock(&ipriv
->slaves_mtx
);
101 err
= register_netdev(dev
);
106 mutex_lock(&ipriv
->slaves_mtx
);
107 list_add_tail_rcu(&priv
->list
, &ipriv
->slaves
);
108 mutex_unlock(&ipriv
->slaves_mtx
);
115 mac802154_del_iface(struct wpan_phy
*phy
, struct net_device
*dev
)
117 struct mac802154_sub_if_data
*sdata
;
120 sdata
= netdev_priv(dev
);
122 BUG_ON(sdata
->hw
->phy
!= phy
);
124 mutex_lock(&sdata
->hw
->slaves_mtx
);
125 list_del_rcu(&sdata
->list
);
126 mutex_unlock(&sdata
->hw
->slaves_mtx
);
129 unregister_netdevice(sdata
->dev
);
132 static struct net_device
*
133 mac802154_add_iface(struct wpan_phy
*phy
, const char *name
, int type
)
135 struct net_device
*dev
;
139 case IEEE802154_DEV_MONITOR
:
140 dev
= alloc_netdev(sizeof(struct mac802154_sub_if_data
),
141 name
, mac802154_monitor_setup
);
143 case IEEE802154_DEV_WPAN
:
144 dev
= alloc_netdev(sizeof(struct mac802154_sub_if_data
),
145 name
, mac802154_wpan_setup
);
155 err
= mac802154_netdev_register(phy
, dev
);
159 dev_hold(dev
); /* we return an incremented device refcount */
168 static int mac802154_set_txpower(struct wpan_phy
*phy
, int db
)
170 struct mac802154_priv
*priv
= wpan_phy_priv(phy
);
172 if (!priv
->ops
->set_txpower
)
175 return priv
->ops
->set_txpower(&priv
->hw
, db
);
178 static int mac802154_set_lbt(struct wpan_phy
*phy
, bool on
)
180 struct mac802154_priv
*priv
= wpan_phy_priv(phy
);
182 if (!priv
->ops
->set_lbt
)
185 return priv
->ops
->set_lbt(&priv
->hw
, on
);
188 static int mac802154_set_cca_mode(struct wpan_phy
*phy
, u8 mode
)
190 struct mac802154_priv
*priv
= wpan_phy_priv(phy
);
192 if (!priv
->ops
->set_cca_mode
)
195 return priv
->ops
->set_cca_mode(&priv
->hw
, mode
);
198 static int mac802154_set_cca_ed_level(struct wpan_phy
*phy
, s32 level
)
200 struct mac802154_priv
*priv
= wpan_phy_priv(phy
);
202 if (!priv
->ops
->set_cca_ed_level
)
205 return priv
->ops
->set_cca_ed_level(&priv
->hw
, level
);
208 static int mac802154_set_csma_params(struct wpan_phy
*phy
, u8 min_be
,
209 u8 max_be
, u8 retries
)
211 struct mac802154_priv
*priv
= wpan_phy_priv(phy
);
213 if (!priv
->ops
->set_csma_params
)
216 return priv
->ops
->set_csma_params(&priv
->hw
, min_be
, max_be
, retries
);
219 static int mac802154_set_frame_retries(struct wpan_phy
*phy
, s8 retries
)
221 struct mac802154_priv
*priv
= wpan_phy_priv(phy
);
223 if (!priv
->ops
->set_frame_retries
)
226 return priv
->ops
->set_frame_retries(&priv
->hw
, retries
);
229 struct ieee802154_dev
*
230 ieee802154_alloc_device(size_t priv_data_len
, struct ieee802154_ops
*ops
)
232 struct wpan_phy
*phy
;
233 struct mac802154_priv
*priv
;
236 if (!ops
|| !ops
->xmit
|| !ops
->ed
|| !ops
->start
||
237 !ops
->stop
|| !ops
->set_channel
) {
238 pr_err("undefined IEEE802.15.4 device operations\n");
242 /* Ensure 32-byte alignment of our private data and hw private data.
243 * We use the wpan_phy priv data for both our mac802154_priv and for
244 * the driver's private data
246 * in memory it'll be like this:
248 * +-----------------------+
249 * | struct wpan_phy |
250 * +-----------------------+
251 * | struct mac802154_priv |
252 * +-----------------------+
253 * | driver's private data |
254 * +-----------------------+
256 * Due to ieee802154 layer isn't aware of driver and MAC structures,
257 * so lets allign them here.
260 priv_size
= ALIGN(sizeof(*priv
), NETDEV_ALIGN
) + priv_data_len
;
262 phy
= wpan_phy_alloc(priv_size
);
264 pr_err("failure to allocate master IEEE802.15.4 device\n");
268 priv
= wpan_phy_priv(phy
);
269 priv
->hw
.phy
= priv
->phy
= phy
;
270 priv
->hw
.priv
= (char *)priv
+ ALIGN(sizeof(*priv
), NETDEV_ALIGN
);
273 INIT_LIST_HEAD(&priv
->slaves
);
274 mutex_init(&priv
->slaves_mtx
);
278 EXPORT_SYMBOL(ieee802154_alloc_device
);
280 void ieee802154_free_device(struct ieee802154_dev
*hw
)
282 struct mac802154_priv
*priv
= mac802154_to_priv(hw
);
284 BUG_ON(!list_empty(&priv
->slaves
));
286 mutex_destroy(&priv
->slaves_mtx
);
288 wpan_phy_free(priv
->phy
);
290 EXPORT_SYMBOL(ieee802154_free_device
);
292 int ieee802154_register_device(struct ieee802154_dev
*dev
)
294 struct mac802154_priv
*priv
= mac802154_to_priv(dev
);
297 priv
->dev_workqueue
=
298 create_singlethread_workqueue(wpan_phy_name(priv
->phy
));
299 if (!priv
->dev_workqueue
)
302 wpan_phy_set_dev(priv
->phy
, priv
->hw
.parent
);
304 priv
->phy
->add_iface
= mac802154_add_iface
;
305 priv
->phy
->del_iface
= mac802154_del_iface
;
306 priv
->phy
->set_txpower
= mac802154_set_txpower
;
307 priv
->phy
->set_lbt
= mac802154_set_lbt
;
308 priv
->phy
->set_cca_mode
= mac802154_set_cca_mode
;
309 priv
->phy
->set_cca_ed_level
= mac802154_set_cca_ed_level
;
310 priv
->phy
->set_csma_params
= mac802154_set_csma_params
;
311 priv
->phy
->set_frame_retries
= mac802154_set_frame_retries
;
313 rc
= wpan_phy_register(priv
->phy
);
319 mutex_lock(&priv
->slaves_mtx
);
320 priv
->running
= MAC802154_DEVICE_RUN
;
321 mutex_unlock(&priv
->slaves_mtx
);
328 destroy_workqueue(priv
->dev_workqueue
);
332 EXPORT_SYMBOL(ieee802154_register_device
);
334 void ieee802154_unregister_device(struct ieee802154_dev
*dev
)
336 struct mac802154_priv
*priv
= mac802154_to_priv(dev
);
337 struct mac802154_sub_if_data
*sdata
, *next
;
339 flush_workqueue(priv
->dev_workqueue
);
340 destroy_workqueue(priv
->dev_workqueue
);
344 mutex_lock(&priv
->slaves_mtx
);
345 priv
->running
= MAC802154_DEVICE_STOPPED
;
346 mutex_unlock(&priv
->slaves_mtx
);
348 list_for_each_entry_safe(sdata
, next
, &priv
->slaves
, list
) {
349 mutex_lock(&sdata
->hw
->slaves_mtx
);
350 list_del(&sdata
->list
);
351 mutex_unlock(&sdata
->hw
->slaves_mtx
);
353 unregister_netdevice(sdata
->dev
);
358 wpan_phy_unregister(priv
->phy
);
360 EXPORT_SYMBOL(ieee802154_unregister_device
);
362 MODULE_DESCRIPTION("IEEE 802.15.4 implementation");
363 MODULE_LICENSE("GPL v2");