Lines Matching +full:cam +full:- +full:0
1 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2 /* Copyright(c) 2019-2020 Realtek Corporation
5 #include "cam.h"
27 for (i = 0; i < 4; i++) { in rtw89_cam_get_sec_key_cmd()
29 j += ext_key ? 16 : 0; in rtw89_cam_get_sec_key_cmd()
30 key32[i] = FIELD_PREP(GENMASK(7, 0), sec_cam->key[j + 0]) | in rtw89_cam_get_sec_key_cmd()
31 FIELD_PREP(GENMASK(15, 8), sec_cam->key[j + 1]) | in rtw89_cam_get_sec_key_cmd()
32 FIELD_PREP(GENMASK(23, 16), sec_cam->key[j + 2]) | in rtw89_cam_get_sec_key_cmd()
33 FIELD_PREP(GENMASK(31, 24), sec_cam->key[j + 3]); in rtw89_cam_get_sec_key_cmd()
36 cmd = skb->data; in rtw89_cam_get_sec_key_cmd()
37 RTW89_SET_FWCMD_SEC_IDX(cmd, sec_cam->sec_cam_idx + (ext_key ? 1 : 0)); in rtw89_cam_get_sec_key_cmd()
38 RTW89_SET_FWCMD_SEC_OFFSET(cmd, sec_cam->offset); in rtw89_cam_get_sec_key_cmd()
39 RTW89_SET_FWCMD_SEC_LEN(cmd, sec_cam->len); in rtw89_cam_get_sec_key_cmd()
40 RTW89_SET_FWCMD_SEC_TYPE(cmd, sec_cam->type); in rtw89_cam_get_sec_key_cmd()
42 RTW89_SET_FWCMD_SEC_SPP_MODE(cmd, sec_cam->spp_mode); in rtw89_cam_get_sec_key_cmd()
43 RTW89_SET_FWCMD_SEC_KEY0(cmd, key32[0]); in rtw89_cam_get_sec_key_cmd()
60 return -ENOMEM; in rtw89_cam_send_sec_key_cmd()
67 H2C_FUNC_MAC_SEC_UPD, 1, 0, in rtw89_cam_send_sec_key_cmd()
76 if (!sec_cam->ext_key) in rtw89_cam_send_sec_key_cmd()
77 return 0; in rtw89_cam_send_sec_key_cmd()
82 return -ENOMEM; in rtw89_cam_send_sec_key_cmd()
90 1, 0, H2C_SEC_CAM_LEN); in rtw89_cam_send_sec_key_cmd()
98 return 0; in rtw89_cam_send_sec_key_cmd()
104 const struct rtw89_chip_info *chip = rtwdev->chip; in rtw89_cam_get_avail_sec_cam()
105 struct rtw89_cam_info *cam_info = &rtwdev->cam_info; in rtw89_cam_get_avail_sec_cam()
106 u8 sec_cam_num = chip->scam_num; in rtw89_cam_get_avail_sec_cam()
107 u8 idx = 0; in rtw89_cam_get_avail_sec_cam()
110 idx = find_first_zero_bit(cam_info->sec_cam_map, sec_cam_num); in rtw89_cam_get_avail_sec_cam()
112 return -EBUSY; in rtw89_cam_get_avail_sec_cam()
114 set_bit(idx, cam_info->sec_cam_map); in rtw89_cam_get_avail_sec_cam()
117 return 0; in rtw89_cam_get_avail_sec_cam()
121 idx = find_next_zero_bit(cam_info->sec_cam_map, sec_cam_num, idx); in rtw89_cam_get_avail_sec_cam()
122 if (idx >= sec_cam_num - 1) in rtw89_cam_get_avail_sec_cam()
123 return -EBUSY; in rtw89_cam_get_avail_sec_cam()
124 /* ext keys need two cam entries for 256-bit key */ in rtw89_cam_get_avail_sec_cam()
125 if (test_bit(idx + 1, cam_info->sec_cam_map)) { in rtw89_cam_get_avail_sec_cam()
130 set_bit(idx, cam_info->sec_cam_map); in rtw89_cam_get_avail_sec_cam()
131 set_bit(idx + 1, cam_info->sec_cam_map); in rtw89_cam_get_avail_sec_cam()
134 return 0; in rtw89_cam_get_avail_sec_cam()
145 * RTW89_ADDR_CAM_SEC_ALL_UNI : 0 - 6 unicast in rtw89_cam_get_addr_cam_key_idx()
146 * RTW89_ADDR_CAM_SEC_NORMAL : 0 - 1 unicast, 2 - 4 group, 5 - 6 BIP in rtw89_cam_get_addr_cam_key_idx()
147 * RTW89_ADDR_CAM_SEC_4GROUP : 0 - 1 unicast, 2 - 5 group, 6 BIP in rtw89_cam_get_addr_cam_key_idx()
149 switch (addr_cam->sec_ent_mode) { in rtw89_cam_get_addr_cam_key_idx()
151 return -EINVAL; in rtw89_cam_get_addr_cam_key_idx()
153 idx = find_first_zero_bit(addr_cam->sec_cam_map, in rtw89_cam_get_addr_cam_key_idx()
156 return -EBUSY; in rtw89_cam_get_addr_cam_key_idx()
160 if (sec_cam->type == RTW89_SEC_KEY_TYPE_BIP_CCMP128) { in rtw89_cam_get_addr_cam_key_idx()
161 idx = find_next_zero_bit(addr_cam->sec_cam_map, in rtw89_cam_get_addr_cam_key_idx()
164 return -EBUSY; in rtw89_cam_get_addr_cam_key_idx()
169 if (key->flags & IEEE80211_KEY_FLAG_PAIRWISE) { in rtw89_cam_get_addr_cam_key_idx()
170 idx = find_next_zero_bit(addr_cam->sec_cam_map, in rtw89_cam_get_addr_cam_key_idx()
171 RTW89_SEC_CAM_IN_ADDR_CAM, 0); in rtw89_cam_get_addr_cam_key_idx()
173 return -EBUSY; in rtw89_cam_get_addr_cam_key_idx()
179 idx = find_next_zero_bit(addr_cam->sec_cam_map, in rtw89_cam_get_addr_cam_key_idx()
182 return -EBUSY; in rtw89_cam_get_addr_cam_key_idx()
186 if (sec_cam->type == RTW89_SEC_KEY_TYPE_BIP_CCMP128) { in rtw89_cam_get_addr_cam_key_idx()
187 if (test_bit(6, addr_cam->sec_cam_map)) in rtw89_cam_get_addr_cam_key_idx()
188 return -EINVAL; in rtw89_cam_get_addr_cam_key_idx()
193 if (key->flags & IEEE80211_KEY_FLAG_PAIRWISE) { in rtw89_cam_get_addr_cam_key_idx()
194 idx = find_next_zero_bit(addr_cam->sec_cam_map, in rtw89_cam_get_addr_cam_key_idx()
195 RTW89_SEC_CAM_IN_ADDR_CAM, 0); in rtw89_cam_get_addr_cam_key_idx()
197 return -EBUSY; in rtw89_cam_get_addr_cam_key_idx()
203 idx = find_next_zero_bit(addr_cam->sec_cam_map, in rtw89_cam_get_addr_cam_key_idx()
206 return -EBUSY; in rtw89_cam_get_addr_cam_key_idx()
211 return 0; in rtw89_cam_get_addr_cam_key_idx()
222 int ret = 0; in __rtw89_cam_detach_sec_cam()
226 for_each_set_bit(i, addr_cam->sec_cam_map, RTW89_SEC_CAM_IN_ADDR_CAM) { in __rtw89_cam_detach_sec_cam()
227 if (addr_cam->sec_ent[i] != sec_cam->sec_cam_idx) in __rtw89_cam_detach_sec_cam()
230 clear_bit(i, addr_cam->sec_cam_map); in __rtw89_cam_detach_sec_cam()
237 "failed to update dctl cam del key: %d\n", ret); in __rtw89_cam_detach_sec_cam()
240 rtw89_err(rtwdev, "failed to update cam del key: %d\n", ret); in __rtw89_cam_detach_sec_cam()
253 u8 key_idx = 0; in __rtw89_cam_attach_sec_cam()
258 if (key->cipher == WLAN_CIPHER_SUITE_WEP40 || in __rtw89_cam_attach_sec_cam()
259 key->cipher == WLAN_CIPHER_SUITE_WEP104) in __rtw89_cam_attach_sec_cam()
260 addr_cam->sec_ent_mode = RTW89_ADDR_CAM_SEC_ALL_UNI; in __rtw89_cam_attach_sec_cam()
264 rtw89_err(rtwdev, "failed to get addr cam key idx %d, %d\n", in __rtw89_cam_attach_sec_cam()
265 addr_cam->sec_ent_mode, sec_cam->type); in __rtw89_cam_attach_sec_cam()
269 addr_cam->sec_ent_keyid[key_idx] = key->keyidx; in __rtw89_cam_attach_sec_cam()
270 addr_cam->sec_ent[key_idx] = sec_cam->sec_cam_idx; in __rtw89_cam_attach_sec_cam()
271 set_bit(key_idx, addr_cam->sec_cam_map); in __rtw89_cam_attach_sec_cam()
274 rtw89_err(rtwdev, "failed to update dctl cam sec entry: %d\n", in __rtw89_cam_attach_sec_cam()
280 rtw89_err(rtwdev, "failed to update addr cam sec entry: %d\n", in __rtw89_cam_attach_sec_cam()
282 clear_bit(key_idx, addr_cam->sec_cam_map); in __rtw89_cam_attach_sec_cam()
286 return 0; in __rtw89_cam_attach_sec_cam()
294 struct rtw89_cam_info *cam_info = &rtwdev->cam_info; in rtw89_cam_attach_link_sec_cam()
297 sec_cam = cam_info->sec_entries[sec_cam_idx]; in rtw89_cam_attach_link_sec_cam()
299 return -ENOENT; in rtw89_cam_attach_link_sec_cam()
302 sec_cam->key_conf, sec_cam); in rtw89_cam_attach_link_sec_cam()
319 rtw89_err(rtwdev, "No iface for deleting sec cam\n"); in rtw89_cam_detach_sec_cam()
320 return -EINVAL; in rtw89_cam_detach_sec_cam()
326 clear_bit(sec_cam->sec_cam_idx, rtwsta->pairwise_sec_cam_map); in rtw89_cam_detach_sec_cam()
329 rtwsta_link = rtwsta ? rtwsta->links[link_id] : NULL; in rtw89_cam_detach_sec_cam()
339 return 0; in rtw89_cam_detach_sec_cam()
357 rtw89_err(rtwdev, "No iface for adding sec cam\n"); in rtw89_cam_attach_sec_cam()
358 return -EINVAL; in rtw89_cam_attach_sec_cam()
363 key_link_id = ieee80211_vif_is_mld(vif) ? key->link_id : 0; in rtw89_cam_attach_sec_cam()
364 if (key_link_id >= 0) { in rtw89_cam_attach_sec_cam()
365 rtwvif_link = rtwvif->links[key_link_id]; in rtw89_cam_attach_sec_cam()
366 rtwsta_link = rtwsta ? rtwsta->links[key_link_id] : NULL; in rtw89_cam_attach_sec_cam()
369 rtw89_err(rtwdev, "No drv link for adding sec cam\n"); in rtw89_cam_attach_sec_cam()
370 return -ENOLINK; in rtw89_cam_attach_sec_cam()
377 /* key_link_id < 0: MLD pairwise key */ in rtw89_cam_attach_sec_cam()
379 rtw89_err(rtwdev, "No sta for adding MLD pairwise sec cam\n"); in rtw89_cam_attach_sec_cam()
380 return -EINVAL; in rtw89_cam_attach_sec_cam()
384 rtwvif_link = rtwsta_link->rtwvif_link; in rtw89_cam_attach_sec_cam()
391 set_bit(sec_cam->sec_cam_idx, rtwsta->pairwise_sec_cam_map); in rtw89_cam_attach_sec_cam()
393 return 0; in rtw89_cam_attach_sec_cam()
403 struct rtw89_cam_info *cam_info = &rtwdev->cam_info; in rtw89_cam_sec_key_install()
407 /* maximum key length 256-bit */ in rtw89_cam_sec_key_install()
408 if (key->keylen > 32) { in rtw89_cam_sec_key_install()
409 rtw89_err(rtwdev, "invalid sec key length %d\n", key->keylen); in rtw89_cam_sec_key_install()
410 return -EINVAL; in rtw89_cam_sec_key_install()
415 rtw89_warn(rtwdev, "no available sec cam: %d ext: %d\n", in rtw89_cam_sec_key_install()
422 ret = -ENOMEM; in rtw89_cam_sec_key_install()
426 key->hw_key_idx = sec_cam_idx; in rtw89_cam_sec_key_install()
427 cam_info->sec_entries[sec_cam_idx] = sec_cam; in rtw89_cam_sec_key_install()
429 sec_cam->sec_cam_idx = sec_cam_idx; in rtw89_cam_sec_key_install()
430 sec_cam->type = hw_key_type; in rtw89_cam_sec_key_install()
431 sec_cam->len = RTW89_SEC_CAM_LEN; in rtw89_cam_sec_key_install()
432 sec_cam->ext_key = ext_key; in rtw89_cam_sec_key_install()
433 memcpy(sec_cam->key, key->key, key->keylen); in rtw89_cam_sec_key_install()
435 sec_cam->key_conf = key; in rtw89_cam_sec_key_install()
443 /* associate with addr cam */ in rtw89_cam_sec_key_install()
446 rtw89_err(rtwdev, "failed to attach sec cam: %d\n", ret); in rtw89_cam_sec_key_install()
450 return 0; in rtw89_cam_sec_key_install()
453 cam_info->sec_entries[sec_cam_idx] = NULL; in rtw89_cam_sec_key_install()
455 clear_bit(sec_cam_idx, cam_info->sec_cam_map); in rtw89_cam_sec_key_install()
457 clear_bit(sec_cam_idx + 1, cam_info->sec_cam_map); in rtw89_cam_sec_key_install()
467 const struct rtw89_chip_info *chip = rtwdev->chip; in rtw89_cam_sec_key_add()
472 switch (key->cipher) { in rtw89_cam_sec_key_add()
480 if (!chip->hw_tkip_crypto) in rtw89_cam_sec_key_add()
481 return -EOPNOTSUPP; in rtw89_cam_sec_key_add()
483 key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIC; in rtw89_cam_sec_key_add()
487 if (!chip->hw_mgmt_tx_encrypt) in rtw89_cam_sec_key_add()
488 key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX; in rtw89_cam_sec_key_add()
492 if (!chip->hw_mgmt_tx_encrypt) in rtw89_cam_sec_key_add()
493 key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX; in rtw89_cam_sec_key_add()
498 if (!chip->hw_mgmt_tx_encrypt) in rtw89_cam_sec_key_add()
499 key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX; in rtw89_cam_sec_key_add()
503 if (!chip->hw_mgmt_tx_encrypt) in rtw89_cam_sec_key_add()
504 key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX; in rtw89_cam_sec_key_add()
511 return -EOPNOTSUPP; in rtw89_cam_sec_key_add()
514 if (!chip->hw_sec_hdr) in rtw89_cam_sec_key_add()
515 key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV; in rtw89_cam_sec_key_add()
525 return 0; in rtw89_cam_sec_key_add()
534 struct rtw89_cam_info *cam_info = &rtwdev->cam_info; in rtw89_cam_sec_key_del()
539 sec_cam_idx = key->hw_key_idx; in rtw89_cam_sec_key_del()
540 sec_cam = cam_info->sec_entries[sec_cam_idx]; in rtw89_cam_sec_key_del()
542 return -EINVAL; in rtw89_cam_sec_key_del()
546 /* clear valid bit in addr cam will disable sec cam, in rtw89_cam_sec_key_del()
549 cam_info->sec_entries[sec_cam_idx] = NULL; in rtw89_cam_sec_key_del()
550 clear_bit(sec_cam_idx, cam_info->sec_cam_map); in rtw89_cam_sec_key_del()
551 if (sec_cam->ext_key) in rtw89_cam_sec_key_del()
552 clear_bit(sec_cam_idx + 1, cam_info->sec_cam_map); in rtw89_cam_sec_key_del()
573 struct rtw89_cam_info *cam_info = &rtwdev->cam_info; in rtw89_cam_deinit_addr_cam()
575 addr_cam->valid = false; in rtw89_cam_deinit_addr_cam()
576 clear_bit(addr_cam->addr_cam_idx, cam_info->addr_cam_map); in rtw89_cam_deinit_addr_cam()
582 struct rtw89_cam_info *cam_info = &rtwdev->cam_info; in rtw89_cam_deinit_bssid_cam()
584 bssid_cam->valid = false; in rtw89_cam_deinit_bssid_cam()
585 clear_bit(bssid_cam->bssid_cam_idx, cam_info->bssid_cam_map); in rtw89_cam_deinit_bssid_cam()
590 struct rtw89_addr_cam_entry *addr_cam = &rtwvif_link->addr_cam; in rtw89_cam_deinit()
591 struct rtw89_bssid_cam_entry *bssid_cam = &rtwvif_link->bssid_cam; in rtw89_cam_deinit()
600 ieee80211_iter_keys_rcu(rtwdev->hw, NULL, rtw89_cam_reset_key_iter, rtwdev); in rtw89_cam_reset_keys()
607 const struct rtw89_chip_info *chip = rtwdev->chip; in rtw89_cam_get_avail_addr_cam()
608 struct rtw89_cam_info *cam_info = &rtwdev->cam_info; in rtw89_cam_get_avail_addr_cam()
609 u8 addr_cam_num = chip->acam_num; in rtw89_cam_get_avail_addr_cam()
612 idx = find_first_zero_bit(cam_info->addr_cam_map, addr_cam_num); in rtw89_cam_get_avail_addr_cam()
614 return -EBUSY; in rtw89_cam_get_avail_addr_cam()
616 set_bit(idx, cam_info->addr_cam_map); in rtw89_cam_get_avail_addr_cam()
619 return 0; in rtw89_cam_get_avail_addr_cam()
624 const struct rtw89_chip_info *chip = rtwdev->chip; in rtw89_get_addr_cam_entry_size()
626 switch (chip->chip_id) { in rtw89_get_addr_cam_entry_size()
645 if (unlikely(addr_cam->valid)) { in rtw89_cam_init_addr_cam()
647 "addr cam is already valid; skip init\n"); in rtw89_cam_init_addr_cam()
648 return 0; in rtw89_cam_init_addr_cam()
653 rtw89_err(rtwdev, "failed to get available addr cam\n"); in rtw89_cam_init_addr_cam()
657 addr_cam->addr_cam_idx = addr_cam_idx; in rtw89_cam_init_addr_cam()
658 addr_cam->len = rtw89_get_addr_cam_entry_size(rtwdev); in rtw89_cam_init_addr_cam()
659 addr_cam->offset = 0; in rtw89_cam_init_addr_cam()
660 addr_cam->valid = true; in rtw89_cam_init_addr_cam()
661 addr_cam->addr_mask = 0; in rtw89_cam_init_addr_cam()
662 addr_cam->mask_sel = RTW89_NO_MSK; in rtw89_cam_init_addr_cam()
663 addr_cam->sec_ent_mode = RTW89_ADDR_CAM_SEC_NORMAL; in rtw89_cam_init_addr_cam()
664 bitmap_zero(addr_cam->sec_cam_map, RTW89_SEC_CAM_IN_ADDR_CAM); in rtw89_cam_init_addr_cam()
666 for (i = 0; i < RTW89_SEC_CAM_IN_ADDR_CAM; i++) { in rtw89_cam_init_addr_cam()
667 addr_cam->sec_ent_keyid[i] = 0; in rtw89_cam_init_addr_cam()
668 addr_cam->sec_ent[i] = 0; in rtw89_cam_init_addr_cam()
671 /* associate addr cam with bssid cam */ in rtw89_cam_init_addr_cam()
672 addr_cam->bssid_cam_idx = bssid_cam->bssid_cam_idx; in rtw89_cam_init_addr_cam()
674 return 0; in rtw89_cam_init_addr_cam()
680 const struct rtw89_chip_info *chip = rtwdev->chip; in rtw89_cam_get_avail_bssid_cam()
681 struct rtw89_cam_info *cam_info = &rtwdev->cam_info; in rtw89_cam_get_avail_bssid_cam()
682 u8 bssid_cam_num = chip->bcam_num; in rtw89_cam_get_avail_bssid_cam()
685 idx = find_first_zero_bit(cam_info->bssid_cam_map, bssid_cam_num); in rtw89_cam_get_avail_bssid_cam()
687 return -EBUSY; in rtw89_cam_get_avail_bssid_cam()
689 set_bit(idx, cam_info->bssid_cam_map); in rtw89_cam_get_avail_bssid_cam()
692 return 0; in rtw89_cam_get_avail_bssid_cam()
703 if (unlikely(bssid_cam->valid)) { in rtw89_cam_init_bssid_cam()
705 "bssid cam is already valid; skip init\n"); in rtw89_cam_init_bssid_cam()
706 return 0; in rtw89_cam_init_bssid_cam()
711 rtw89_err(rtwdev, "failed to get available bssid cam\n"); in rtw89_cam_init_bssid_cam()
715 bssid_cam->bssid_cam_idx = bssid_cam_idx; in rtw89_cam_init_bssid_cam()
716 bssid_cam->phy_idx = rtwvif_link->phy_idx; in rtw89_cam_init_bssid_cam()
717 bssid_cam->len = BSSID_CAM_ENT_SIZE; in rtw89_cam_init_bssid_cam()
718 bssid_cam->offset = 0; in rtw89_cam_init_bssid_cam()
719 bssid_cam->valid = true; in rtw89_cam_init_bssid_cam()
720 ether_addr_copy(bssid_cam->bssid, bssid); in rtw89_cam_init_bssid_cam()
722 return 0; in rtw89_cam_init_bssid_cam()
727 struct rtw89_bssid_cam_entry *bssid_cam = &rtwvif_link->bssid_cam; in rtw89_cam_bssid_changed()
729 ether_addr_copy(bssid_cam->bssid, rtwvif_link->bssid); in rtw89_cam_bssid_changed()
734 struct rtw89_addr_cam_entry *addr_cam = &rtwvif_link->addr_cam; in rtw89_cam_init()
735 struct rtw89_bssid_cam_entry *bssid_cam = &rtwvif_link->bssid_cam; in rtw89_cam_init()
739 rtwvif_link->bssid); in rtw89_cam_init()
741 rtw89_err(rtwdev, "failed to init bssid cam\n"); in rtw89_cam_init()
747 rtw89_err(rtwdev, "failed to init addr cam\n"); in rtw89_cam_init()
751 return 0; in rtw89_cam_init()
767 bss_color = bss_conf->he_bss_color.color; in rtw89_cam_fill_bssid_cam_info()
769 if (bss_conf->nontransmitted) in rtw89_cam_fill_bssid_cam_info()
776 FWCMD_SET_ADDR_BSSID_IDX(cmd, bssid_cam->bssid_cam_idx); in rtw89_cam_fill_bssid_cam_info()
777 FWCMD_SET_ADDR_BSSID_OFFSET(cmd, bssid_cam->offset); in rtw89_cam_fill_bssid_cam_info()
778 FWCMD_SET_ADDR_BSSID_LEN(cmd, bssid_cam->len); in rtw89_cam_fill_bssid_cam_info()
779 FWCMD_SET_ADDR_BSSID_VALID(cmd, bssid_cam->valid); in rtw89_cam_fill_bssid_cam_info()
781 FWCMD_SET_ADDR_BSSID_BB_SEL(cmd, bssid_cam->phy_idx); in rtw89_cam_fill_bssid_cam_info()
784 FWCMD_SET_ADDR_BSSID_BSSID0(cmd, bssid_cam->bssid[0]); in rtw89_cam_fill_bssid_cam_info()
785 FWCMD_SET_ADDR_BSSID_BSSID1(cmd, bssid_cam->bssid[1]); in rtw89_cam_fill_bssid_cam_info()
786 FWCMD_SET_ADDR_BSSID_BSSID2(cmd, bssid_cam->bssid[2]); in rtw89_cam_fill_bssid_cam_info()
787 FWCMD_SET_ADDR_BSSID_BSSID3(cmd, bssid_cam->bssid[3]); in rtw89_cam_fill_bssid_cam_info()
788 FWCMD_SET_ADDR_BSSID_BSSID4(cmd, bssid_cam->bssid[4]); in rtw89_cam_fill_bssid_cam_info()
789 FWCMD_SET_ADDR_BSSID_BSSID5(cmd, bssid_cam->bssid[5]); in rtw89_cam_fill_bssid_cam_info()
791 return 0; in rtw89_cam_fill_bssid_cam_info()
796 u8 hash = 0; in rtw89_cam_addr_hash()
816 const u8 *sma = scan_mac_addr ? scan_mac_addr : rtwvif_link->mac_addr; in rtw89_cam_fill_addr_cam_info()
818 u8 sma_start = 0; in rtw89_cam_fill_addr_cam_info()
819 u8 tma_start = 0; in rtw89_cam_fill_addr_cam_info()
826 tma = link_sta->addr; in rtw89_cam_fill_addr_cam_info()
828 tma = rtwvif_link->bssid; in rtw89_cam_fill_addr_cam_info()
831 if (addr_cam->addr_mask != 0) { in rtw89_cam_fill_addr_cam_info()
832 addr_msk_start = __ffs(addr_cam->addr_mask); in rtw89_cam_fill_addr_cam_info()
833 if (addr_cam->mask_sel == RTW89_SMA) in rtw89_cam_fill_addr_cam_info()
835 else if (addr_cam->mask_sel == RTW89_TMA) in rtw89_cam_fill_addr_cam_info()
841 FWCMD_SET_ADDR_IDX(cmd, addr_cam->addr_cam_idx); in rtw89_cam_fill_addr_cam_info()
842 FWCMD_SET_ADDR_OFFSET(cmd, addr_cam->offset); in rtw89_cam_fill_addr_cam_info()
843 FWCMD_SET_ADDR_LEN(cmd, addr_cam->len); in rtw89_cam_fill_addr_cam_info()
845 FWCMD_SET_ADDR_VALID(cmd, addr_cam->valid); in rtw89_cam_fill_addr_cam_info()
846 FWCMD_SET_ADDR_NET_TYPE(cmd, rtwvif_link->net_type); in rtw89_cam_fill_addr_cam_info()
847 FWCMD_SET_ADDR_BCN_HIT_COND(cmd, rtwvif_link->bcn_hit_cond); in rtw89_cam_fill_addr_cam_info()
848 FWCMD_SET_ADDR_HIT_RULE(cmd, rtwvif_link->hit_rule); in rtw89_cam_fill_addr_cam_info()
849 FWCMD_SET_ADDR_BB_SEL(cmd, rtwvif_link->phy_idx); in rtw89_cam_fill_addr_cam_info()
850 FWCMD_SET_ADDR_ADDR_MASK(cmd, addr_cam->addr_mask); in rtw89_cam_fill_addr_cam_info()
851 FWCMD_SET_ADDR_MASK_SEL(cmd, addr_cam->mask_sel); in rtw89_cam_fill_addr_cam_info()
855 FWCMD_SET_ADDR_BSSID_CAM_IDX(cmd, addr_cam->bssid_cam_idx); in rtw89_cam_fill_addr_cam_info()
857 FWCMD_SET_ADDR_SMA0(cmd, sma[0]); in rtw89_cam_fill_addr_cam_info()
864 FWCMD_SET_ADDR_TMA0(cmd, tma[0]); in rtw89_cam_fill_addr_cam_info()
871 FWCMD_SET_ADDR_PORT_INT(cmd, rtwvif_link->port); in rtw89_cam_fill_addr_cam_info()
872 FWCMD_SET_ADDR_TSF_SYNC(cmd, rtwvif_link->port); in rtw89_cam_fill_addr_cam_info()
873 FWCMD_SET_ADDR_TF_TRS(cmd, rtwvif_link->trigger); in rtw89_cam_fill_addr_cam_info()
874 FWCMD_SET_ADDR_LSIG_TXOP(cmd, rtwvif_link->lsig_txop); in rtw89_cam_fill_addr_cam_info()
875 FWCMD_SET_ADDR_TGT_IND(cmd, rtwvif_link->tgt_ind); in rtw89_cam_fill_addr_cam_info()
876 FWCMD_SET_ADDR_FRM_TGT_IND(cmd, rtwvif_link->frm_tgt_ind); in rtw89_cam_fill_addr_cam_info()
877 FWCMD_SET_ADDR_MACID(cmd, rtwsta_link ? rtwsta_link->mac_id : in rtw89_cam_fill_addr_cam_info()
878 rtwvif_link->mac_id); in rtw89_cam_fill_addr_cam_info()
879 if (rtwvif_link->net_type == RTW89_NET_TYPE_INFRA) in rtw89_cam_fill_addr_cam_info()
880 FWCMD_SET_ADDR_AID12(cmd, vif->cfg.aid & 0xfff); in rtw89_cam_fill_addr_cam_info()
881 else if (rtwvif_link->net_type == RTW89_NET_TYPE_AP_MODE) in rtw89_cam_fill_addr_cam_info()
882 FWCMD_SET_ADDR_AID12(cmd, sta ? sta->aid & 0xfff : 0); in rtw89_cam_fill_addr_cam_info()
883 FWCMD_SET_ADDR_WOL_PATTERN(cmd, rtwvif_link->wowlan_pattern); in rtw89_cam_fill_addr_cam_info()
884 FWCMD_SET_ADDR_WOL_UC(cmd, rtwvif_link->wowlan_uc); in rtw89_cam_fill_addr_cam_info()
885 FWCMD_SET_ADDR_WOL_MAGIC(cmd, rtwvif_link->wowlan_magic); in rtw89_cam_fill_addr_cam_info()
886 FWCMD_SET_ADDR_WAPI(cmd, addr_cam->wapi); in rtw89_cam_fill_addr_cam_info()
887 FWCMD_SET_ADDR_SEC_ENT_MODE(cmd, addr_cam->sec_ent_mode); in rtw89_cam_fill_addr_cam_info()
888 FWCMD_SET_ADDR_SEC_ENT0_KEYID(cmd, addr_cam->sec_ent_keyid[0]); in rtw89_cam_fill_addr_cam_info()
889 FWCMD_SET_ADDR_SEC_ENT1_KEYID(cmd, addr_cam->sec_ent_keyid[1]); in rtw89_cam_fill_addr_cam_info()
890 FWCMD_SET_ADDR_SEC_ENT2_KEYID(cmd, addr_cam->sec_ent_keyid[2]); in rtw89_cam_fill_addr_cam_info()
891 FWCMD_SET_ADDR_SEC_ENT3_KEYID(cmd, addr_cam->sec_ent_keyid[3]); in rtw89_cam_fill_addr_cam_info()
892 FWCMD_SET_ADDR_SEC_ENT4_KEYID(cmd, addr_cam->sec_ent_keyid[4]); in rtw89_cam_fill_addr_cam_info()
893 FWCMD_SET_ADDR_SEC_ENT5_KEYID(cmd, addr_cam->sec_ent_keyid[5]); in rtw89_cam_fill_addr_cam_info()
894 FWCMD_SET_ADDR_SEC_ENT6_KEYID(cmd, addr_cam->sec_ent_keyid[6]); in rtw89_cam_fill_addr_cam_info()
896 FWCMD_SET_ADDR_SEC_ENT_VALID(cmd, addr_cam->sec_cam_map[0] & 0xff); in rtw89_cam_fill_addr_cam_info()
897 FWCMD_SET_ADDR_SEC_ENT0(cmd, addr_cam->sec_ent[0]); in rtw89_cam_fill_addr_cam_info()
898 FWCMD_SET_ADDR_SEC_ENT1(cmd, addr_cam->sec_ent[1]); in rtw89_cam_fill_addr_cam_info()
899 FWCMD_SET_ADDR_SEC_ENT2(cmd, addr_cam->sec_ent[2]); in rtw89_cam_fill_addr_cam_info()
900 FWCMD_SET_ADDR_SEC_ENT3(cmd, addr_cam->sec_ent[3]); in rtw89_cam_fill_addr_cam_info()
901 FWCMD_SET_ADDR_SEC_ENT4(cmd, addr_cam->sec_ent[4]); in rtw89_cam_fill_addr_cam_info()
902 FWCMD_SET_ADDR_SEC_ENT5(cmd, addr_cam->sec_ent[5]); in rtw89_cam_fill_addr_cam_info()
903 FWCMD_SET_ADDR_SEC_ENT6(cmd, addr_cam->sec_ent[6]); in rtw89_cam_fill_addr_cam_info()
915 struct rtw89_wow_param *rtw_wow = &rtwdev->wow; in rtw89_cam_fill_dctl_sec_cam_info_v1()
916 u8 *ptk_tx_iv = rtw_wow->key_info.ptk_tx_iv; in rtw89_cam_fill_dctl_sec_cam_info_v1()
918 h2c->c0 = le32_encode_bits(rtwsta_link ? rtwsta_link->mac_id : in rtw89_cam_fill_dctl_sec_cam_info_v1()
919 rtwvif_link->mac_id, in rtw89_cam_fill_dctl_sec_cam_info_v1()
923 h2c->w4 = le32_encode_bits(addr_cam->sec_ent_keyid[0], in rtw89_cam_fill_dctl_sec_cam_info_v1()
925 le32_encode_bits(addr_cam->sec_ent_keyid[1], in rtw89_cam_fill_dctl_sec_cam_info_v1()
927 le32_encode_bits(addr_cam->sec_ent_keyid[2], in rtw89_cam_fill_dctl_sec_cam_info_v1()
929 le32_encode_bits(addr_cam->sec_ent_keyid[3], in rtw89_cam_fill_dctl_sec_cam_info_v1()
931 le32_encode_bits(addr_cam->sec_ent_keyid[4], in rtw89_cam_fill_dctl_sec_cam_info_v1()
933 le32_encode_bits(addr_cam->sec_ent_keyid[5], in rtw89_cam_fill_dctl_sec_cam_info_v1()
935 le32_encode_bits(addr_cam->sec_ent_keyid[6], in rtw89_cam_fill_dctl_sec_cam_info_v1()
937 h2c->m4 = cpu_to_le32(DCTLINFO_V1_W4_SEC_ENT0_KEYID | in rtw89_cam_fill_dctl_sec_cam_info_v1()
945 h2c->w5 = le32_encode_bits(addr_cam->sec_cam_map[0] & 0xff, in rtw89_cam_fill_dctl_sec_cam_info_v1()
947 le32_encode_bits(addr_cam->sec_ent[0], in rtw89_cam_fill_dctl_sec_cam_info_v1()
949 le32_encode_bits(addr_cam->sec_ent[1], in rtw89_cam_fill_dctl_sec_cam_info_v1()
951 le32_encode_bits(addr_cam->sec_ent[2], in rtw89_cam_fill_dctl_sec_cam_info_v1()
953 h2c->m5 = cpu_to_le32(DCTLINFO_V1_W5_SEC_ENT_VALID | in rtw89_cam_fill_dctl_sec_cam_info_v1()
958 h2c->w6 = le32_encode_bits(addr_cam->sec_ent[3], in rtw89_cam_fill_dctl_sec_cam_info_v1()
960 le32_encode_bits(addr_cam->sec_ent[4], in rtw89_cam_fill_dctl_sec_cam_info_v1()
962 le32_encode_bits(addr_cam->sec_ent[5], in rtw89_cam_fill_dctl_sec_cam_info_v1()
964 le32_encode_bits(addr_cam->sec_ent[6], in rtw89_cam_fill_dctl_sec_cam_info_v1()
966 h2c->m6 = cpu_to_le32(DCTLINFO_V1_W6_SEC_ENT3 | in rtw89_cam_fill_dctl_sec_cam_info_v1()
971 if (rtw_wow->ptk_alg) { in rtw89_cam_fill_dctl_sec_cam_info_v1()
972 h2c->w0 = le32_encode_bits(ptk_tx_iv[0] | ptk_tx_iv[1] << 8, in rtw89_cam_fill_dctl_sec_cam_info_v1()
974 h2c->m0 = cpu_to_le32(DCTLINFO_V1_W0_AES_IV_L); in rtw89_cam_fill_dctl_sec_cam_info_v1()
976 h2c->w1 = le32_encode_bits(ptk_tx_iv[4] | in rtw89_cam_fill_dctl_sec_cam_info_v1()
981 h2c->m1 = cpu_to_le32(DCTLINFO_V1_W1_AES_IV_H); in rtw89_cam_fill_dctl_sec_cam_info_v1()
983 h2c->w4 |= le32_encode_bits(rtw_wow->ptk_keyidx, in rtw89_cam_fill_dctl_sec_cam_info_v1()
985 h2c->m4 |= cpu_to_le32(DCTLINFO_V1_W4_SEC_KEY_ID); in rtw89_cam_fill_dctl_sec_cam_info_v1()
995 struct ieee80211_vif *vif = rtwvif_to_vif(rtwvif_link->rtwvif); in rtw89_cam_fill_dctl_sec_cam_info_v2()
996 struct rtw89_vif *rtwvif = rtwvif_link->rtwvif; in rtw89_cam_fill_dctl_sec_cam_info_v2()
999 bool is_mld = sta ? sta->mlo : ieee80211_vif_is_mld(vif); in rtw89_cam_fill_dctl_sec_cam_info_v2()
1000 struct rtw89_wow_param *rtw_wow = &rtwdev->wow; in rtw89_cam_fill_dctl_sec_cam_info_v2()
1001 u8 *ptk_tx_iv = rtw_wow->key_info.ptk_tx_iv; in rtw89_cam_fill_dctl_sec_cam_info_v2()
1004 h2c->c0 = le32_encode_bits(rtwsta_link ? rtwsta_link->mac_id : in rtw89_cam_fill_dctl_sec_cam_info_v2()
1005 rtwvif_link->mac_id, in rtw89_cam_fill_dctl_sec_cam_info_v2()
1009 h2c->w2 = le32_encode_bits(is_mld, DCTLINFO_V2_W2_IS_MLD); in rtw89_cam_fill_dctl_sec_cam_info_v2()
1010 h2c->m2 = cpu_to_le32(DCTLINFO_V2_W2_IS_MLD); in rtw89_cam_fill_dctl_sec_cam_info_v2()
1012 h2c->w4 = le32_encode_bits(addr_cam->sec_ent_keyid[0], in rtw89_cam_fill_dctl_sec_cam_info_v2()
1014 le32_encode_bits(addr_cam->sec_ent_keyid[1], in rtw89_cam_fill_dctl_sec_cam_info_v2()
1016 le32_encode_bits(addr_cam->sec_ent_keyid[2], in rtw89_cam_fill_dctl_sec_cam_info_v2()
1018 le32_encode_bits(addr_cam->sec_ent_keyid[3], in rtw89_cam_fill_dctl_sec_cam_info_v2()
1020 le32_encode_bits(addr_cam->sec_ent_keyid[4], in rtw89_cam_fill_dctl_sec_cam_info_v2()
1022 le32_encode_bits(addr_cam->sec_ent_keyid[5], in rtw89_cam_fill_dctl_sec_cam_info_v2()
1024 le32_encode_bits(addr_cam->sec_ent_keyid[6], in rtw89_cam_fill_dctl_sec_cam_info_v2()
1026 h2c->m4 = cpu_to_le32(DCTLINFO_V2_W4_SEC_ENT0_KEYID | in rtw89_cam_fill_dctl_sec_cam_info_v2()
1034 h2c->w5 = le32_encode_bits(addr_cam->sec_cam_map[0], in rtw89_cam_fill_dctl_sec_cam_info_v2()
1036 le32_encode_bits(addr_cam->sec_ent[0], in rtw89_cam_fill_dctl_sec_cam_info_v2()
1038 h2c->m5 = cpu_to_le32(DCTLINFO_V2_W5_SEC_ENT_VALID_V1 | in rtw89_cam_fill_dctl_sec_cam_info_v2()
1041 h2c->w6 = le32_encode_bits(addr_cam->sec_ent[1], in rtw89_cam_fill_dctl_sec_cam_info_v2()
1043 le32_encode_bits(addr_cam->sec_ent[2], in rtw89_cam_fill_dctl_sec_cam_info_v2()
1045 le32_encode_bits(addr_cam->sec_ent[3], in rtw89_cam_fill_dctl_sec_cam_info_v2()
1047 le32_encode_bits(addr_cam->sec_ent[4], in rtw89_cam_fill_dctl_sec_cam_info_v2()
1049 h2c->m6 = cpu_to_le32(DCTLINFO_V2_W6_SEC_ENT1_V1 | in rtw89_cam_fill_dctl_sec_cam_info_v2()
1054 h2c->w7 = le32_encode_bits(addr_cam->sec_ent[5], in rtw89_cam_fill_dctl_sec_cam_info_v2()
1056 le32_encode_bits(addr_cam->sec_ent[6], in rtw89_cam_fill_dctl_sec_cam_info_v2()
1058 h2c->m7 = cpu_to_le32(DCTLINFO_V2_W7_SEC_ENT5_V1 | in rtw89_cam_fill_dctl_sec_cam_info_v2()
1061 if (rtw_wow->ptk_alg) { in rtw89_cam_fill_dctl_sec_cam_info_v2()
1062 h2c->w0 = le32_encode_bits(ptk_tx_iv[0] | ptk_tx_iv[1] << 8, in rtw89_cam_fill_dctl_sec_cam_info_v2()
1064 h2c->m0 = cpu_to_le32(DCTLINFO_V2_W0_AES_IV_L); in rtw89_cam_fill_dctl_sec_cam_info_v2()
1066 h2c->w1 = le32_encode_bits(ptk_tx_iv[4] | in rtw89_cam_fill_dctl_sec_cam_info_v2()
1071 h2c->m1 = cpu_to_le32(DCTLINFO_V2_W1_AES_IV_H); in rtw89_cam_fill_dctl_sec_cam_info_v2()
1073 h2c->w4 |= le32_encode_bits(rtw_wow->ptk_keyidx, in rtw89_cam_fill_dctl_sec_cam_info_v2()
1075 h2c->m4 |= cpu_to_le32(DCTLINFO_V2_W4_SEC_KEY_ID); in rtw89_cam_fill_dctl_sec_cam_info_v2()
1081 if (rtwvif_link->net_type == RTW89_NET_TYPE_INFRA) { in rtw89_cam_fill_dctl_sec_cam_info_v2()
1082 mld_sma = rtwvif->mac_addr; in rtw89_cam_fill_dctl_sec_cam_info_v2()
1083 mld_tma = vif->cfg.ap_addr; in rtw89_cam_fill_dctl_sec_cam_info_v2()
1084 mld_bssid = vif->cfg.ap_addr; in rtw89_cam_fill_dctl_sec_cam_info_v2()
1085 } else if (rtwvif_link->net_type == RTW89_NET_TYPE_AP_MODE && sta) { in rtw89_cam_fill_dctl_sec_cam_info_v2()
1086 mld_sma = rtwvif->mac_addr; in rtw89_cam_fill_dctl_sec_cam_info_v2()
1087 mld_tma = sta->addr; in rtw89_cam_fill_dctl_sec_cam_info_v2()
1088 mld_bssid = rtwvif->mac_addr; in rtw89_cam_fill_dctl_sec_cam_info_v2()
1093 h2c->w8 = le32_encode_bits(mld_sma[0], DCTLINFO_V2_W8_MLD_SMA_0) | in rtw89_cam_fill_dctl_sec_cam_info_v2()
1097 h2c->m8 = cpu_to_le32(DCTLINFO_V2_W8_ALL); in rtw89_cam_fill_dctl_sec_cam_info_v2()
1099 h2c->w9 = le32_encode_bits(mld_sma[4], DCTLINFO_V2_W9_MLD_SMA_4) | in rtw89_cam_fill_dctl_sec_cam_info_v2()
1101 le32_encode_bits(mld_tma[0], DCTLINFO_V2_W9_MLD_TMA_0) | in rtw89_cam_fill_dctl_sec_cam_info_v2()
1103 h2c->m9 = cpu_to_le32(DCTLINFO_V2_W9_ALL); in rtw89_cam_fill_dctl_sec_cam_info_v2()
1105 h2c->w10 = le32_encode_bits(mld_tma[2], DCTLINFO_V2_W10_MLD_TMA_2) | in rtw89_cam_fill_dctl_sec_cam_info_v2()
1109 h2c->m10 = cpu_to_le32(DCTLINFO_V2_W10_ALL); in rtw89_cam_fill_dctl_sec_cam_info_v2()
1111 h2c->w11 = le32_encode_bits(mld_bssid[0], DCTLINFO_V2_W11_MLD_BSSID_0) | in rtw89_cam_fill_dctl_sec_cam_info_v2()
1115 h2c->m11 = cpu_to_le32(DCTLINFO_V2_W11_ALL); in rtw89_cam_fill_dctl_sec_cam_info_v2()
1117 h2c->w12 = le32_encode_bits(mld_bssid[4], DCTLINFO_V2_W12_MLD_BSSID_4) | in rtw89_cam_fill_dctl_sec_cam_info_v2()
1119 h2c->m12 = cpu_to_le32(DCTLINFO_V2_W12_ALL); in rtw89_cam_fill_dctl_sec_cam_info_v2()