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.
19 #include <linux/kernel.h>
20 #include <linux/module.h>
21 #include <linux/netdevice.h>
23 #include <net/netlink.h>
24 #include <linux/nl802154.h>
25 #include <net/mac802154.h>
26 #include <net/ieee802154_netdev.h>
27 #include <net/route.h>
28 #include <net/cfg802154.h>
30 #include "ieee802154_i.h"
33 static void ieee802154_tasklet_handler(unsigned long data
)
35 struct ieee802154_local
*local
= (struct ieee802154_local
*)data
;
38 while ((skb
= skb_dequeue(&local
->skb_queue
))) {
39 switch (skb
->pkt_type
) {
40 case IEEE802154_RX_MSG
:
41 /* Clear skb->pkt_type in order to not confuse kernel
45 ieee802154_rx(&local
->hw
, skb
);
48 WARN(1, "mac802154: Packet is of unknown type %d\n",
56 struct ieee802154_hw
*
57 ieee802154_alloc_hw(size_t priv_data_len
, const struct ieee802154_ops
*ops
)
60 struct ieee802154_local
*local
;
63 if (!ops
|| !(ops
->xmit_async
|| ops
->xmit_sync
) || !ops
->ed
||
64 !ops
->start
|| !ops
->stop
|| !ops
->set_channel
) {
65 pr_err("undefined IEEE802.15.4 device operations\n");
69 /* Ensure 32-byte alignment of our private data and hw private data.
70 * We use the wpan_phy priv data for both our ieee802154_local and for
71 * the driver's private data
73 * in memory it'll be like this:
75 * +-------------------------+
77 * +-------------------------+
78 * | struct ieee802154_local |
79 * +-------------------------+
80 * | driver's private data |
81 * +-------------------------+
83 * Due to ieee802154 layer isn't aware of driver and MAC structures,
84 * so lets align them here.
87 priv_size
= ALIGN(sizeof(*local
), NETDEV_ALIGN
) + priv_data_len
;
89 phy
= wpan_phy_new(&mac802154_config_ops
, priv_size
);
91 pr_err("failure to allocate master IEEE802.15.4 device\n");
95 phy
->privid
= mac802154_wpan_phy_privid
;
97 local
= wpan_phy_priv(phy
);
99 local
->hw
.phy
= local
->phy
;
100 local
->hw
.priv
= (char *)local
+ ALIGN(sizeof(*local
), NETDEV_ALIGN
);
103 INIT_LIST_HEAD(&local
->interfaces
);
104 mutex_init(&local
->iflist_mtx
);
106 tasklet_init(&local
->tasklet
,
107 ieee802154_tasklet_handler
,
108 (unsigned long)local
);
110 skb_queue_head_init(&local
->skb_queue
);
114 EXPORT_SYMBOL(ieee802154_alloc_hw
);
116 void ieee802154_free_hw(struct ieee802154_hw
*hw
)
118 struct ieee802154_local
*local
= hw_to_local(hw
);
120 BUG_ON(!list_empty(&local
->interfaces
));
122 mutex_destroy(&local
->iflist_mtx
);
124 wpan_phy_free(local
->phy
);
126 EXPORT_SYMBOL(ieee802154_free_hw
);
128 int ieee802154_register_hw(struct ieee802154_hw
*hw
)
130 struct ieee802154_local
*local
= hw_to_local(hw
);
131 struct net_device
*dev
;
135 create_singlethread_workqueue(wpan_phy_name(local
->phy
));
136 if (!local
->workqueue
) {
141 wpan_phy_set_dev(local
->phy
, local
->hw
.parent
);
143 rc
= wpan_phy_register(local
->phy
);
149 dev
= ieee802154_if_add(local
, "wpan%d", NULL
, IEEE802154_DEV_WPAN
);
161 destroy_workqueue(local
->workqueue
);
165 EXPORT_SYMBOL(ieee802154_register_hw
);
167 void ieee802154_unregister_hw(struct ieee802154_hw
*hw
)
169 struct ieee802154_local
*local
= hw_to_local(hw
);
171 tasklet_kill(&local
->tasklet
);
172 flush_workqueue(local
->workqueue
);
173 destroy_workqueue(local
->workqueue
);
177 ieee802154_remove_interfaces(local
);
181 wpan_phy_unregister(local
->phy
);
183 EXPORT_SYMBOL(ieee802154_unregister_hw
);
185 MODULE_DESCRIPTION("IEEE 802.15.4 implementation");
186 MODULE_LICENSE("GPL v2");