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/if_arp.h>
22 #include <net/mac802154.h>
23 #include <net/ieee802154_netdev.h>
24 #include <net/cfg802154.h>
26 #include "ieee802154_i.h"
27 #include "driver-ops.h"
29 struct phy_chan_notify_work {
30 struct work_struct work;
31 struct net_device *dev;
34 struct hw_addr_filt_notify_work {
35 struct work_struct work;
36 struct net_device *dev;
37 unsigned long changed;
40 static struct ieee802154_local *mac802154_slave_get_priv(struct net_device *dev)
42 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
44 BUG_ON(dev->type != ARPHRD_IEEE802154);
49 static void hw_addr_notify(struct work_struct *work)
51 struct hw_addr_filt_notify_work *nw = container_of(work,
52 struct hw_addr_filt_notify_work, work);
53 struct ieee802154_local *local = mac802154_slave_get_priv(nw->dev);
56 res = local->ops->set_hw_addr_filt(&local->hw, &local->hw.hw_filt,
59 pr_debug("failed changed mask %lx\n", nw->changed);
64 static void set_hw_addr_filt(struct net_device *dev, unsigned long changed)
66 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
67 struct hw_addr_filt_notify_work *work;
69 work = kzalloc(sizeof(*work), GFP_ATOMIC);
73 INIT_WORK(&work->work, hw_addr_notify);
75 work->changed = changed;
76 queue_work(sdata->local->workqueue, &work->work);
79 void mac802154_dev_set_short_addr(struct net_device *dev, __le16 val)
81 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
83 BUG_ON(dev->type != ARPHRD_IEEE802154);
85 spin_lock_bh(&sdata->mib_lock);
86 sdata->short_addr = val;
87 spin_unlock_bh(&sdata->mib_lock);
89 if ((sdata->local->ops->set_hw_addr_filt) &&
90 (sdata->local->hw.hw_filt.short_addr != sdata->short_addr)) {
91 sdata->local->hw.hw_filt.short_addr = sdata->short_addr;
92 set_hw_addr_filt(dev, IEEE802154_AFILT_SADDR_CHANGED);
96 __le16 mac802154_dev_get_short_addr(const struct net_device *dev)
98 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
101 BUG_ON(dev->type != ARPHRD_IEEE802154);
103 spin_lock_bh(&sdata->mib_lock);
104 ret = sdata->short_addr;
105 spin_unlock_bh(&sdata->mib_lock);
110 void mac802154_dev_set_ieee_addr(struct net_device *dev)
112 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
113 struct ieee802154_local *local = sdata->local;
115 sdata->extended_addr = ieee802154_devaddr_from_raw(dev->dev_addr);
117 if (local->ops->set_hw_addr_filt &&
118 local->hw.hw_filt.ieee_addr != sdata->extended_addr) {
119 local->hw.hw_filt.ieee_addr = sdata->extended_addr;
120 set_hw_addr_filt(dev, IEEE802154_AFILT_IEEEADDR_CHANGED);
124 __le16 mac802154_dev_get_pan_id(const struct net_device *dev)
126 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
129 BUG_ON(dev->type != ARPHRD_IEEE802154);
131 spin_lock_bh(&sdata->mib_lock);
133 spin_unlock_bh(&sdata->mib_lock);
138 void mac802154_dev_set_pan_id(struct net_device *dev, __le16 val)
140 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
142 BUG_ON(dev->type != ARPHRD_IEEE802154);
144 spin_lock_bh(&sdata->mib_lock);
146 spin_unlock_bh(&sdata->mib_lock);
148 if ((sdata->local->ops->set_hw_addr_filt) &&
149 (sdata->local->hw.hw_filt.pan_id != sdata->pan_id)) {
150 sdata->local->hw.hw_filt.pan_id = sdata->pan_id;
151 set_hw_addr_filt(dev, IEEE802154_AFILT_PANID_CHANGED);
155 u8 mac802154_dev_get_dsn(const struct net_device *dev)
157 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
159 BUG_ON(dev->type != ARPHRD_IEEE802154);
164 static void phy_chan_notify(struct work_struct *work)
166 struct phy_chan_notify_work *nw = container_of(work,
167 struct phy_chan_notify_work, work);
168 struct net_device *dev = nw->dev;
169 struct ieee802154_local *local = mac802154_slave_get_priv(dev);
170 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
173 mutex_lock(&sdata->local->phy->pib_lock);
174 res = drv_set_channel(local, sdata->page, sdata->chan);
176 pr_debug("set_channel failed\n");
178 sdata->local->phy->current_channel = sdata->chan;
179 sdata->local->phy->current_page = sdata->page;
181 mutex_unlock(&sdata->local->phy->pib_lock);
186 void mac802154_dev_set_page_channel(struct net_device *dev, u8 page, u8 chan)
188 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
189 struct phy_chan_notify_work *work;
191 BUG_ON(dev->type != ARPHRD_IEEE802154);
193 spin_lock_bh(&sdata->mib_lock);
196 spin_unlock_bh(&sdata->mib_lock);
198 mutex_lock(&sdata->local->phy->pib_lock);
199 if (sdata->local->phy->current_channel != sdata->chan ||
200 sdata->local->phy->current_page != sdata->page) {
201 mutex_unlock(&sdata->local->phy->pib_lock);
203 work = kzalloc(sizeof(*work), GFP_ATOMIC);
207 INIT_WORK(&work->work, phy_chan_notify);
209 queue_work(sdata->local->workqueue, &work->work);
211 mutex_unlock(&sdata->local->phy->pib_lock);
216 int mac802154_get_params(struct net_device *dev,
217 struct ieee802154_llsec_params *params)
219 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
222 BUG_ON(dev->type != ARPHRD_IEEE802154);
224 mutex_lock(&sdata->sec_mtx);
225 res = mac802154_llsec_get_params(&sdata->sec, params);
226 mutex_unlock(&sdata->sec_mtx);
231 int mac802154_set_params(struct net_device *dev,
232 const struct ieee802154_llsec_params *params,
235 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
238 BUG_ON(dev->type != ARPHRD_IEEE802154);
240 mutex_lock(&sdata->sec_mtx);
241 res = mac802154_llsec_set_params(&sdata->sec, params, changed);
242 mutex_unlock(&sdata->sec_mtx);
248 int mac802154_add_key(struct net_device *dev,
249 const struct ieee802154_llsec_key_id *id,
250 const struct ieee802154_llsec_key *key)
252 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
255 BUG_ON(dev->type != ARPHRD_IEEE802154);
257 mutex_lock(&sdata->sec_mtx);
258 res = mac802154_llsec_key_add(&sdata->sec, id, key);
259 mutex_unlock(&sdata->sec_mtx);
264 int mac802154_del_key(struct net_device *dev,
265 const struct ieee802154_llsec_key_id *id)
267 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
270 BUG_ON(dev->type != ARPHRD_IEEE802154);
272 mutex_lock(&sdata->sec_mtx);
273 res = mac802154_llsec_key_del(&sdata->sec, id);
274 mutex_unlock(&sdata->sec_mtx);
280 int mac802154_add_dev(struct net_device *dev,
281 const struct ieee802154_llsec_device *llsec_dev)
283 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
286 BUG_ON(dev->type != ARPHRD_IEEE802154);
288 mutex_lock(&sdata->sec_mtx);
289 res = mac802154_llsec_dev_add(&sdata->sec, llsec_dev);
290 mutex_unlock(&sdata->sec_mtx);
295 int mac802154_del_dev(struct net_device *dev, __le64 dev_addr)
297 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
300 BUG_ON(dev->type != ARPHRD_IEEE802154);
302 mutex_lock(&sdata->sec_mtx);
303 res = mac802154_llsec_dev_del(&sdata->sec, dev_addr);
304 mutex_unlock(&sdata->sec_mtx);
310 int mac802154_add_devkey(struct net_device *dev,
312 const struct ieee802154_llsec_device_key *key)
314 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
317 BUG_ON(dev->type != ARPHRD_IEEE802154);
319 mutex_lock(&sdata->sec_mtx);
320 res = mac802154_llsec_devkey_add(&sdata->sec, device_addr, key);
321 mutex_unlock(&sdata->sec_mtx);
326 int mac802154_del_devkey(struct net_device *dev,
328 const struct ieee802154_llsec_device_key *key)
330 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
333 BUG_ON(dev->type != ARPHRD_IEEE802154);
335 mutex_lock(&sdata->sec_mtx);
336 res = mac802154_llsec_devkey_del(&sdata->sec, device_addr, key);
337 mutex_unlock(&sdata->sec_mtx);
343 int mac802154_add_seclevel(struct net_device *dev,
344 const struct ieee802154_llsec_seclevel *sl)
346 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
349 BUG_ON(dev->type != ARPHRD_IEEE802154);
351 mutex_lock(&sdata->sec_mtx);
352 res = mac802154_llsec_seclevel_add(&sdata->sec, sl);
353 mutex_unlock(&sdata->sec_mtx);
358 int mac802154_del_seclevel(struct net_device *dev,
359 const struct ieee802154_llsec_seclevel *sl)
361 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
364 BUG_ON(dev->type != ARPHRD_IEEE802154);
366 mutex_lock(&sdata->sec_mtx);
367 res = mac802154_llsec_seclevel_del(&sdata->sec, sl);
368 mutex_unlock(&sdata->sec_mtx);
374 void mac802154_lock_table(struct net_device *dev)
376 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
378 BUG_ON(dev->type != ARPHRD_IEEE802154);
380 mutex_lock(&sdata->sec_mtx);
383 void mac802154_get_table(struct net_device *dev,
384 struct ieee802154_llsec_table **t)
386 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
388 BUG_ON(dev->type != ARPHRD_IEEE802154);
390 *t = &sdata->sec.table;
393 void mac802154_unlock_table(struct net_device *dev)
395 struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
397 BUG_ON(dev->type != ARPHRD_IEEE802154);
399 mutex_unlock(&sdata->sec_mtx);