1 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2 /* Copyright(c) 2019-2020 Realtek Corporation
3 */
4
5 #include "cam.h"
6 #include "debug.h"
7 #include "fw.h"
8 #include "mac.h"
9
10 static struct sk_buff *
rtw89_cam_get_sec_key_cmd(struct rtw89_dev * rtwdev,struct rtw89_sec_cam_entry * sec_cam,bool ext_key)11 rtw89_cam_get_sec_key_cmd(struct rtw89_dev *rtwdev,
12 struct rtw89_sec_cam_entry *sec_cam,
13 bool ext_key)
14 {
15 struct sk_buff *skb;
16 u32 cmd_len = H2C_SEC_CAM_LEN;
17 u32 key32[4];
18 u8 *cmd;
19 int i, j;
20
21 skb = rtw89_fw_h2c_alloc_skb_with_hdr(cmd_len);
22 if (!skb)
23 return NULL;
24
25 skb_put_zero(skb, cmd_len);
26
27 for (i = 0; i < 4; i++) {
28 j = i * 4;
29 j += ext_key ? 16 : 0;
30 key32[i] = FIELD_PREP(GENMASK(7, 0), sec_cam->key[j + 0]) |
31 FIELD_PREP(GENMASK(15, 8), sec_cam->key[j + 1]) |
32 FIELD_PREP(GENMASK(23, 16), sec_cam->key[j + 2]) |
33 FIELD_PREP(GENMASK(31, 24), sec_cam->key[j + 3]);
34 }
35
36 cmd = skb->data;
37 RTW89_SET_FWCMD_SEC_IDX(cmd, sec_cam->sec_cam_idx + (ext_key ? 1 : 0));
38 RTW89_SET_FWCMD_SEC_OFFSET(cmd, sec_cam->offset);
39 RTW89_SET_FWCMD_SEC_LEN(cmd, sec_cam->len);
40 RTW89_SET_FWCMD_SEC_TYPE(cmd, sec_cam->type);
41 RTW89_SET_FWCMD_SEC_EXT_KEY(cmd, ext_key);
42 RTW89_SET_FWCMD_SEC_SPP_MODE(cmd, sec_cam->spp_mode);
43 RTW89_SET_FWCMD_SEC_KEY0(cmd, key32[0]);
44 RTW89_SET_FWCMD_SEC_KEY1(cmd, key32[1]);
45 RTW89_SET_FWCMD_SEC_KEY2(cmd, key32[2]);
46 RTW89_SET_FWCMD_SEC_KEY3(cmd, key32[3]);
47
48 return skb;
49 }
50
rtw89_cam_send_sec_key_cmd(struct rtw89_dev * rtwdev,struct rtw89_sec_cam_entry * sec_cam)51 static int rtw89_cam_send_sec_key_cmd(struct rtw89_dev *rtwdev,
52 struct rtw89_sec_cam_entry *sec_cam)
53 {
54 struct sk_buff *skb, *ext_skb;
55 int ret;
56
57 skb = rtw89_cam_get_sec_key_cmd(rtwdev, sec_cam, false);
58 if (!skb) {
59 rtw89_err(rtwdev, "failed to get sec key command\n");
60 return -ENOMEM;
61 }
62
63 rtw89_h2c_pkt_set_hdr(rtwdev, skb,
64 FWCMD_TYPE_H2C,
65 H2C_CAT_MAC,
66 H2C_CL_MAC_SEC_CAM,
67 H2C_FUNC_MAC_SEC_UPD, 1, 0,
68 H2C_SEC_CAM_LEN);
69 ret = rtw89_h2c_tx(rtwdev, skb, false);
70 if (ret) {
71 rtw89_err(rtwdev, "failed to send sec key h2c: %d\n", ret);
72 dev_kfree_skb(skb);
73 return ret;
74 }
75
76 if (!sec_cam->ext_key)
77 return 0;
78
79 ext_skb = rtw89_cam_get_sec_key_cmd(rtwdev, sec_cam, true);
80 if (!ext_skb) {
81 rtw89_err(rtwdev, "failed to get ext sec key command\n");
82 return -ENOMEM;
83 }
84
85 rtw89_h2c_pkt_set_hdr(rtwdev, ext_skb,
86 FWCMD_TYPE_H2C,
87 H2C_CAT_MAC,
88 H2C_CL_MAC_SEC_CAM,
89 H2C_FUNC_MAC_SEC_UPD,
90 1, 0, H2C_SEC_CAM_LEN);
91 ret = rtw89_h2c_tx(rtwdev, ext_skb, false);
92 if (ret) {
93 rtw89_err(rtwdev, "failed to send ext sec key h2c: %d\n", ret);
94 dev_kfree_skb(ext_skb);
95 return ret;
96 }
97
98 return 0;
99 }
100
rtw89_cam_get_avail_sec_cam(struct rtw89_dev * rtwdev,u8 * sec_cam_idx,bool ext_key)101 static int rtw89_cam_get_avail_sec_cam(struct rtw89_dev *rtwdev,
102 u8 *sec_cam_idx, bool ext_key)
103 {
104 const struct rtw89_chip_info *chip = rtwdev->chip;
105 struct rtw89_cam_info *cam_info = &rtwdev->cam_info;
106 u8 sec_cam_num = chip->scam_num;
107 u8 idx = 0;
108
109 if (!ext_key) {
110 idx = find_first_zero_bit(cam_info->sec_cam_map, sec_cam_num);
111 if (idx >= sec_cam_num)
112 return -EBUSY;
113
114 set_bit(idx, cam_info->sec_cam_map);
115 *sec_cam_idx = idx;
116
117 return 0;
118 }
119
120 again:
121 idx = find_next_zero_bit(cam_info->sec_cam_map, sec_cam_num, idx);
122 if (idx >= sec_cam_num - 1)
123 return -EBUSY;
124 /* ext keys need two cam entries for 256-bit key */
125 if (test_bit(idx + 1, cam_info->sec_cam_map)) {
126 idx++;
127 goto again;
128 }
129
130 set_bit(idx, cam_info->sec_cam_map);
131 set_bit(idx + 1, cam_info->sec_cam_map);
132 *sec_cam_idx = idx;
133
134 return 0;
135 }
136
rtw89_cam_get_addr_cam_key_idx(struct rtw89_addr_cam_entry * addr_cam,struct rtw89_sec_cam_entry * sec_cam,struct ieee80211_key_conf * key,u8 * key_idx)137 static int rtw89_cam_get_addr_cam_key_idx(struct rtw89_addr_cam_entry *addr_cam,
138 struct rtw89_sec_cam_entry *sec_cam,
139 struct ieee80211_key_conf *key,
140 u8 *key_idx)
141 {
142 u8 idx;
143
144 /* RTW89_ADDR_CAM_SEC_NONE : not enabled
145 * RTW89_ADDR_CAM_SEC_ALL_UNI : 0 - 6 unicast
146 * RTW89_ADDR_CAM_SEC_NORMAL : 0 - 1 unicast, 2 - 4 group, 5 - 6 BIP
147 * RTW89_ADDR_CAM_SEC_4GROUP : 0 - 1 unicast, 2 - 5 group, 6 BIP
148 */
149 switch (addr_cam->sec_ent_mode) {
150 case RTW89_ADDR_CAM_SEC_NONE:
151 return -EINVAL;
152 case RTW89_ADDR_CAM_SEC_ALL_UNI:
153 if (!(key->flags & IEEE80211_KEY_FLAG_PAIRWISE))
154 return -EINVAL;
155 idx = find_first_zero_bit(addr_cam->sec_cam_map,
156 RTW89_SEC_CAM_IN_ADDR_CAM);
157 if (idx >= RTW89_SEC_CAM_IN_ADDR_CAM)
158 return -EBUSY;
159 *key_idx = idx;
160 break;
161 case RTW89_ADDR_CAM_SEC_NORMAL:
162 if (sec_cam->type == RTW89_SEC_KEY_TYPE_BIP_CCMP128) {
163 idx = find_next_zero_bit(addr_cam->sec_cam_map,
164 RTW89_SEC_CAM_IN_ADDR_CAM, 5);
165 if (idx > 6)
166 return -EBUSY;
167 *key_idx = idx;
168 break;
169 }
170
171 if (key->flags & IEEE80211_KEY_FLAG_PAIRWISE) {
172 idx = find_next_zero_bit(addr_cam->sec_cam_map,
173 RTW89_SEC_CAM_IN_ADDR_CAM, 0);
174 if (idx > 1)
175 return -EBUSY;
176 *key_idx = idx;
177 break;
178 }
179
180 /* Group keys */
181 idx = find_next_zero_bit(addr_cam->sec_cam_map,
182 RTW89_SEC_CAM_IN_ADDR_CAM, 2);
183 if (idx > 4)
184 return -EBUSY;
185 *key_idx = idx;
186 break;
187 case RTW89_ADDR_CAM_SEC_4GROUP:
188 if (sec_cam->type == RTW89_SEC_KEY_TYPE_BIP_CCMP128) {
189 if (test_bit(6, addr_cam->sec_cam_map))
190 return -EINVAL;
191 *key_idx = 6;
192 break;
193 }
194
195 if (key->flags & IEEE80211_KEY_FLAG_PAIRWISE) {
196 idx = find_next_zero_bit(addr_cam->sec_cam_map,
197 RTW89_SEC_CAM_IN_ADDR_CAM, 0);
198 if (idx > 1)
199 return -EBUSY;
200 *key_idx = idx;
201 break;
202 }
203
204 /* Group keys */
205 idx = find_next_zero_bit(addr_cam->sec_cam_map,
206 RTW89_SEC_CAM_IN_ADDR_CAM, 2);
207 if (idx > 5)
208 return -EBUSY;
209 *key_idx = idx;
210 break;
211 }
212
213 return 0;
214 }
215
rtw89_cam_attach_sec_cam(struct rtw89_dev * rtwdev,struct ieee80211_vif * vif,struct ieee80211_sta * sta,struct ieee80211_key_conf * key,struct rtw89_sec_cam_entry * sec_cam)216 static int rtw89_cam_attach_sec_cam(struct rtw89_dev *rtwdev,
217 struct ieee80211_vif *vif,
218 struct ieee80211_sta *sta,
219 struct ieee80211_key_conf *key,
220 struct rtw89_sec_cam_entry *sec_cam)
221 {
222 struct rtw89_vif *rtwvif;
223 struct rtw89_addr_cam_entry *addr_cam;
224 u8 key_idx = 0;
225 int ret;
226
227 if (!vif) {
228 rtw89_err(rtwdev, "No iface for adding sec cam\n");
229 return -EINVAL;
230 }
231
232 rtwvif = (struct rtw89_vif *)vif->drv_priv;
233 addr_cam = &rtwvif->addr_cam;
234 ret = rtw89_cam_get_addr_cam_key_idx(addr_cam, sec_cam, key, &key_idx);
235 if (ret) {
236 rtw89_err(rtwdev, "failed to get addr cam key idx %d, %d\n",
237 addr_cam->sec_ent_mode, sec_cam->type);
238 return ret;
239 }
240
241 key->hw_key_idx = key_idx;
242 addr_cam->sec_ent_keyid[key_idx] = key->keyidx;
243 addr_cam->sec_ent[key_idx] = sec_cam->sec_cam_idx;
244 addr_cam->sec_entries[key_idx] = sec_cam;
245 set_bit(key_idx, addr_cam->sec_cam_map);
246 ret = rtw89_fw_h2c_cam(rtwdev, rtwvif);
247 if (ret) {
248 rtw89_err(rtwdev, "failed to update addr cam sec entry: %d\n",
249 ret);
250 clear_bit(key_idx, addr_cam->sec_cam_map);
251 addr_cam->sec_entries[key_idx] = NULL;
252 return ret;
253 }
254
255 return 0;
256 }
257
rtw89_cam_sec_key_install(struct rtw89_dev * rtwdev,struct ieee80211_vif * vif,struct ieee80211_sta * sta,struct ieee80211_key_conf * key,u8 hw_key_type,bool ext_key)258 static int rtw89_cam_sec_key_install(struct rtw89_dev *rtwdev,
259 struct ieee80211_vif *vif,
260 struct ieee80211_sta *sta,
261 struct ieee80211_key_conf *key,
262 u8 hw_key_type, bool ext_key)
263 {
264 struct rtw89_sec_cam_entry *sec_cam = NULL;
265 struct rtw89_cam_info *cam_info = &rtwdev->cam_info;
266 u8 sec_cam_idx;
267 int ret;
268
269 /* maximum key length 256-bit */
270 if (key->keylen > 32) {
271 rtw89_err(rtwdev, "invalid sec key length %d\n", key->keylen);
272 return -EINVAL;
273 }
274
275 ret = rtw89_cam_get_avail_sec_cam(rtwdev, &sec_cam_idx, ext_key);
276 if (ret) {
277 rtw89_warn(rtwdev, "no available sec cam: %d ext: %d\n",
278 ret, ext_key);
279 return ret;
280 }
281
282 sec_cam = kzalloc(sizeof(*sec_cam), GFP_KERNEL);
283 if (!sec_cam) {
284 ret = -ENOMEM;
285 goto err_release_cam;
286 }
287
288 sec_cam->sec_cam_idx = sec_cam_idx;
289 sec_cam->type = hw_key_type;
290 sec_cam->len = RTW89_SEC_CAM_LEN;
291 sec_cam->ext_key = ext_key;
292 memcpy(sec_cam->key, key->key, key->keylen);
293 ret = rtw89_cam_send_sec_key_cmd(rtwdev, sec_cam);
294 if (ret) {
295 rtw89_err(rtwdev, "failed to send sec key cmd: %d\n", ret);
296 goto err_release_cam;
297 }
298
299 /* associate with addr cam */
300 ret = rtw89_cam_attach_sec_cam(rtwdev, vif, sta, key, sec_cam);
301 if (ret) {
302 rtw89_err(rtwdev, "failed to attach sec cam: %d\n", ret);
303 goto err_release_cam;
304 }
305
306 return 0;
307
308 err_release_cam:
309 kfree(sec_cam);
310 clear_bit(sec_cam_idx, cam_info->sec_cam_map);
311 if (ext_key)
312 clear_bit(sec_cam_idx + 1, cam_info->sec_cam_map);
313
314 return ret;
315 }
316
rtw89_cam_sec_key_add(struct rtw89_dev * rtwdev,struct ieee80211_vif * vif,struct ieee80211_sta * sta,struct ieee80211_key_conf * key)317 int rtw89_cam_sec_key_add(struct rtw89_dev *rtwdev,
318 struct ieee80211_vif *vif,
319 struct ieee80211_sta *sta,
320 struct ieee80211_key_conf *key)
321 {
322 u8 hw_key_type;
323 bool ext_key = false;
324 int ret;
325
326 switch (key->cipher) {
327 case WLAN_CIPHER_SUITE_WEP40:
328 hw_key_type = RTW89_SEC_KEY_TYPE_WEP40;
329 break;
330 case WLAN_CIPHER_SUITE_WEP104:
331 hw_key_type = RTW89_SEC_KEY_TYPE_WEP104;
332 break;
333 case WLAN_CIPHER_SUITE_CCMP:
334 hw_key_type = RTW89_SEC_KEY_TYPE_CCMP128;
335 key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX;
336 break;
337 case WLAN_CIPHER_SUITE_CCMP_256:
338 hw_key_type = RTW89_SEC_KEY_TYPE_CCMP256;
339 key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX;
340 ext_key = true;
341 break;
342 case WLAN_CIPHER_SUITE_GCMP:
343 hw_key_type = RTW89_SEC_KEY_TYPE_GCMP128;
344 key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX;
345 break;
346 case WLAN_CIPHER_SUITE_GCMP_256:
347 hw_key_type = RTW89_SEC_KEY_TYPE_GCMP256;
348 key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX;
349 ext_key = true;
350 break;
351 default:
352 return -EOPNOTSUPP;
353 }
354
355 key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
356
357 ret = rtw89_cam_sec_key_install(rtwdev, vif, sta, key, hw_key_type,
358 ext_key);
359 if (ret) {
360 rtw89_err(rtwdev, "failed to install key type %d ext %d: %d\n",
361 hw_key_type, ext_key, ret);
362 return ret;
363 }
364
365 return 0;
366 }
367
rtw89_cam_sec_key_del(struct rtw89_dev * rtwdev,struct ieee80211_vif * vif,struct ieee80211_sta * sta,struct ieee80211_key_conf * key,bool inform_fw)368 int rtw89_cam_sec_key_del(struct rtw89_dev *rtwdev,
369 struct ieee80211_vif *vif,
370 struct ieee80211_sta *sta,
371 struct ieee80211_key_conf *key,
372 bool inform_fw)
373 {
374 struct rtw89_cam_info *cam_info = &rtwdev->cam_info;
375 struct rtw89_vif *rtwvif;
376 struct rtw89_addr_cam_entry *addr_cam;
377 struct rtw89_sec_cam_entry *sec_cam;
378 u8 key_idx = key->hw_key_idx;
379 u8 sec_cam_idx;
380 int ret = 0;
381
382 if (!vif) {
383 rtw89_err(rtwdev, "No iface for deleting sec cam\n");
384 return -EINVAL;
385 }
386
387 rtwvif = (struct rtw89_vif *)vif->drv_priv;
388 addr_cam = &rtwvif->addr_cam;
389 sec_cam = addr_cam->sec_entries[key_idx];
390 if (!sec_cam)
391 return -EINVAL;
392
393 /* detach sec cam from addr cam */
394 clear_bit(key_idx, addr_cam->sec_cam_map);
395 addr_cam->sec_entries[key_idx] = NULL;
396 if (inform_fw) {
397 ret = rtw89_fw_h2c_cam(rtwdev, rtwvif);
398 if (ret)
399 rtw89_err(rtwdev, "failed to update cam del key: %d\n", ret);
400 }
401
402 /* clear valid bit in addr cam will disable sec cam,
403 * so we don't need to send H2C command again
404 */
405 sec_cam_idx = sec_cam->sec_cam_idx;
406 clear_bit(sec_cam_idx, cam_info->sec_cam_map);
407 if (sec_cam->ext_key)
408 clear_bit(sec_cam_idx + 1, cam_info->sec_cam_map);
409
410 kfree(sec_cam);
411
412 return ret;
413 }
414
rtw89_cam_reset_key_iter(struct ieee80211_hw * hw,struct ieee80211_vif * vif,struct ieee80211_sta * sta,struct ieee80211_key_conf * key,void * data)415 static void rtw89_cam_reset_key_iter(struct ieee80211_hw *hw,
416 struct ieee80211_vif *vif,
417 struct ieee80211_sta *sta,
418 struct ieee80211_key_conf *key,
419 void *data)
420 {
421 struct rtw89_dev *rtwdev = (struct rtw89_dev *)data;
422 struct rtw89_vif *rtwvif = (struct rtw89_vif *)vif->drv_priv;
423
424 rtw89_cam_sec_key_del(rtwdev, vif, sta, key, false);
425 rtw89_cam_deinit(rtwdev, rtwvif);
426 }
427
rtw89_cam_deinit(struct rtw89_dev * rtwdev,struct rtw89_vif * rtwvif)428 void rtw89_cam_deinit(struct rtw89_dev *rtwdev, struct rtw89_vif *rtwvif)
429 {
430 struct rtw89_cam_info *cam_info = &rtwdev->cam_info;
431 struct rtw89_addr_cam_entry *addr_cam = &rtwvif->addr_cam;
432 struct rtw89_bssid_cam_entry *bssid_cam = &rtwvif->bssid_cam;
433
434 addr_cam->valid = false;
435 bssid_cam->valid = false;
436 clear_bit(addr_cam->addr_cam_idx, cam_info->addr_cam_map);
437 clear_bit(bssid_cam->bssid_cam_idx, cam_info->bssid_cam_map);
438 }
439
rtw89_cam_reset_keys(struct rtw89_dev * rtwdev)440 void rtw89_cam_reset_keys(struct rtw89_dev *rtwdev)
441 {
442 rcu_read_lock();
443 ieee80211_iter_keys_rcu(rtwdev->hw, NULL, rtw89_cam_reset_key_iter, rtwdev);
444 rcu_read_unlock();
445 }
446
rtw89_cam_get_avail_addr_cam(struct rtw89_dev * rtwdev,u8 * addr_cam_idx)447 static int rtw89_cam_get_avail_addr_cam(struct rtw89_dev *rtwdev,
448 u8 *addr_cam_idx)
449 {
450 const struct rtw89_chip_info *chip = rtwdev->chip;
451 struct rtw89_cam_info *cam_info = &rtwdev->cam_info;
452 u8 addr_cam_num = chip->acam_num;
453 u8 idx;
454
455 idx = find_first_zero_bit(cam_info->addr_cam_map, addr_cam_num);
456 if (idx >= addr_cam_num)
457 return -EBUSY;
458
459 set_bit(idx, cam_info->addr_cam_map);
460 *addr_cam_idx = idx;
461
462 return 0;
463 }
464
rtw89_cam_init_addr_cam(struct rtw89_dev * rtwdev,struct rtw89_vif * rtwvif)465 static int rtw89_cam_init_addr_cam(struct rtw89_dev *rtwdev,
466 struct rtw89_vif *rtwvif)
467 {
468 struct rtw89_addr_cam_entry *addr_cam = &rtwvif->addr_cam;
469 u8 addr_cam_idx;
470 int i;
471 int ret;
472
473 ret = rtw89_cam_get_avail_addr_cam(rtwdev, &addr_cam_idx);
474 if (ret) {
475 rtw89_err(rtwdev, "failed to get available addr cam\n");
476 return ret;
477 }
478
479 addr_cam->addr_cam_idx = addr_cam_idx;
480 addr_cam->len = ADDR_CAM_ENT_SIZE;
481 addr_cam->offset = 0;
482 addr_cam->valid = true;
483 addr_cam->addr_mask = 0;
484 addr_cam->mask_sel = RTW89_NO_MSK;
485 bitmap_zero(addr_cam->sec_cam_map, RTW89_SEC_CAM_IN_ADDR_CAM);
486 ether_addr_copy(addr_cam->sma, rtwvif->mac_addr);
487
488 for (i = 0; i < RTW89_SEC_CAM_IN_ADDR_CAM; i++) {
489 addr_cam->sec_ent_keyid[i] = 0;
490 addr_cam->sec_ent[i] = 0;
491 }
492
493 return 0;
494 }
495
rtw89_cam_get_avail_bssid_cam(struct rtw89_dev * rtwdev,u8 * bssid_cam_idx)496 static int rtw89_cam_get_avail_bssid_cam(struct rtw89_dev *rtwdev,
497 u8 *bssid_cam_idx)
498 {
499 const struct rtw89_chip_info *chip = rtwdev->chip;
500 struct rtw89_cam_info *cam_info = &rtwdev->cam_info;
501 u8 bssid_cam_num = chip->bcam_num;
502 u8 idx;
503
504 idx = find_first_zero_bit(cam_info->bssid_cam_map, bssid_cam_num);
505 if (idx >= bssid_cam_num)
506 return -EBUSY;
507
508 set_bit(idx, cam_info->bssid_cam_map);
509 *bssid_cam_idx = idx;
510
511 return 0;
512 }
513
rtw89_cam_init_bssid_cam(struct rtw89_dev * rtwdev,struct rtw89_vif * rtwvif)514 static int rtw89_cam_init_bssid_cam(struct rtw89_dev *rtwdev,
515 struct rtw89_vif *rtwvif)
516 {
517 struct rtw89_bssid_cam_entry *bssid_cam = &rtwvif->bssid_cam;
518 u8 bssid_cam_idx;
519 int ret;
520
521 ret = rtw89_cam_get_avail_bssid_cam(rtwdev, &bssid_cam_idx);
522 if (ret) {
523 rtw89_err(rtwdev, "failed to get available bssid cam\n");
524 return ret;
525 }
526
527 bssid_cam->bssid_cam_idx = bssid_cam_idx;
528 bssid_cam->phy_idx = rtwvif->phy_idx;
529 bssid_cam->len = BSSID_CAM_ENT_SIZE;
530 bssid_cam->offset = 0;
531 bssid_cam->valid = true;
532 ether_addr_copy(bssid_cam->bssid, rtwvif->bssid);
533
534 return 0;
535 }
536
rtw89_cam_bssid_changed(struct rtw89_dev * rtwdev,struct rtw89_vif * rtwvif)537 void rtw89_cam_bssid_changed(struct rtw89_dev *rtwdev, struct rtw89_vif *rtwvif)
538 {
539 struct ieee80211_vif *vif = rtwvif_to_vif(rtwvif);
540 struct rtw89_addr_cam_entry *addr_cam = &rtwvif->addr_cam;
541 struct rtw89_bssid_cam_entry *bssid_cam = &rtwvif->bssid_cam;
542
543 if (vif->type == NL80211_IFTYPE_STATION)
544 ether_addr_copy(addr_cam->tma, rtwvif->bssid);
545 ether_addr_copy(bssid_cam->bssid, rtwvif->bssid);
546 }
547
rtw89_cam_init(struct rtw89_dev * rtwdev,struct rtw89_vif * rtwvif)548 int rtw89_cam_init(struct rtw89_dev *rtwdev, struct rtw89_vif *rtwvif)
549 {
550 struct rtw89_addr_cam_entry *addr_cam = &rtwvif->addr_cam;
551 struct rtw89_bssid_cam_entry *bssid_cam = &rtwvif->bssid_cam;
552 int ret;
553
554 ret = rtw89_cam_init_addr_cam(rtwdev, rtwvif);
555 if (ret) {
556 rtw89_err(rtwdev, "failed to init addr cam\n");
557 return ret;
558 }
559
560 ret = rtw89_cam_init_bssid_cam(rtwdev, rtwvif);
561 if (ret) {
562 rtw89_err(rtwdev, "failed to init bssid cam\n");
563 return ret;
564 }
565
566 /* associate addr cam with bssid cam */
567 addr_cam->bssid_cam_idx = bssid_cam->bssid_cam_idx;
568
569 return 0;
570 }
571
rtw89_cam_fill_bssid_cam_info(struct rtw89_dev * rtwdev,struct rtw89_vif * rtwvif,u8 * cmd)572 int rtw89_cam_fill_bssid_cam_info(struct rtw89_dev *rtwdev,
573 struct rtw89_vif *rtwvif, u8 *cmd)
574 {
575 struct ieee80211_vif *vif = rtwvif_to_vif(rtwvif);
576 struct rtw89_bssid_cam_entry *bssid_cam = &rtwvif->bssid_cam;
577 u8 bss_color = vif->bss_conf.he_bss_color.color;
578
579 FWCMD_SET_ADDR_BSSID_IDX(cmd, bssid_cam->bssid_cam_idx);
580 FWCMD_SET_ADDR_BSSID_OFFSET(cmd, bssid_cam->offset);
581 FWCMD_SET_ADDR_BSSID_LEN(cmd, bssid_cam->len);
582 FWCMD_SET_ADDR_BSSID_VALID(cmd, bssid_cam->valid);
583 FWCMD_SET_ADDR_BSSID_BB_SEL(cmd, bssid_cam->phy_idx);
584 FWCMD_SET_ADDR_BSSID_BSS_COLOR(cmd, bss_color);
585
586 FWCMD_SET_ADDR_BSSID_BSSID0(cmd, bssid_cam->bssid[0]);
587 FWCMD_SET_ADDR_BSSID_BSSID1(cmd, bssid_cam->bssid[1]);
588 FWCMD_SET_ADDR_BSSID_BSSID2(cmd, bssid_cam->bssid[2]);
589 FWCMD_SET_ADDR_BSSID_BSSID3(cmd, bssid_cam->bssid[3]);
590 FWCMD_SET_ADDR_BSSID_BSSID4(cmd, bssid_cam->bssid[4]);
591 FWCMD_SET_ADDR_BSSID_BSSID5(cmd, bssid_cam->bssid[5]);
592
593 return 0;
594 }
595
rtw89_cam_addr_hash(u8 start,u8 * addr)596 static u8 rtw89_cam_addr_hash(u8 start, u8 *addr)
597 {
598 u8 hash = 0;
599 u8 i;
600
601 for (i = start; i < ETH_ALEN; i++)
602 hash ^= addr[i];
603
604 return hash;
605 }
606
rtw89_cam_fill_addr_cam_info(struct rtw89_dev * rtwdev,struct rtw89_vif * rtwvif,u8 * cmd)607 void rtw89_cam_fill_addr_cam_info(struct rtw89_dev *rtwdev,
608 struct rtw89_vif *rtwvif,
609 u8 *cmd)
610 {
611 struct ieee80211_vif *vif = rtwvif_to_vif(rtwvif);
612 struct ieee80211_sta *sta;
613 struct rtw89_sta *rtwsta;
614 struct rtw89_addr_cam_entry *addr_cam = &rtwvif->addr_cam;
615 u8 sma_hash, tma_hash, addr_msk_start;
616 u8 sma_start = 0;
617 u8 tma_start = 0;
618
619 if (addr_cam->addr_mask != 0) {
620 addr_msk_start = __ffs(addr_cam->addr_mask);
621 if (addr_cam->mask_sel == RTW89_SMA)
622 sma_start = addr_msk_start;
623 else if (addr_cam->mask_sel == RTW89_TMA)
624 tma_start = addr_msk_start;
625 }
626 sma_hash = rtw89_cam_addr_hash(sma_start, rtwvif->mac_addr);
627 tma_hash = rtw89_cam_addr_hash(tma_start, addr_cam->tma);
628
629 FWCMD_SET_ADDR_IDX(cmd, addr_cam->addr_cam_idx);
630 FWCMD_SET_ADDR_OFFSET(cmd, addr_cam->offset);
631 FWCMD_SET_ADDR_LEN(cmd, addr_cam->len);
632
633 FWCMD_SET_ADDR_VALID(cmd, addr_cam->valid);
634 FWCMD_SET_ADDR_NET_TYPE(cmd, rtwvif->net_type);
635 FWCMD_SET_ADDR_BCN_HIT_COND(cmd, rtwvif->bcn_hit_cond);
636 FWCMD_SET_ADDR_HIT_RULE(cmd, rtwvif->hit_rule);
637 FWCMD_SET_ADDR_BB_SEL(cmd, rtwvif->phy_idx);
638 FWCMD_SET_ADDR_ADDR_MASK(cmd, addr_cam->addr_mask);
639 FWCMD_SET_ADDR_MASK_SEL(cmd, addr_cam->mask_sel);
640 FWCMD_SET_ADDR_SMA_HASH(cmd, sma_hash);
641 FWCMD_SET_ADDR_TMA_HASH(cmd, tma_hash);
642
643 FWCMD_SET_ADDR_BSSID_CAM_IDX(cmd, addr_cam->bssid_cam_idx);
644
645 FWCMD_SET_ADDR_SMA0(cmd, rtwvif->mac_addr[0]);
646 FWCMD_SET_ADDR_SMA1(cmd, rtwvif->mac_addr[1]);
647 FWCMD_SET_ADDR_SMA2(cmd, rtwvif->mac_addr[2]);
648 FWCMD_SET_ADDR_SMA3(cmd, rtwvif->mac_addr[3]);
649 FWCMD_SET_ADDR_SMA4(cmd, rtwvif->mac_addr[4]);
650 FWCMD_SET_ADDR_SMA5(cmd, rtwvif->mac_addr[5]);
651
652 FWCMD_SET_ADDR_TMA0(cmd, addr_cam->tma[0]);
653 FWCMD_SET_ADDR_TMA1(cmd, addr_cam->tma[1]);
654 FWCMD_SET_ADDR_TMA2(cmd, addr_cam->tma[2]);
655 FWCMD_SET_ADDR_TMA3(cmd, addr_cam->tma[3]);
656 FWCMD_SET_ADDR_TMA4(cmd, addr_cam->tma[4]);
657 FWCMD_SET_ADDR_TMA5(cmd, addr_cam->tma[5]);
658
659 FWCMD_SET_ADDR_PORT_INT(cmd, rtwvif->port);
660 FWCMD_SET_ADDR_TSF_SYNC(cmd, rtwvif->port);
661 FWCMD_SET_ADDR_TF_TRS(cmd, rtwvif->trigger);
662 FWCMD_SET_ADDR_LSIG_TXOP(cmd, rtwvif->lsig_txop);
663 FWCMD_SET_ADDR_TGT_IND(cmd, rtwvif->tgt_ind);
664 FWCMD_SET_ADDR_FRM_TGT_IND(cmd, rtwvif->frm_tgt_ind);
665
666 if (vif->type == NL80211_IFTYPE_STATION) {
667 sta = rtwvif->mgd.ap;
668 if (sta) {
669 rtwsta = (struct rtw89_sta *)sta->drv_priv;
670 FWCMD_SET_ADDR_MACID(cmd, rtwsta->mac_id);
671 FWCMD_SET_ADDR_AID12(cmd, vif->bss_conf.aid & 0xfff);
672 }
673 }
674 FWCMD_SET_ADDR_WOL_PATTERN(cmd, rtwvif->wowlan_pattern);
675 FWCMD_SET_ADDR_WOL_UC(cmd, rtwvif->wowlan_uc);
676 FWCMD_SET_ADDR_WOL_MAGIC(cmd, rtwvif->wowlan_magic);
677 FWCMD_SET_ADDR_WAPI(cmd, addr_cam->wapi);
678 FWCMD_SET_ADDR_SEC_ENT_MODE(cmd, addr_cam->sec_ent_mode);
679 FWCMD_SET_ADDR_SEC_ENT0_KEYID(cmd, addr_cam->sec_ent_keyid[0]);
680 FWCMD_SET_ADDR_SEC_ENT1_KEYID(cmd, addr_cam->sec_ent_keyid[1]);
681 FWCMD_SET_ADDR_SEC_ENT2_KEYID(cmd, addr_cam->sec_ent_keyid[2]);
682 FWCMD_SET_ADDR_SEC_ENT3_KEYID(cmd, addr_cam->sec_ent_keyid[3]);
683 FWCMD_SET_ADDR_SEC_ENT4_KEYID(cmd, addr_cam->sec_ent_keyid[4]);
684 FWCMD_SET_ADDR_SEC_ENT5_KEYID(cmd, addr_cam->sec_ent_keyid[5]);
685 FWCMD_SET_ADDR_SEC_ENT6_KEYID(cmd, addr_cam->sec_ent_keyid[6]);
686
687 FWCMD_SET_ADDR_SEC_ENT_VALID(cmd, addr_cam->sec_cam_map[0] & 0xff);
688 FWCMD_SET_ADDR_SEC_ENT0(cmd, addr_cam->sec_ent[0]);
689 FWCMD_SET_ADDR_SEC_ENT1(cmd, addr_cam->sec_ent[1]);
690 FWCMD_SET_ADDR_SEC_ENT2(cmd, addr_cam->sec_ent[2]);
691 FWCMD_SET_ADDR_SEC_ENT3(cmd, addr_cam->sec_ent[3]);
692 FWCMD_SET_ADDR_SEC_ENT4(cmd, addr_cam->sec_ent[4]);
693 FWCMD_SET_ADDR_SEC_ENT5(cmd, addr_cam->sec_ent[5]);
694 FWCMD_SET_ADDR_SEC_ENT6(cmd, addr_cam->sec_ent[6]);
695 }
696