]>
Commit | Line | Data |
---|---|---|
ef2486f5 | 1 | /* |
2 | * Copyright 2007-2012 Siemens AG | |
3 | * | |
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. | |
7 | * | |
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. | |
12 | * | |
ef2486f5 | 13 | * Written by: |
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> | |
18 | */ | |
19 | ||
20 | #include <linux/if_arp.h> | |
21 | ||
22 | #include <net/mac802154.h> | |
b70ab2e8 | 23 | #include <net/ieee802154_netdev.h> |
5ad60d36 | 24 | #include <net/cfg802154.h> |
ef2486f5 | 25 | |
0f1556bc | 26 | #include "ieee802154_i.h" |
ef2486f5 | 27 | |
66b69d4d | 28 | struct phy_chan_notify_work { |
29 | struct work_struct work; | |
30 | struct net_device *dev; | |
31 | }; | |
32 | ||
ef2486f5 | 33 | struct hw_addr_filt_notify_work { |
34 | struct work_struct work; | |
35 | struct net_device *dev; | |
36 | unsigned long changed; | |
37 | }; | |
38 | ||
a5e1ec53 | 39 | static struct ieee802154_local *mac802154_slave_get_priv(struct net_device *dev) |
ef2486f5 | 40 | { |
036562f9 | 41 | struct ieee802154_sub_if_data *sdata = netdev_priv(dev); |
ef2486f5 | 42 | |
43 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
44 | ||
04e850fe | 45 | return sdata->local; |
ef2486f5 | 46 | } |
47 | ||
48 | static void hw_addr_notify(struct work_struct *work) | |
49 | { | |
50 | struct hw_addr_filt_notify_work *nw = container_of(work, | |
51 | struct hw_addr_filt_notify_work, work); | |
a5e1ec53 | 52 | struct ieee802154_local *local = mac802154_slave_get_priv(nw->dev); |
ef2486f5 | 53 | int res; |
54 | ||
a5e1ec53 AA |
55 | res = local->ops->set_hw_addr_filt(&local->hw, &local->hw.hw_filt, |
56 | nw->changed); | |
ef2486f5 | 57 | if (res) |
58 | pr_debug("failed changed mask %lx\n", nw->changed); | |
59 | ||
60 | kfree(nw); | |
ef2486f5 | 61 | } |
62 | ||
63 | static void set_hw_addr_filt(struct net_device *dev, unsigned long changed) | |
64 | { | |
036562f9 | 65 | struct ieee802154_sub_if_data *sdata = netdev_priv(dev); |
ef2486f5 | 66 | struct hw_addr_filt_notify_work *work; |
67 | ||
68 | work = kzalloc(sizeof(*work), GFP_ATOMIC); | |
69 | if (!work) | |
70 | return; | |
71 | ||
72 | INIT_WORK(&work->work, hw_addr_notify); | |
73 | work->dev = dev; | |
74 | work->changed = changed; | |
04e850fe | 75 | queue_work(sdata->local->dev_workqueue, &work->work); |
ef2486f5 | 76 | } |
77 | ||
b70ab2e8 | 78 | void mac802154_dev_set_short_addr(struct net_device *dev, __le16 val) |
48e44d50 | 79 | { |
036562f9 | 80 | struct ieee802154_sub_if_data *sdata = netdev_priv(dev); |
48e44d50 | 81 | |
82 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
83 | ||
036562f9 AA |
84 | spin_lock_bh(&sdata->mib_lock); |
85 | sdata->short_addr = val; | |
86 | spin_unlock_bh(&sdata->mib_lock); | |
48e44d50 | 87 | |
04e850fe AA |
88 | if ((sdata->local->ops->set_hw_addr_filt) && |
89 | (sdata->local->hw.hw_filt.short_addr != sdata->short_addr)) { | |
90 | sdata->local->hw.hw_filt.short_addr = sdata->short_addr; | |
57205c14 | 91 | set_hw_addr_filt(dev, IEEE802154_AFILT_SADDR_CHANGED); |
48e44d50 | 92 | } |
93 | } | |
94 | ||
b70ab2e8 | 95 | __le16 mac802154_dev_get_short_addr(const struct net_device *dev) |
e885a47a | 96 | { |
036562f9 | 97 | struct ieee802154_sub_if_data *sdata = netdev_priv(dev); |
b70ab2e8 | 98 | __le16 ret; |
e885a47a | 99 | |
100 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
101 | ||
036562f9 AA |
102 | spin_lock_bh(&sdata->mib_lock); |
103 | ret = sdata->short_addr; | |
104 | spin_unlock_bh(&sdata->mib_lock); | |
e885a47a | 105 | |
106 | return ret; | |
107 | } | |
108 | ||
ef2486f5 | 109 | void mac802154_dev_set_ieee_addr(struct net_device *dev) |
110 | { | |
036562f9 | 111 | struct ieee802154_sub_if_data *sdata = netdev_priv(dev); |
04e850fe | 112 | struct ieee802154_local *local = sdata->local; |
ef2486f5 | 113 | |
036562f9 | 114 | sdata->extended_addr = ieee802154_devaddr_from_raw(dev->dev_addr); |
b70ab2e8 | 115 | |
a5e1ec53 | 116 | if (local->ops->set_hw_addr_filt && |
036562f9 AA |
117 | local->hw.hw_filt.ieee_addr != sdata->extended_addr) { |
118 | local->hw.hw_filt.ieee_addr = sdata->extended_addr; | |
57205c14 | 119 | set_hw_addr_filt(dev, IEEE802154_AFILT_IEEEADDR_CHANGED); |
ef2486f5 | 120 | } |
121 | } | |
dcbe4f93 | 122 | |
b70ab2e8 | 123 | __le16 mac802154_dev_get_pan_id(const struct net_device *dev) |
dcbe4f93 | 124 | { |
036562f9 | 125 | struct ieee802154_sub_if_data *sdata = netdev_priv(dev); |
b70ab2e8 | 126 | __le16 ret; |
dcbe4f93 | 127 | |
128 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
129 | ||
036562f9 AA |
130 | spin_lock_bh(&sdata->mib_lock); |
131 | ret = sdata->pan_id; | |
132 | spin_unlock_bh(&sdata->mib_lock); | |
dcbe4f93 | 133 | |
134 | return ret; | |
135 | } | |
136 | ||
b70ab2e8 | 137 | void mac802154_dev_set_pan_id(struct net_device *dev, __le16 val) |
dcbe4f93 | 138 | { |
036562f9 | 139 | struct ieee802154_sub_if_data *sdata = netdev_priv(dev); |
dcbe4f93 | 140 | |
141 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
142 | ||
036562f9 AA |
143 | spin_lock_bh(&sdata->mib_lock); |
144 | sdata->pan_id = val; | |
145 | spin_unlock_bh(&sdata->mib_lock); | |
dcbe4f93 | 146 | |
04e850fe AA |
147 | if ((sdata->local->ops->set_hw_addr_filt) && |
148 | (sdata->local->hw.hw_filt.pan_id != sdata->pan_id)) { | |
149 | sdata->local->hw.hw_filt.pan_id = sdata->pan_id; | |
57205c14 | 150 | set_hw_addr_filt(dev, IEEE802154_AFILT_PANID_CHANGED); |
dcbe4f93 | 151 | } |
152 | } | |
66b69d4d | 153 | |
0483546a TC |
154 | u8 mac802154_dev_get_dsn(const struct net_device *dev) |
155 | { | |
036562f9 | 156 | struct ieee802154_sub_if_data *sdata = netdev_priv(dev); |
0483546a TC |
157 | |
158 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
159 | ||
036562f9 | 160 | return sdata->dsn++; |
0483546a TC |
161 | } |
162 | ||
66b69d4d | 163 | static void phy_chan_notify(struct work_struct *work) |
164 | { | |
165 | struct phy_chan_notify_work *nw = container_of(work, | |
166 | struct phy_chan_notify_work, work); | |
a5e1ec53 | 167 | struct ieee802154_local *local = mac802154_slave_get_priv(nw->dev); |
036562f9 | 168 | struct ieee802154_sub_if_data *sdata = netdev_priv(nw->dev); |
66b69d4d | 169 | int res; |
170 | ||
04e850fe | 171 | mutex_lock(&sdata->local->phy->pib_lock); |
036562f9 | 172 | res = local->ops->set_channel(&local->hw, sdata->page, sdata->chan); |
4710d806 | 173 | if (res) { |
66b69d4d | 174 | pr_debug("set_channel failed\n"); |
4710d806 | 175 | } else { |
04e850fe AA |
176 | sdata->local->phy->current_channel = sdata->chan; |
177 | sdata->local->phy->current_page = sdata->page; | |
9f7f78b4 | 178 | } |
04e850fe | 179 | mutex_unlock(&sdata->local->phy->pib_lock); |
66b69d4d | 180 | |
181 | kfree(nw); | |
182 | } | |
183 | ||
184 | void mac802154_dev_set_page_channel(struct net_device *dev, u8 page, u8 chan) | |
185 | { | |
036562f9 | 186 | struct ieee802154_sub_if_data *sdata = netdev_priv(dev); |
66b69d4d | 187 | struct phy_chan_notify_work *work; |
188 | ||
189 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
190 | ||
036562f9 AA |
191 | spin_lock_bh(&sdata->mib_lock); |
192 | sdata->page = page; | |
193 | sdata->chan = chan; | |
194 | spin_unlock_bh(&sdata->mib_lock); | |
66b69d4d | 195 | |
04e850fe AA |
196 | mutex_lock(&sdata->local->phy->pib_lock); |
197 | if (sdata->local->phy->current_channel != sdata->chan || | |
198 | sdata->local->phy->current_page != sdata->page) { | |
199 | mutex_unlock(&sdata->local->phy->pib_lock); | |
9f7f78b4 | 200 | |
66b69d4d | 201 | work = kzalloc(sizeof(*work), GFP_ATOMIC); |
202 | if (!work) | |
203 | return; | |
204 | ||
205 | INIT_WORK(&work->work, phy_chan_notify); | |
206 | work->dev = dev; | |
04e850fe | 207 | queue_work(sdata->local->dev_workqueue, &work->work); |
4710d806 | 208 | } else { |
04e850fe | 209 | mutex_unlock(&sdata->local->phy->pib_lock); |
4710d806 | 210 | } |
66b69d4d | 211 | } |
29e02374 PB |
212 | |
213 | ||
214 | int mac802154_get_params(struct net_device *dev, | |
215 | struct ieee802154_llsec_params *params) | |
216 | { | |
036562f9 | 217 | struct ieee802154_sub_if_data *sdata = netdev_priv(dev); |
29e02374 PB |
218 | int res; |
219 | ||
220 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
221 | ||
036562f9 AA |
222 | mutex_lock(&sdata->sec_mtx); |
223 | res = mac802154_llsec_get_params(&sdata->sec, params); | |
224 | mutex_unlock(&sdata->sec_mtx); | |
29e02374 PB |
225 | |
226 | return res; | |
227 | } | |
228 | ||
229 | int mac802154_set_params(struct net_device *dev, | |
230 | const struct ieee802154_llsec_params *params, | |
231 | int changed) | |
232 | { | |
036562f9 | 233 | struct ieee802154_sub_if_data *sdata = netdev_priv(dev); |
29e02374 PB |
234 | int res; |
235 | ||
236 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
237 | ||
036562f9 AA |
238 | mutex_lock(&sdata->sec_mtx); |
239 | res = mac802154_llsec_set_params(&sdata->sec, params, changed); | |
240 | mutex_unlock(&sdata->sec_mtx); | |
29e02374 PB |
241 | |
242 | return res; | |
243 | } | |
244 | ||
245 | ||
246 | int mac802154_add_key(struct net_device *dev, | |
247 | const struct ieee802154_llsec_key_id *id, | |
248 | const struct ieee802154_llsec_key *key) | |
249 | { | |
036562f9 | 250 | struct ieee802154_sub_if_data *sdata = netdev_priv(dev); |
29e02374 PB |
251 | int res; |
252 | ||
253 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
254 | ||
036562f9 AA |
255 | mutex_lock(&sdata->sec_mtx); |
256 | res = mac802154_llsec_key_add(&sdata->sec, id, key); | |
257 | mutex_unlock(&sdata->sec_mtx); | |
29e02374 PB |
258 | |
259 | return res; | |
260 | } | |
261 | ||
262 | int mac802154_del_key(struct net_device *dev, | |
263 | const struct ieee802154_llsec_key_id *id) | |
264 | { | |
036562f9 | 265 | struct ieee802154_sub_if_data *sdata = netdev_priv(dev); |
29e02374 PB |
266 | int res; |
267 | ||
268 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
269 | ||
036562f9 AA |
270 | mutex_lock(&sdata->sec_mtx); |
271 | res = mac802154_llsec_key_del(&sdata->sec, id); | |
272 | mutex_unlock(&sdata->sec_mtx); | |
29e02374 PB |
273 | |
274 | return res; | |
275 | } | |
276 | ||
277 | ||
278 | int mac802154_add_dev(struct net_device *dev, | |
279 | const struct ieee802154_llsec_device *llsec_dev) | |
280 | { | |
036562f9 | 281 | struct ieee802154_sub_if_data *sdata = netdev_priv(dev); |
29e02374 PB |
282 | int res; |
283 | ||
284 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
285 | ||
036562f9 AA |
286 | mutex_lock(&sdata->sec_mtx); |
287 | res = mac802154_llsec_dev_add(&sdata->sec, llsec_dev); | |
288 | mutex_unlock(&sdata->sec_mtx); | |
29e02374 PB |
289 | |
290 | return res; | |
291 | } | |
292 | ||
293 | int mac802154_del_dev(struct net_device *dev, __le64 dev_addr) | |
294 | { | |
036562f9 | 295 | struct ieee802154_sub_if_data *sdata = netdev_priv(dev); |
29e02374 PB |
296 | int res; |
297 | ||
298 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
299 | ||
036562f9 AA |
300 | mutex_lock(&sdata->sec_mtx); |
301 | res = mac802154_llsec_dev_del(&sdata->sec, dev_addr); | |
302 | mutex_unlock(&sdata->sec_mtx); | |
29e02374 PB |
303 | |
304 | return res; | |
305 | } | |
306 | ||
307 | ||
308 | int mac802154_add_devkey(struct net_device *dev, | |
309 | __le64 device_addr, | |
310 | const struct ieee802154_llsec_device_key *key) | |
311 | { | |
036562f9 | 312 | struct ieee802154_sub_if_data *sdata = netdev_priv(dev); |
29e02374 PB |
313 | int res; |
314 | ||
315 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
316 | ||
036562f9 AA |
317 | mutex_lock(&sdata->sec_mtx); |
318 | res = mac802154_llsec_devkey_add(&sdata->sec, device_addr, key); | |
319 | mutex_unlock(&sdata->sec_mtx); | |
29e02374 PB |
320 | |
321 | return res; | |
322 | } | |
323 | ||
324 | int mac802154_del_devkey(struct net_device *dev, | |
325 | __le64 device_addr, | |
326 | const struct ieee802154_llsec_device_key *key) | |
327 | { | |
036562f9 | 328 | struct ieee802154_sub_if_data *sdata = netdev_priv(dev); |
29e02374 PB |
329 | int res; |
330 | ||
331 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
332 | ||
036562f9 AA |
333 | mutex_lock(&sdata->sec_mtx); |
334 | res = mac802154_llsec_devkey_del(&sdata->sec, device_addr, key); | |
335 | mutex_unlock(&sdata->sec_mtx); | |
29e02374 PB |
336 | |
337 | return res; | |
338 | } | |
339 | ||
340 | ||
341 | int mac802154_add_seclevel(struct net_device *dev, | |
342 | const struct ieee802154_llsec_seclevel *sl) | |
343 | { | |
036562f9 | 344 | struct ieee802154_sub_if_data *sdata = netdev_priv(dev); |
29e02374 PB |
345 | int res; |
346 | ||
347 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
348 | ||
036562f9 AA |
349 | mutex_lock(&sdata->sec_mtx); |
350 | res = mac802154_llsec_seclevel_add(&sdata->sec, sl); | |
351 | mutex_unlock(&sdata->sec_mtx); | |
29e02374 PB |
352 | |
353 | return res; | |
354 | } | |
355 | ||
356 | int mac802154_del_seclevel(struct net_device *dev, | |
357 | const struct ieee802154_llsec_seclevel *sl) | |
358 | { | |
036562f9 | 359 | struct ieee802154_sub_if_data *sdata = netdev_priv(dev); |
29e02374 PB |
360 | int res; |
361 | ||
362 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
363 | ||
036562f9 AA |
364 | mutex_lock(&sdata->sec_mtx); |
365 | res = mac802154_llsec_seclevel_del(&sdata->sec, sl); | |
366 | mutex_unlock(&sdata->sec_mtx); | |
29e02374 PB |
367 | |
368 | return res; | |
369 | } | |
370 | ||
371 | ||
372 | void mac802154_lock_table(struct net_device *dev) | |
373 | { | |
036562f9 | 374 | struct ieee802154_sub_if_data *sdata = netdev_priv(dev); |
29e02374 PB |
375 | |
376 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
377 | ||
036562f9 | 378 | mutex_lock(&sdata->sec_mtx); |
29e02374 PB |
379 | } |
380 | ||
381 | void mac802154_get_table(struct net_device *dev, | |
382 | struct ieee802154_llsec_table **t) | |
383 | { | |
036562f9 | 384 | struct ieee802154_sub_if_data *sdata = netdev_priv(dev); |
29e02374 PB |
385 | |
386 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
387 | ||
036562f9 | 388 | *t = &sdata->sec.table; |
29e02374 PB |
389 | } |
390 | ||
391 | void mac802154_unlock_table(struct net_device *dev) | |
392 | { | |
036562f9 | 393 | struct ieee802154_sub_if_data *sdata = netdev_priv(dev); |
29e02374 PB |
394 | |
395 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
396 | ||
036562f9 | 397 | mutex_unlock(&sdata->sec_mtx); |
29e02374 | 398 | } |