1 | // SPDX-License-Identifier: GPL-2.0-only |
2 | /* |
3 | * Copyright 2007-2012 Siemens AG |
4 | * |
5 | * Written by: |
6 | * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com> |
7 | * Sergey Lapin <slapin@ossfans.org> |
8 | * Maxim Gorbachyov <maxim.gorbachev@siemens.com> |
9 | * Alexander Smirnov <alex.bluesman.smirnov@gmail.com> |
10 | */ |
11 | |
12 | #include <linux/if_arp.h> |
13 | |
14 | #include <net/mac802154.h> |
15 | #include <net/ieee802154_netdev.h> |
16 | #include <net/cfg802154.h> |
17 | |
18 | #include "ieee802154_i.h" |
19 | #include "driver-ops.h" |
20 | |
21 | void mac802154_dev_set_page_channel(struct net_device *dev, u8 page, u8 chan) |
22 | { |
23 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
24 | struct ieee802154_local *local = sdata->local; |
25 | int res; |
26 | |
27 | ASSERT_RTNL(); |
28 | |
29 | BUG_ON(dev->type != ARPHRD_IEEE802154); |
30 | |
31 | res = drv_set_channel(local, page, channel: chan); |
32 | if (res) { |
33 | pr_debug("set_channel failed\n" ); |
34 | } else { |
35 | local->phy->current_channel = chan; |
36 | local->phy->current_page = page; |
37 | } |
38 | } |
39 | |
40 | int mac802154_get_params(struct net_device *dev, |
41 | struct ieee802154_llsec_params *params) |
42 | { |
43 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
44 | int res; |
45 | |
46 | BUG_ON(dev->type != ARPHRD_IEEE802154); |
47 | |
48 | mutex_lock(&sdata->sec_mtx); |
49 | res = mac802154_llsec_get_params(sec: &sdata->sec, params); |
50 | mutex_unlock(lock: &sdata->sec_mtx); |
51 | |
52 | return res; |
53 | } |
54 | |
55 | int mac802154_set_params(struct net_device *dev, |
56 | const struct ieee802154_llsec_params *params, |
57 | int changed) |
58 | { |
59 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
60 | int res; |
61 | |
62 | BUG_ON(dev->type != ARPHRD_IEEE802154); |
63 | |
64 | mutex_lock(&sdata->sec_mtx); |
65 | res = mac802154_llsec_set_params(sec: &sdata->sec, params, changed); |
66 | mutex_unlock(lock: &sdata->sec_mtx); |
67 | |
68 | return res; |
69 | } |
70 | |
71 | int mac802154_add_key(struct net_device *dev, |
72 | const struct ieee802154_llsec_key_id *id, |
73 | const struct ieee802154_llsec_key *key) |
74 | { |
75 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
76 | int res; |
77 | |
78 | BUG_ON(dev->type != ARPHRD_IEEE802154); |
79 | |
80 | mutex_lock(&sdata->sec_mtx); |
81 | res = mac802154_llsec_key_add(sec: &sdata->sec, id, key); |
82 | mutex_unlock(lock: &sdata->sec_mtx); |
83 | |
84 | return res; |
85 | } |
86 | |
87 | int mac802154_del_key(struct net_device *dev, |
88 | const struct ieee802154_llsec_key_id *id) |
89 | { |
90 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
91 | int res; |
92 | |
93 | BUG_ON(dev->type != ARPHRD_IEEE802154); |
94 | |
95 | mutex_lock(&sdata->sec_mtx); |
96 | res = mac802154_llsec_key_del(sec: &sdata->sec, key: id); |
97 | mutex_unlock(lock: &sdata->sec_mtx); |
98 | |
99 | return res; |
100 | } |
101 | |
102 | int mac802154_add_dev(struct net_device *dev, |
103 | const struct ieee802154_llsec_device *llsec_dev) |
104 | { |
105 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
106 | int res; |
107 | |
108 | BUG_ON(dev->type != ARPHRD_IEEE802154); |
109 | |
110 | mutex_lock(&sdata->sec_mtx); |
111 | res = mac802154_llsec_dev_add(sec: &sdata->sec, dev: llsec_dev); |
112 | mutex_unlock(lock: &sdata->sec_mtx); |
113 | |
114 | return res; |
115 | } |
116 | |
117 | int mac802154_del_dev(struct net_device *dev, __le64 dev_addr) |
118 | { |
119 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
120 | int res; |
121 | |
122 | BUG_ON(dev->type != ARPHRD_IEEE802154); |
123 | |
124 | mutex_lock(&sdata->sec_mtx); |
125 | res = mac802154_llsec_dev_del(sec: &sdata->sec, device_addr: dev_addr); |
126 | mutex_unlock(lock: &sdata->sec_mtx); |
127 | |
128 | return res; |
129 | } |
130 | |
131 | int mac802154_add_devkey(struct net_device *dev, |
132 | __le64 device_addr, |
133 | const struct ieee802154_llsec_device_key *key) |
134 | { |
135 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
136 | int res; |
137 | |
138 | BUG_ON(dev->type != ARPHRD_IEEE802154); |
139 | |
140 | mutex_lock(&sdata->sec_mtx); |
141 | res = mac802154_llsec_devkey_add(sec: &sdata->sec, dev_addr: device_addr, key); |
142 | mutex_unlock(lock: &sdata->sec_mtx); |
143 | |
144 | return res; |
145 | } |
146 | |
147 | int mac802154_del_devkey(struct net_device *dev, |
148 | __le64 device_addr, |
149 | const struct ieee802154_llsec_device_key *key) |
150 | { |
151 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
152 | int res; |
153 | |
154 | BUG_ON(dev->type != ARPHRD_IEEE802154); |
155 | |
156 | mutex_lock(&sdata->sec_mtx); |
157 | res = mac802154_llsec_devkey_del(sec: &sdata->sec, dev_addr: device_addr, key); |
158 | mutex_unlock(lock: &sdata->sec_mtx); |
159 | |
160 | return res; |
161 | } |
162 | |
163 | int mac802154_add_seclevel(struct net_device *dev, |
164 | const struct ieee802154_llsec_seclevel *sl) |
165 | { |
166 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
167 | int res; |
168 | |
169 | BUG_ON(dev->type != ARPHRD_IEEE802154); |
170 | |
171 | mutex_lock(&sdata->sec_mtx); |
172 | res = mac802154_llsec_seclevel_add(sec: &sdata->sec, sl); |
173 | mutex_unlock(lock: &sdata->sec_mtx); |
174 | |
175 | return res; |
176 | } |
177 | |
178 | int mac802154_del_seclevel(struct net_device *dev, |
179 | const struct ieee802154_llsec_seclevel *sl) |
180 | { |
181 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
182 | int res; |
183 | |
184 | BUG_ON(dev->type != ARPHRD_IEEE802154); |
185 | |
186 | mutex_lock(&sdata->sec_mtx); |
187 | res = mac802154_llsec_seclevel_del(sec: &sdata->sec, sl); |
188 | mutex_unlock(lock: &sdata->sec_mtx); |
189 | |
190 | return res; |
191 | } |
192 | |
193 | void mac802154_lock_table(struct net_device *dev) |
194 | { |
195 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
196 | |
197 | BUG_ON(dev->type != ARPHRD_IEEE802154); |
198 | |
199 | mutex_lock(&sdata->sec_mtx); |
200 | } |
201 | |
202 | void mac802154_get_table(struct net_device *dev, |
203 | struct ieee802154_llsec_table **t) |
204 | { |
205 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
206 | |
207 | BUG_ON(dev->type != ARPHRD_IEEE802154); |
208 | |
209 | *t = &sdata->sec.table; |
210 | } |
211 | |
212 | void mac802154_unlock_table(struct net_device *dev) |
213 | { |
214 | struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev); |
215 | |
216 | BUG_ON(dev->type != ARPHRD_IEEE802154); |
217 | |
218 | mutex_unlock(lock: &sdata->sec_mtx); |
219 | } |
220 | |