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