1 | // SPDX-License-Identifier: GPL-2.0 |
2 | |
3 | #include <net/macsec.h> |
4 | #include "netdevsim.h" |
5 | |
6 | static int nsim_macsec_find_secy(struct netdevsim *ns, sci_t sci) |
7 | { |
8 | int i; |
9 | |
10 | for (i = 0; i < NSIM_MACSEC_MAX_SECY_COUNT; i++) { |
11 | if (ns->macsec.nsim_secy[i].sci == sci) |
12 | return i; |
13 | } |
14 | |
15 | return -1; |
16 | } |
17 | |
18 | static int nsim_macsec_find_rxsc(struct nsim_secy *ns_secy, sci_t sci) |
19 | { |
20 | int i; |
21 | |
22 | for (i = 0; i < NSIM_MACSEC_MAX_RXSC_COUNT; i++) { |
23 | if (ns_secy->nsim_rxsc[i].sci == sci) |
24 | return i; |
25 | } |
26 | |
27 | return -1; |
28 | } |
29 | |
30 | static int nsim_macsec_add_secy(struct macsec_context *ctx) |
31 | { |
32 | struct netdevsim *ns = netdev_priv(dev: ctx->netdev); |
33 | int idx; |
34 | |
35 | if (ns->macsec.nsim_secy_count == NSIM_MACSEC_MAX_SECY_COUNT) |
36 | return -ENOSPC; |
37 | |
38 | for (idx = 0; idx < NSIM_MACSEC_MAX_SECY_COUNT; idx++) { |
39 | if (!ns->macsec.nsim_secy[idx].used) |
40 | break; |
41 | } |
42 | |
43 | if (idx == NSIM_MACSEC_MAX_SECY_COUNT) { |
44 | netdev_err(dev: ctx->netdev, format: "%s: nsim_secy_count not full but all SecYs used\n" , |
45 | __func__); |
46 | return -ENOSPC; |
47 | } |
48 | |
49 | netdev_dbg(ctx->netdev, "%s: adding new secy with sci %08llx at index %d\n" , |
50 | __func__, sci_to_cpu(ctx->secy->sci), idx); |
51 | ns->macsec.nsim_secy[idx].used = true; |
52 | ns->macsec.nsim_secy[idx].nsim_rxsc_count = 0; |
53 | ns->macsec.nsim_secy[idx].sci = ctx->secy->sci; |
54 | ns->macsec.nsim_secy_count++; |
55 | |
56 | return 0; |
57 | } |
58 | |
59 | static int nsim_macsec_upd_secy(struct macsec_context *ctx) |
60 | { |
61 | struct netdevsim *ns = netdev_priv(dev: ctx->netdev); |
62 | int idx; |
63 | |
64 | idx = nsim_macsec_find_secy(ns, sci: ctx->secy->sci); |
65 | if (idx < 0) { |
66 | netdev_err(dev: ctx->netdev, format: "%s: sci %08llx not found in secy table\n" , |
67 | __func__, sci_to_cpu(sci: ctx->secy->sci)); |
68 | return -ENOENT; |
69 | } |
70 | |
71 | netdev_dbg(ctx->netdev, "%s: updating secy with sci %08llx at index %d\n" , |
72 | __func__, sci_to_cpu(ctx->secy->sci), idx); |
73 | |
74 | return 0; |
75 | } |
76 | |
77 | static int nsim_macsec_del_secy(struct macsec_context *ctx) |
78 | { |
79 | struct netdevsim *ns = netdev_priv(dev: ctx->netdev); |
80 | int idx; |
81 | |
82 | idx = nsim_macsec_find_secy(ns, sci: ctx->secy->sci); |
83 | if (idx < 0) { |
84 | netdev_err(dev: ctx->netdev, format: "%s: sci %08llx not found in secy table\n" , |
85 | __func__, sci_to_cpu(sci: ctx->secy->sci)); |
86 | return -ENOENT; |
87 | } |
88 | |
89 | netdev_dbg(ctx->netdev, "%s: removing SecY with SCI %08llx at index %d\n" , |
90 | __func__, sci_to_cpu(ctx->secy->sci), idx); |
91 | |
92 | ns->macsec.nsim_secy[idx].used = false; |
93 | memset(&ns->macsec.nsim_secy[idx], 0, sizeof(ns->macsec.nsim_secy[idx])); |
94 | ns->macsec.nsim_secy_count--; |
95 | |
96 | return 0; |
97 | } |
98 | |
99 | static int nsim_macsec_add_rxsc(struct macsec_context *ctx) |
100 | { |
101 | struct netdevsim *ns = netdev_priv(dev: ctx->netdev); |
102 | struct nsim_secy *secy; |
103 | int idx; |
104 | |
105 | idx = nsim_macsec_find_secy(ns, sci: ctx->secy->sci); |
106 | if (idx < 0) { |
107 | netdev_err(dev: ctx->netdev, format: "%s: sci %08llx not found in secy table\n" , |
108 | __func__, sci_to_cpu(sci: ctx->secy->sci)); |
109 | return -ENOENT; |
110 | } |
111 | secy = &ns->macsec.nsim_secy[idx]; |
112 | |
113 | if (secy->nsim_rxsc_count == NSIM_MACSEC_MAX_RXSC_COUNT) |
114 | return -ENOSPC; |
115 | |
116 | for (idx = 0; idx < NSIM_MACSEC_MAX_RXSC_COUNT; idx++) { |
117 | if (!secy->nsim_rxsc[idx].used) |
118 | break; |
119 | } |
120 | |
121 | if (idx == NSIM_MACSEC_MAX_RXSC_COUNT) |
122 | netdev_err(dev: ctx->netdev, format: "%s: nsim_rxsc_count not full but all RXSCs used\n" , |
123 | __func__); |
124 | |
125 | netdev_dbg(ctx->netdev, "%s: adding new rxsc with sci %08llx at index %d\n" , |
126 | __func__, sci_to_cpu(ctx->rx_sc->sci), idx); |
127 | secy->nsim_rxsc[idx].used = true; |
128 | secy->nsim_rxsc[idx].sci = ctx->rx_sc->sci; |
129 | secy->nsim_rxsc_count++; |
130 | |
131 | return 0; |
132 | } |
133 | |
134 | static int nsim_macsec_upd_rxsc(struct macsec_context *ctx) |
135 | { |
136 | struct netdevsim *ns = netdev_priv(dev: ctx->netdev); |
137 | struct nsim_secy *secy; |
138 | int idx; |
139 | |
140 | idx = nsim_macsec_find_secy(ns, sci: ctx->secy->sci); |
141 | if (idx < 0) { |
142 | netdev_err(dev: ctx->netdev, format: "%s: sci %08llx not found in secy table\n" , |
143 | __func__, sci_to_cpu(sci: ctx->secy->sci)); |
144 | return -ENOENT; |
145 | } |
146 | secy = &ns->macsec.nsim_secy[idx]; |
147 | |
148 | idx = nsim_macsec_find_rxsc(ns_secy: secy, sci: ctx->rx_sc->sci); |
149 | if (idx < 0) { |
150 | netdev_err(dev: ctx->netdev, format: "%s: sci %08llx not found in RXSC table\n" , |
151 | __func__, sci_to_cpu(sci: ctx->rx_sc->sci)); |
152 | return -ENOENT; |
153 | } |
154 | |
155 | netdev_dbg(ctx->netdev, "%s: updating RXSC with sci %08llx at index %d\n" , |
156 | __func__, sci_to_cpu(ctx->rx_sc->sci), idx); |
157 | |
158 | return 0; |
159 | } |
160 | |
161 | static int nsim_macsec_del_rxsc(struct macsec_context *ctx) |
162 | { |
163 | struct netdevsim *ns = netdev_priv(dev: ctx->netdev); |
164 | struct nsim_secy *secy; |
165 | int idx; |
166 | |
167 | idx = nsim_macsec_find_secy(ns, sci: ctx->secy->sci); |
168 | if (idx < 0) { |
169 | netdev_err(dev: ctx->netdev, format: "%s: sci %08llx not found in secy table\n" , |
170 | __func__, sci_to_cpu(sci: ctx->secy->sci)); |
171 | return -ENOENT; |
172 | } |
173 | secy = &ns->macsec.nsim_secy[idx]; |
174 | |
175 | idx = nsim_macsec_find_rxsc(ns_secy: secy, sci: ctx->rx_sc->sci); |
176 | if (idx < 0) { |
177 | netdev_err(dev: ctx->netdev, format: "%s: sci %08llx not found in RXSC table\n" , |
178 | __func__, sci_to_cpu(sci: ctx->rx_sc->sci)); |
179 | return -ENOENT; |
180 | } |
181 | |
182 | netdev_dbg(ctx->netdev, "%s: removing RXSC with sci %08llx at index %d\n" , |
183 | __func__, sci_to_cpu(ctx->rx_sc->sci), idx); |
184 | |
185 | secy->nsim_rxsc[idx].used = false; |
186 | memset(&secy->nsim_rxsc[idx], 0, sizeof(secy->nsim_rxsc[idx])); |
187 | secy->nsim_rxsc_count--; |
188 | |
189 | return 0; |
190 | } |
191 | |
192 | static int nsim_macsec_add_rxsa(struct macsec_context *ctx) |
193 | { |
194 | struct netdevsim *ns = netdev_priv(dev: ctx->netdev); |
195 | struct nsim_secy *secy; |
196 | int idx; |
197 | |
198 | idx = nsim_macsec_find_secy(ns, sci: ctx->secy->sci); |
199 | if (idx < 0) { |
200 | netdev_err(dev: ctx->netdev, format: "%s: sci %08llx not found in secy table\n" , |
201 | __func__, sci_to_cpu(sci: ctx->secy->sci)); |
202 | return -ENOENT; |
203 | } |
204 | secy = &ns->macsec.nsim_secy[idx]; |
205 | |
206 | idx = nsim_macsec_find_rxsc(ns_secy: secy, sci: ctx->sa.rx_sa->sc->sci); |
207 | if (idx < 0) { |
208 | netdev_err(dev: ctx->netdev, format: "%s: sci %08llx not found in RXSC table\n" , |
209 | __func__, sci_to_cpu(sci: ctx->sa.rx_sa->sc->sci)); |
210 | return -ENOENT; |
211 | } |
212 | |
213 | netdev_dbg(ctx->netdev, "%s: RXSC with sci %08llx, AN %u\n" , |
214 | __func__, sci_to_cpu(ctx->sa.rx_sa->sc->sci), ctx->sa.assoc_num); |
215 | |
216 | return 0; |
217 | } |
218 | |
219 | static int nsim_macsec_upd_rxsa(struct macsec_context *ctx) |
220 | { |
221 | struct netdevsim *ns = netdev_priv(dev: ctx->netdev); |
222 | struct nsim_secy *secy; |
223 | int idx; |
224 | |
225 | idx = nsim_macsec_find_secy(ns, sci: ctx->secy->sci); |
226 | if (idx < 0) { |
227 | netdev_err(dev: ctx->netdev, format: "%s: sci %08llx not found in secy table\n" , |
228 | __func__, sci_to_cpu(sci: ctx->secy->sci)); |
229 | return -ENOENT; |
230 | } |
231 | secy = &ns->macsec.nsim_secy[idx]; |
232 | |
233 | idx = nsim_macsec_find_rxsc(ns_secy: secy, sci: ctx->sa.rx_sa->sc->sci); |
234 | if (idx < 0) { |
235 | netdev_err(dev: ctx->netdev, format: "%s: sci %08llx not found in RXSC table\n" , |
236 | __func__, sci_to_cpu(sci: ctx->sa.rx_sa->sc->sci)); |
237 | return -ENOENT; |
238 | } |
239 | |
240 | netdev_dbg(ctx->netdev, "%s: RXSC with sci %08llx, AN %u\n" , |
241 | __func__, sci_to_cpu(ctx->sa.rx_sa->sc->sci), ctx->sa.assoc_num); |
242 | |
243 | return 0; |
244 | } |
245 | |
246 | static int nsim_macsec_del_rxsa(struct macsec_context *ctx) |
247 | { |
248 | struct netdevsim *ns = netdev_priv(dev: ctx->netdev); |
249 | struct nsim_secy *secy; |
250 | int idx; |
251 | |
252 | idx = nsim_macsec_find_secy(ns, sci: ctx->secy->sci); |
253 | if (idx < 0) { |
254 | netdev_err(dev: ctx->netdev, format: "%s: sci %08llx not found in secy table\n" , |
255 | __func__, sci_to_cpu(sci: ctx->secy->sci)); |
256 | return -ENOENT; |
257 | } |
258 | secy = &ns->macsec.nsim_secy[idx]; |
259 | |
260 | idx = nsim_macsec_find_rxsc(ns_secy: secy, sci: ctx->sa.rx_sa->sc->sci); |
261 | if (idx < 0) { |
262 | netdev_err(dev: ctx->netdev, format: "%s: sci %08llx not found in RXSC table\n" , |
263 | __func__, sci_to_cpu(sci: ctx->sa.rx_sa->sc->sci)); |
264 | return -ENOENT; |
265 | } |
266 | |
267 | netdev_dbg(ctx->netdev, "%s: RXSC with sci %08llx, AN %u\n" , |
268 | __func__, sci_to_cpu(ctx->sa.rx_sa->sc->sci), ctx->sa.assoc_num); |
269 | |
270 | return 0; |
271 | } |
272 | |
273 | static int nsim_macsec_add_txsa(struct macsec_context *ctx) |
274 | { |
275 | struct netdevsim *ns = netdev_priv(dev: ctx->netdev); |
276 | int idx; |
277 | |
278 | idx = nsim_macsec_find_secy(ns, sci: ctx->secy->sci); |
279 | if (idx < 0) { |
280 | netdev_err(dev: ctx->netdev, format: "%s: sci %08llx not found in secy table\n" , |
281 | __func__, sci_to_cpu(sci: ctx->secy->sci)); |
282 | return -ENOENT; |
283 | } |
284 | |
285 | netdev_dbg(ctx->netdev, "%s: SECY with sci %08llx, AN %u\n" , |
286 | __func__, sci_to_cpu(ctx->secy->sci), ctx->sa.assoc_num); |
287 | |
288 | return 0; |
289 | } |
290 | |
291 | static int nsim_macsec_upd_txsa(struct macsec_context *ctx) |
292 | { |
293 | struct netdevsim *ns = netdev_priv(dev: ctx->netdev); |
294 | int idx; |
295 | |
296 | idx = nsim_macsec_find_secy(ns, sci: ctx->secy->sci); |
297 | if (idx < 0) { |
298 | netdev_err(dev: ctx->netdev, format: "%s: sci %08llx not found in secy table\n" , |
299 | __func__, sci_to_cpu(sci: ctx->secy->sci)); |
300 | return -ENOENT; |
301 | } |
302 | |
303 | netdev_dbg(ctx->netdev, "%s: SECY with sci %08llx, AN %u\n" , |
304 | __func__, sci_to_cpu(ctx->secy->sci), ctx->sa.assoc_num); |
305 | |
306 | return 0; |
307 | } |
308 | |
309 | static int nsim_macsec_del_txsa(struct macsec_context *ctx) |
310 | { |
311 | struct netdevsim *ns = netdev_priv(dev: ctx->netdev); |
312 | int idx; |
313 | |
314 | idx = nsim_macsec_find_secy(ns, sci: ctx->secy->sci); |
315 | if (idx < 0) { |
316 | netdev_err(dev: ctx->netdev, format: "%s: sci %08llx not found in secy table\n" , |
317 | __func__, sci_to_cpu(sci: ctx->secy->sci)); |
318 | return -ENOENT; |
319 | } |
320 | |
321 | netdev_dbg(ctx->netdev, "%s: SECY with sci %08llx, AN %u\n" , |
322 | __func__, sci_to_cpu(ctx->secy->sci), ctx->sa.assoc_num); |
323 | |
324 | return 0; |
325 | } |
326 | |
327 | static const struct macsec_ops nsim_macsec_ops = { |
328 | .mdo_add_secy = nsim_macsec_add_secy, |
329 | .mdo_upd_secy = nsim_macsec_upd_secy, |
330 | .mdo_del_secy = nsim_macsec_del_secy, |
331 | .mdo_add_rxsc = nsim_macsec_add_rxsc, |
332 | .mdo_upd_rxsc = nsim_macsec_upd_rxsc, |
333 | .mdo_del_rxsc = nsim_macsec_del_rxsc, |
334 | .mdo_add_rxsa = nsim_macsec_add_rxsa, |
335 | .mdo_upd_rxsa = nsim_macsec_upd_rxsa, |
336 | .mdo_del_rxsa = nsim_macsec_del_rxsa, |
337 | .mdo_add_txsa = nsim_macsec_add_txsa, |
338 | .mdo_upd_txsa = nsim_macsec_upd_txsa, |
339 | .mdo_del_txsa = nsim_macsec_del_txsa, |
340 | }; |
341 | |
342 | void nsim_macsec_init(struct netdevsim *ns) |
343 | { |
344 | ns->netdev->macsec_ops = &nsim_macsec_ops; |
345 | ns->netdev->features |= NETIF_F_HW_MACSEC; |
346 | memset(&ns->macsec, 0, sizeof(ns->macsec)); |
347 | } |
348 | |
349 | void nsim_macsec_teardown(struct netdevsim *ns) |
350 | { |
351 | } |
352 | |