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" |
59cb300f | 27 | #include "driver-ops.h" |
ef2486f5 | 28 | |
b70ab2e8 | 29 | void mac802154_dev_set_short_addr(struct net_device *dev, __le16 val) |
48e44d50 | 30 | { |
59d19cd7 | 31 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
48e44d50 | 32 | |
33 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
34 | ||
036562f9 | 35 | spin_lock_bh(&sdata->mib_lock); |
863e88f2 | 36 | sdata->wpan_dev.short_addr = val; |
036562f9 | 37 | spin_unlock_bh(&sdata->mib_lock); |
48e44d50 | 38 | } |
39 | ||
b70ab2e8 | 40 | __le16 mac802154_dev_get_short_addr(const struct net_device *dev) |
e885a47a | 41 | { |
59d19cd7 | 42 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
b70ab2e8 | 43 | __le16 ret; |
e885a47a | 44 | |
45 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
46 | ||
036562f9 | 47 | spin_lock_bh(&sdata->mib_lock); |
863e88f2 | 48 | ret = sdata->wpan_dev.short_addr; |
036562f9 | 49 | spin_unlock_bh(&sdata->mib_lock); |
e885a47a | 50 | |
51 | return ret; | |
52 | } | |
53 | ||
b70ab2e8 | 54 | __le16 mac802154_dev_get_pan_id(const struct net_device *dev) |
dcbe4f93 | 55 | { |
59d19cd7 | 56 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
b70ab2e8 | 57 | __le16 ret; |
dcbe4f93 | 58 | |
59 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
60 | ||
036562f9 | 61 | spin_lock_bh(&sdata->mib_lock); |
863e88f2 | 62 | ret = sdata->wpan_dev.pan_id; |
036562f9 | 63 | spin_unlock_bh(&sdata->mib_lock); |
dcbe4f93 | 64 | |
65 | return ret; | |
66 | } | |
67 | ||
b70ab2e8 | 68 | void mac802154_dev_set_pan_id(struct net_device *dev, __le16 val) |
dcbe4f93 | 69 | { |
59d19cd7 | 70 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
dcbe4f93 | 71 | |
72 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
73 | ||
036562f9 | 74 | spin_lock_bh(&sdata->mib_lock); |
863e88f2 | 75 | sdata->wpan_dev.pan_id = val; |
036562f9 | 76 | spin_unlock_bh(&sdata->mib_lock); |
dcbe4f93 | 77 | } |
66b69d4d | 78 | |
0483546a TC |
79 | u8 mac802154_dev_get_dsn(const struct net_device *dev) |
80 | { | |
59d19cd7 | 81 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
0483546a TC |
82 | |
83 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
84 | ||
863e88f2 | 85 | return sdata->wpan_dev.dsn++; |
0483546a TC |
86 | } |
87 | ||
66b69d4d | 88 | void mac802154_dev_set_page_channel(struct net_device *dev, u8 page, u8 chan) |
89 | { | |
59d19cd7 | 90 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
12439a53 AA |
91 | struct ieee802154_local *local = sdata->local; |
92 | int res; | |
66b69d4d | 93 | |
94 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
95 | ||
12439a53 AA |
96 | res = drv_set_channel(local, page, chan); |
97 | if (res) { | |
98 | pr_debug("set_channel failed\n"); | |
4710d806 | 99 | } else { |
12439a53 AA |
100 | mutex_lock(&local->phy->pib_lock); |
101 | local->phy->current_channel = chan; | |
102 | local->phy->current_page = page; | |
103 | mutex_unlock(&local->phy->pib_lock); | |
4710d806 | 104 | } |
66b69d4d | 105 | } |
29e02374 | 106 | |
29e02374 PB |
107 | int mac802154_get_params(struct net_device *dev, |
108 | struct ieee802154_llsec_params *params) | |
109 | { | |
59d19cd7 | 110 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
29e02374 PB |
111 | int res; |
112 | ||
113 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
114 | ||
036562f9 AA |
115 | mutex_lock(&sdata->sec_mtx); |
116 | res = mac802154_llsec_get_params(&sdata->sec, params); | |
117 | mutex_unlock(&sdata->sec_mtx); | |
29e02374 PB |
118 | |
119 | return res; | |
120 | } | |
121 | ||
122 | int mac802154_set_params(struct net_device *dev, | |
123 | const struct ieee802154_llsec_params *params, | |
124 | int changed) | |
125 | { | |
59d19cd7 | 126 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
29e02374 PB |
127 | int res; |
128 | ||
129 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
130 | ||
036562f9 AA |
131 | mutex_lock(&sdata->sec_mtx); |
132 | res = mac802154_llsec_set_params(&sdata->sec, params, changed); | |
133 | mutex_unlock(&sdata->sec_mtx); | |
29e02374 PB |
134 | |
135 | return res; | |
136 | } | |
137 | ||
29e02374 PB |
138 | int mac802154_add_key(struct net_device *dev, |
139 | const struct ieee802154_llsec_key_id *id, | |
140 | const struct ieee802154_llsec_key *key) | |
141 | { | |
59d19cd7 | 142 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
29e02374 PB |
143 | int res; |
144 | ||
145 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
146 | ||
036562f9 AA |
147 | mutex_lock(&sdata->sec_mtx); |
148 | res = mac802154_llsec_key_add(&sdata->sec, id, key); | |
149 | mutex_unlock(&sdata->sec_mtx); | |
29e02374 PB |
150 | |
151 | return res; | |
152 | } | |
153 | ||
154 | int mac802154_del_key(struct net_device *dev, | |
155 | const struct ieee802154_llsec_key_id *id) | |
156 | { | |
59d19cd7 | 157 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
29e02374 PB |
158 | int res; |
159 | ||
160 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
161 | ||
036562f9 AA |
162 | mutex_lock(&sdata->sec_mtx); |
163 | res = mac802154_llsec_key_del(&sdata->sec, id); | |
164 | mutex_unlock(&sdata->sec_mtx); | |
29e02374 PB |
165 | |
166 | return res; | |
167 | } | |
168 | ||
29e02374 PB |
169 | int mac802154_add_dev(struct net_device *dev, |
170 | const struct ieee802154_llsec_device *llsec_dev) | |
171 | { | |
59d19cd7 | 172 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
29e02374 PB |
173 | int res; |
174 | ||
175 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
176 | ||
036562f9 AA |
177 | mutex_lock(&sdata->sec_mtx); |
178 | res = mac802154_llsec_dev_add(&sdata->sec, llsec_dev); | |
179 | mutex_unlock(&sdata->sec_mtx); | |
29e02374 PB |
180 | |
181 | return res; | |
182 | } | |
183 | ||
184 | int mac802154_del_dev(struct net_device *dev, __le64 dev_addr) | |
185 | { | |
59d19cd7 | 186 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
29e02374 PB |
187 | int res; |
188 | ||
189 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
190 | ||
036562f9 AA |
191 | mutex_lock(&sdata->sec_mtx); |
192 | res = mac802154_llsec_dev_del(&sdata->sec, dev_addr); | |
193 | mutex_unlock(&sdata->sec_mtx); | |
29e02374 PB |
194 | |
195 | return res; | |
196 | } | |
197 | ||
29e02374 PB |
198 | int mac802154_add_devkey(struct net_device *dev, |
199 | __le64 device_addr, | |
200 | const struct ieee802154_llsec_device_key *key) | |
201 | { | |
59d19cd7 | 202 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
29e02374 PB |
203 | int res; |
204 | ||
205 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
206 | ||
036562f9 AA |
207 | mutex_lock(&sdata->sec_mtx); |
208 | res = mac802154_llsec_devkey_add(&sdata->sec, device_addr, key); | |
209 | mutex_unlock(&sdata->sec_mtx); | |
29e02374 PB |
210 | |
211 | return res; | |
212 | } | |
213 | ||
214 | int mac802154_del_devkey(struct net_device *dev, | |
215 | __le64 device_addr, | |
216 | const struct ieee802154_llsec_device_key *key) | |
217 | { | |
59d19cd7 | 218 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
29e02374 PB |
219 | int res; |
220 | ||
221 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
222 | ||
036562f9 AA |
223 | mutex_lock(&sdata->sec_mtx); |
224 | res = mac802154_llsec_devkey_del(&sdata->sec, device_addr, key); | |
225 | mutex_unlock(&sdata->sec_mtx); | |
29e02374 PB |
226 | |
227 | return res; | |
228 | } | |
229 | ||
29e02374 PB |
230 | int mac802154_add_seclevel(struct net_device *dev, |
231 | const struct ieee802154_llsec_seclevel *sl) | |
232 | { | |
59d19cd7 | 233 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(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_seclevel_add(&sdata->sec, sl); | |
240 | mutex_unlock(&sdata->sec_mtx); | |
29e02374 PB |
241 | |
242 | return res; | |
243 | } | |
244 | ||
245 | int mac802154_del_seclevel(struct net_device *dev, | |
246 | const struct ieee802154_llsec_seclevel *sl) | |
247 | { | |
59d19cd7 | 248 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
29e02374 PB |
249 | int res; |
250 | ||
251 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
252 | ||
036562f9 AA |
253 | mutex_lock(&sdata->sec_mtx); |
254 | res = mac802154_llsec_seclevel_del(&sdata->sec, sl); | |
255 | mutex_unlock(&sdata->sec_mtx); | |
29e02374 PB |
256 | |
257 | return res; | |
258 | } | |
259 | ||
29e02374 PB |
260 | void mac802154_lock_table(struct net_device *dev) |
261 | { | |
59d19cd7 | 262 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
29e02374 PB |
263 | |
264 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
265 | ||
036562f9 | 266 | mutex_lock(&sdata->sec_mtx); |
29e02374 PB |
267 | } |
268 | ||
269 | void mac802154_get_table(struct net_device *dev, | |
270 | struct ieee802154_llsec_table **t) | |
271 | { | |
59d19cd7 | 272 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
29e02374 PB |
273 | |
274 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
275 | ||
036562f9 | 276 | *t = &sdata->sec.table; |
29e02374 PB |
277 | } |
278 | ||
279 | void mac802154_unlock_table(struct net_device *dev) | |
280 | { | |
59d19cd7 | 281 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
29e02374 PB |
282 | |
283 | BUG_ON(dev->type != ARPHRD_IEEE802154); | |
284 | ||
036562f9 | 285 | mutex_unlock(&sdata->sec_mtx); |
29e02374 | 286 | } |