Author | Tokens | Token Proportion | Commits | Commit Proportion |
---|---|---|---|---|
Ping-Ke Shih | 4307 | 91.27% | 14 | 63.64% |
Chih-Kang Chang | 356 | 7.54% | 4 | 18.18% |
Zong-Zhe Yang | 34 | 0.72% | 1 | 4.55% |
Chin-Yen Lee | 20 | 0.42% | 1 | 4.55% |
Yang Yingliang | 1 | 0.02% | 1 | 4.55% |
Johannes Berg | 1 | 0.02% | 1 | 4.55% |
Total | 4719 | 22 |
123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916
// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause /* Copyright(c) 2019-2020 Realtek Corporation */ #include "cam.h" #include "debug.h" #include "fw.h" #include "mac.h" static struct sk_buff * rtw89_cam_get_sec_key_cmd(struct rtw89_dev *rtwdev, struct rtw89_sec_cam_entry *sec_cam, bool ext_key) { struct sk_buff *skb; u32 cmd_len = H2C_SEC_CAM_LEN; u32 key32[4]; u8 *cmd; int i, j; skb = rtw89_fw_h2c_alloc_skb_with_hdr(rtwdev, cmd_len); if (!skb) return NULL; skb_put_zero(skb, cmd_len); for (i = 0; i < 4; i++) { j = i * 4; j += ext_key ? 16 : 0; key32[i] = FIELD_PREP(GENMASK(7, 0), sec_cam->key[j + 0]) | FIELD_PREP(GENMASK(15, 8), sec_cam->key[j + 1]) | FIELD_PREP(GENMASK(23, 16), sec_cam->key[j + 2]) | FIELD_PREP(GENMASK(31, 24), sec_cam->key[j + 3]); } cmd = skb->data; RTW89_SET_FWCMD_SEC_IDX(cmd, sec_cam->sec_cam_idx + (ext_key ? 1 : 0)); RTW89_SET_FWCMD_SEC_OFFSET(cmd, sec_cam->offset); RTW89_SET_FWCMD_SEC_LEN(cmd, sec_cam->len); RTW89_SET_FWCMD_SEC_TYPE(cmd, sec_cam->type); RTW89_SET_FWCMD_SEC_EXT_KEY(cmd, ext_key); RTW89_SET_FWCMD_SEC_SPP_MODE(cmd, sec_cam->spp_mode); RTW89_SET_FWCMD_SEC_KEY0(cmd, key32[0]); RTW89_SET_FWCMD_SEC_KEY1(cmd, key32[1]); RTW89_SET_FWCMD_SEC_KEY2(cmd, key32[2]); RTW89_SET_FWCMD_SEC_KEY3(cmd, key32[3]); return skb; } static int rtw89_cam_send_sec_key_cmd(struct rtw89_dev *rtwdev, struct rtw89_sec_cam_entry *sec_cam) { struct sk_buff *skb, *ext_skb; int ret; skb = rtw89_cam_get_sec_key_cmd(rtwdev, sec_cam, false); if (!skb) { rtw89_err(rtwdev, "failed to get sec key command\n"); return -ENOMEM; } rtw89_h2c_pkt_set_hdr(rtwdev, skb, FWCMD_TYPE_H2C, H2C_CAT_MAC, H2C_CL_MAC_SEC_CAM, H2C_FUNC_MAC_SEC_UPD, 1, 0, H2C_SEC_CAM_LEN); ret = rtw89_h2c_tx(rtwdev, skb, false); if (ret) { rtw89_err(rtwdev, "failed to send sec key h2c: %d\n", ret); dev_kfree_skb(skb); return ret; } if (!sec_cam->ext_key) return 0; ext_skb = rtw89_cam_get_sec_key_cmd(rtwdev, sec_cam, true); if (!ext_skb) { rtw89_err(rtwdev, "failed to get ext sec key command\n"); return -ENOMEM; } rtw89_h2c_pkt_set_hdr(rtwdev, ext_skb, FWCMD_TYPE_H2C, H2C_CAT_MAC, H2C_CL_MAC_SEC_CAM, H2C_FUNC_MAC_SEC_UPD, 1, 0, H2C_SEC_CAM_LEN); ret = rtw89_h2c_tx(rtwdev, ext_skb, false); if (ret) { rtw89_err(rtwdev, "failed to send ext sec key h2c: %d\n", ret); dev_kfree_skb(ext_skb); return ret; } return 0; } static int rtw89_cam_get_avail_sec_cam(struct rtw89_dev *rtwdev, u8 *sec_cam_idx, bool ext_key) { const struct rtw89_chip_info *chip = rtwdev->chip; struct rtw89_cam_info *cam_info = &rtwdev->cam_info; u8 sec_cam_num = chip->scam_num; u8 idx = 0; if (!ext_key) { idx = find_first_zero_bit(cam_info->sec_cam_map, sec_cam_num); if (idx >= sec_cam_num) return -EBUSY; set_bit(idx, cam_info->sec_cam_map); *sec_cam_idx = idx; return 0; } again: idx = find_next_zero_bit(cam_info->sec_cam_map, sec_cam_num, idx); if (idx >= sec_cam_num - 1) return -EBUSY; /* ext keys need two cam entries for 256-bit key */ if (test_bit(idx + 1, cam_info->sec_cam_map)) { idx++; goto again; } set_bit(idx, cam_info->sec_cam_map); set_bit(idx + 1, cam_info->sec_cam_map); *sec_cam_idx = idx; return 0; } static int 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) { u8 idx; /* RTW89_ADDR_CAM_SEC_NONE : not enabled * RTW89_ADDR_CAM_SEC_ALL_UNI : 0 - 6 unicast * RTW89_ADDR_CAM_SEC_NORMAL : 0 - 1 unicast, 2 - 4 group, 5 - 6 BIP * RTW89_ADDR_CAM_SEC_4GROUP : 0 - 1 unicast, 2 - 5 group, 6 BIP */ switch (addr_cam->sec_ent_mode) { case RTW89_ADDR_CAM_SEC_NONE: return -EINVAL; case RTW89_ADDR_CAM_SEC_ALL_UNI: idx = find_first_zero_bit(addr_cam->sec_cam_map, RTW89_SEC_CAM_IN_ADDR_CAM); if (idx >= RTW89_SEC_CAM_IN_ADDR_CAM) return -EBUSY; *key_idx = idx; break; case RTW89_ADDR_CAM_SEC_NORMAL: if (sec_cam->type == RTW89_SEC_KEY_TYPE_BIP_CCMP128) { idx = find_next_zero_bit(addr_cam->sec_cam_map, RTW89_SEC_CAM_IN_ADDR_CAM, 5); if (idx > 6) return -EBUSY; *key_idx = idx; break; } if (key->flags & IEEE80211_KEY_FLAG_PAIRWISE) { idx = find_next_zero_bit(addr_cam->sec_cam_map, RTW89_SEC_CAM_IN_ADDR_CAM, 0); if (idx > 1) return -EBUSY; *key_idx = idx; break; } /* Group keys */ idx = find_next_zero_bit(addr_cam->sec_cam_map, RTW89_SEC_CAM_IN_ADDR_CAM, 2); if (idx > 4) return -EBUSY; *key_idx = idx; break; case RTW89_ADDR_CAM_SEC_4GROUP: if (sec_cam->type == RTW89_SEC_KEY_TYPE_BIP_CCMP128) { if (test_bit(6, addr_cam->sec_cam_map)) return -EINVAL; *key_idx = 6; break; } if (key->flags & IEEE80211_KEY_FLAG_PAIRWISE) { idx = find_next_zero_bit(addr_cam->sec_cam_map, RTW89_SEC_CAM_IN_ADDR_CAM, 0); if (idx > 1) return -EBUSY; *key_idx = idx; break; } /* Group keys */ idx = find_next_zero_bit(addr_cam->sec_cam_map, RTW89_SEC_CAM_IN_ADDR_CAM, 2); if (idx > 5) return -EBUSY; *key_idx = idx; break; } return 0; } static int 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) { struct rtw89_sta *rtwsta = sta_to_rtwsta_safe(sta); struct rtw89_vif *rtwvif; struct rtw89_addr_cam_entry *addr_cam; u8 key_idx = 0; int ret; if (!vif) { rtw89_err(rtwdev, "No iface for adding sec cam\n"); return -EINVAL; } rtwvif = (struct rtw89_vif *)vif->drv_priv; addr_cam = rtw89_get_addr_cam_of(rtwvif, rtwsta); if (key->cipher == WLAN_CIPHER_SUITE_WEP40 || key->cipher == WLAN_CIPHER_SUITE_WEP104) addr_cam->sec_ent_mode = RTW89_ADDR_CAM_SEC_ALL_UNI; ret = rtw89_cam_get_addr_cam_key_idx(addr_cam, sec_cam, key, &key_idx); if (ret) { rtw89_err(rtwdev, "failed to get addr cam key idx %d, %d\n", addr_cam->sec_ent_mode, sec_cam->type); return ret; } key->hw_key_idx = key_idx; addr_cam->sec_ent_keyid[key_idx] = key->keyidx; addr_cam->sec_ent[key_idx] = sec_cam->sec_cam_idx; addr_cam->sec_entries[key_idx] = sec_cam; set_bit(key_idx, addr_cam->sec_cam_map); ret = rtw89_chip_h2c_dctl_sec_cam(rtwdev, rtwvif, rtwsta); if (ret) { rtw89_err(rtwdev, "failed to update dctl cam sec entry: %d\n", ret); return ret; } ret = rtw89_fw_h2c_cam(rtwdev, rtwvif, rtwsta, NULL); if (ret) { rtw89_err(rtwdev, "failed to update addr cam sec entry: %d\n", ret); clear_bit(key_idx, addr_cam->sec_cam_map); addr_cam->sec_entries[key_idx] = NULL; return ret; } return 0; } static int 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) { struct rtw89_sec_cam_entry *sec_cam = NULL; struct rtw89_cam_info *cam_info = &rtwdev->cam_info; u8 sec_cam_idx; int ret; /* maximum key length 256-bit */ if (key->keylen > 32) { rtw89_err(rtwdev, "invalid sec key length %d\n", key->keylen); return -EINVAL; } ret = rtw89_cam_get_avail_sec_cam(rtwdev, &sec_cam_idx, ext_key); if (ret) { rtw89_warn(rtwdev, "no available sec cam: %d ext: %d\n", ret, ext_key); return ret; } sec_cam = kzalloc(sizeof(*sec_cam), GFP_KERNEL); if (!sec_cam) { ret = -ENOMEM; goto err_release_cam; } sec_cam->sec_cam_idx = sec_cam_idx; sec_cam->type = hw_key_type; sec_cam->len = RTW89_SEC_CAM_LEN; sec_cam->ext_key = ext_key; memcpy(sec_cam->key, key->key, key->keylen); ret = rtw89_cam_send_sec_key_cmd(rtwdev, sec_cam); if (ret) { rtw89_err(rtwdev, "failed to send sec key cmd: %d\n", ret); goto err_release_cam; } /* associate with addr cam */ ret = rtw89_cam_attach_sec_cam(rtwdev, vif, sta, key, sec_cam); if (ret) { rtw89_err(rtwdev, "failed to attach sec cam: %d\n", ret); goto err_release_cam; } return 0; err_release_cam: kfree(sec_cam); clear_bit(sec_cam_idx, cam_info->sec_cam_map); if (ext_key) clear_bit(sec_cam_idx + 1, cam_info->sec_cam_map); return ret; } int rtw89_cam_sec_key_add(struct rtw89_dev *rtwdev, struct ieee80211_vif *vif, struct ieee80211_sta *sta, struct ieee80211_key_conf *key) { const struct rtw89_chip_info *chip = rtwdev->chip; u8 hw_key_type; bool ext_key = false; int ret; switch (key->cipher) { case WLAN_CIPHER_SUITE_WEP40: hw_key_type = RTW89_SEC_KEY_TYPE_WEP40; break; case WLAN_CIPHER_SUITE_WEP104: hw_key_type = RTW89_SEC_KEY_TYPE_WEP104; break; case WLAN_CIPHER_SUITE_CCMP: hw_key_type = RTW89_SEC_KEY_TYPE_CCMP128; key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX; break; case WLAN_CIPHER_SUITE_CCMP_256: hw_key_type = RTW89_SEC_KEY_TYPE_CCMP256; key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX; ext_key = true; break; case WLAN_CIPHER_SUITE_GCMP: hw_key_type = RTW89_SEC_KEY_TYPE_GCMP128; key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX; break; case WLAN_CIPHER_SUITE_GCMP_256: hw_key_type = RTW89_SEC_KEY_TYPE_GCMP256; key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX; ext_key = true; break; case WLAN_CIPHER_SUITE_AES_CMAC: hw_key_type = RTW89_SEC_KEY_TYPE_BIP_CCMP128; break; default: return -EOPNOTSUPP; } if (!chip->hw_sec_hdr) key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV; ret = rtw89_cam_sec_key_install(rtwdev, vif, sta, key, hw_key_type, ext_key); if (ret) { rtw89_err(rtwdev, "failed to install key type %d ext %d: %d\n", hw_key_type, ext_key, ret); return ret; } return 0; } int 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) { struct rtw89_sta *rtwsta = sta_to_rtwsta_safe(sta); struct rtw89_cam_info *cam_info = &rtwdev->cam_info; struct rtw89_vif *rtwvif; struct rtw89_addr_cam_entry *addr_cam; struct rtw89_sec_cam_entry *sec_cam; u8 key_idx = key->hw_key_idx; u8 sec_cam_idx; int ret = 0; if (!vif) { rtw89_err(rtwdev, "No iface for deleting sec cam\n"); return -EINVAL; } rtwvif = (struct rtw89_vif *)vif->drv_priv; addr_cam = rtw89_get_addr_cam_of(rtwvif, rtwsta); sec_cam = addr_cam->sec_entries[key_idx]; if (!sec_cam) return -EINVAL; /* detach sec cam from addr cam */ clear_bit(key_idx, addr_cam->sec_cam_map); addr_cam->sec_entries[key_idx] = NULL; if (inform_fw) { ret = rtw89_chip_h2c_dctl_sec_cam(rtwdev, rtwvif, rtwsta); if (ret) rtw89_err(rtwdev, "failed to update dctl cam del key: %d\n", ret); ret = rtw89_fw_h2c_cam(rtwdev, rtwvif, rtwsta, NULL); if (ret) rtw89_err(rtwdev, "failed to update cam del key: %d\n", ret); } /* clear valid bit in addr cam will disable sec cam, * so we don't need to send H2C command again */ sec_cam_idx = sec_cam->sec_cam_idx; clear_bit(sec_cam_idx, cam_info->sec_cam_map); if (sec_cam->ext_key) clear_bit(sec_cam_idx + 1, cam_info->sec_cam_map); kfree(sec_cam); return ret; } static void rtw89_cam_reset_key_iter(struct ieee80211_hw *hw, struct ieee80211_vif *vif, struct ieee80211_sta *sta, struct ieee80211_key_conf *key, void *data) { struct rtw89_dev *rtwdev = (struct rtw89_dev *)data; rtw89_cam_sec_key_del(rtwdev, vif, sta, key, false); } void rtw89_cam_deinit_addr_cam(struct rtw89_dev *rtwdev, struct rtw89_addr_cam_entry *addr_cam) { struct rtw89_cam_info *cam_info = &rtwdev->cam_info; addr_cam->valid = false; clear_bit(addr_cam->addr_cam_idx, cam_info->addr_cam_map); } void rtw89_cam_deinit_bssid_cam(struct rtw89_dev *rtwdev, struct rtw89_bssid_cam_entry *bssid_cam) { struct rtw89_cam_info *cam_info = &rtwdev->cam_info; bssid_cam->valid = false; clear_bit(bssid_cam->bssid_cam_idx, cam_info->bssid_cam_map); } void rtw89_cam_deinit(struct rtw89_dev *rtwdev, struct rtw89_vif *rtwvif) { struct rtw89_addr_cam_entry *addr_cam = &rtwvif->addr_cam; struct rtw89_bssid_cam_entry *bssid_cam = &rtwvif->bssid_cam; rtw89_cam_deinit_addr_cam(rtwdev, addr_cam); rtw89_cam_deinit_bssid_cam(rtwdev, bssid_cam); } void rtw89_cam_reset_keys(struct rtw89_dev *rtwdev) { rcu_read_lock(); ieee80211_iter_keys_rcu(rtwdev->hw, NULL, rtw89_cam_reset_key_iter, rtwdev); rcu_read_unlock(); } static int rtw89_cam_get_avail_addr_cam(struct rtw89_dev *rtwdev, u8 *addr_cam_idx) { const struct rtw89_chip_info *chip = rtwdev->chip; struct rtw89_cam_info *cam_info = &rtwdev->cam_info; u8 addr_cam_num = chip->acam_num; u8 idx; idx = find_first_zero_bit(cam_info->addr_cam_map, addr_cam_num); if (idx >= addr_cam_num) return -EBUSY; set_bit(idx, cam_info->addr_cam_map); *addr_cam_idx = idx; return 0; } static u8 rtw89_get_addr_cam_entry_size(struct rtw89_dev *rtwdev) { const struct rtw89_chip_info *chip = rtwdev->chip; switch (chip->chip_id) { case RTL8852A: case RTL8852B: case RTL8851B: return ADDR_CAM_ENT_SIZE; default: return ADDR_CAM_ENT_SHORT_SIZE; } } int rtw89_cam_init_addr_cam(struct rtw89_dev *rtwdev, struct rtw89_addr_cam_entry *addr_cam, const struct rtw89_bssid_cam_entry *bssid_cam) { u8 addr_cam_idx; int i; int ret; if (unlikely(addr_cam->valid)) { rtw89_debug(rtwdev, RTW89_DBG_FW, "addr cam is already valid; skip init\n"); return 0; } ret = rtw89_cam_get_avail_addr_cam(rtwdev, &addr_cam_idx); if (ret) { rtw89_err(rtwdev, "failed to get available addr cam\n"); return ret; } addr_cam->addr_cam_idx = addr_cam_idx; addr_cam->len = rtw89_get_addr_cam_entry_size(rtwdev); addr_cam->offset = 0; addr_cam->valid = true; addr_cam->addr_mask = 0; addr_cam->mask_sel = RTW89_NO_MSK; addr_cam->sec_ent_mode = RTW89_ADDR_CAM_SEC_NORMAL; bitmap_zero(addr_cam->sec_cam_map, RTW89_SEC_CAM_IN_ADDR_CAM); for (i = 0; i < RTW89_SEC_CAM_IN_ADDR_CAM; i++) { addr_cam->sec_ent_keyid[i] = 0; addr_cam->sec_ent[i] = 0; } /* associate addr cam with bssid cam */ addr_cam->bssid_cam_idx = bssid_cam->bssid_cam_idx; return 0; } static int rtw89_cam_get_avail_bssid_cam(struct rtw89_dev *rtwdev, u8 *bssid_cam_idx) { const struct rtw89_chip_info *chip = rtwdev->chip; struct rtw89_cam_info *cam_info = &rtwdev->cam_info; u8 bssid_cam_num = chip->bcam_num; u8 idx; idx = find_first_zero_bit(cam_info->bssid_cam_map, bssid_cam_num); if (idx >= bssid_cam_num) return -EBUSY; set_bit(idx, cam_info->bssid_cam_map); *bssid_cam_idx = idx; return 0; } int rtw89_cam_init_bssid_cam(struct rtw89_dev *rtwdev, struct rtw89_vif *rtwvif, struct rtw89_bssid_cam_entry *bssid_cam, const u8 *bssid) { u8 bssid_cam_idx; int ret; if (unlikely(bssid_cam->valid)) { rtw89_debug(rtwdev, RTW89_DBG_FW, "bssid cam is already valid; skip init\n"); return 0; } ret = rtw89_cam_get_avail_bssid_cam(rtwdev, &bssid_cam_idx); if (ret) { rtw89_err(rtwdev, "failed to get available bssid cam\n"); return ret; } bssid_cam->bssid_cam_idx = bssid_cam_idx; bssid_cam->phy_idx = rtwvif->phy_idx; bssid_cam->len = BSSID_CAM_ENT_SIZE; bssid_cam->offset = 0; bssid_cam->valid = true; ether_addr_copy(bssid_cam->bssid, bssid); return 0; } void rtw89_cam_bssid_changed(struct rtw89_dev *rtwdev, struct rtw89_vif *rtwvif) { struct rtw89_bssid_cam_entry *bssid_cam = &rtwvif->bssid_cam; ether_addr_copy(bssid_cam->bssid, rtwvif->bssid); } int rtw89_cam_init(struct rtw89_dev *rtwdev, struct rtw89_vif *rtwvif) { struct rtw89_addr_cam_entry *addr_cam = &rtwvif->addr_cam; struct rtw89_bssid_cam_entry *bssid_cam = &rtwvif->bssid_cam; int ret; ret = rtw89_cam_init_bssid_cam(rtwdev, rtwvif, bssid_cam, rtwvif->bssid); if (ret) { rtw89_err(rtwdev, "failed to init bssid cam\n"); return ret; } ret = rtw89_cam_init_addr_cam(rtwdev, addr_cam, bssid_cam); if (ret) { rtw89_err(rtwdev, "failed to init addr cam\n"); return ret; } return 0; } int rtw89_cam_fill_bssid_cam_info(struct rtw89_dev *rtwdev, struct rtw89_vif *rtwvif, struct rtw89_sta *rtwsta, u8 *cmd) { struct ieee80211_vif *vif = rtwvif_to_vif(rtwvif); struct rtw89_bssid_cam_entry *bssid_cam = rtw89_get_bssid_cam_of(rtwvif, rtwsta); u8 bss_color = vif->bss_conf.he_bss_color.color; u8 bss_mask; if (vif->bss_conf.nontransmitted) bss_mask = RTW89_BSSID_MATCH_5_BYTES; else bss_mask = RTW89_BSSID_MATCH_ALL; FWCMD_SET_ADDR_BSSID_IDX(cmd, bssid_cam->bssid_cam_idx); FWCMD_SET_ADDR_BSSID_OFFSET(cmd, bssid_cam->offset); FWCMD_SET_ADDR_BSSID_LEN(cmd, bssid_cam->len); FWCMD_SET_ADDR_BSSID_VALID(cmd, bssid_cam->valid); FWCMD_SET_ADDR_BSSID_MASK(cmd, bss_mask); FWCMD_SET_ADDR_BSSID_BB_SEL(cmd, bssid_cam->phy_idx); FWCMD_SET_ADDR_BSSID_BSS_COLOR(cmd, bss_color); FWCMD_SET_ADDR_BSSID_BSSID0(cmd, bssid_cam->bssid[0]); FWCMD_SET_ADDR_BSSID_BSSID1(cmd, bssid_cam->bssid[1]); FWCMD_SET_ADDR_BSSID_BSSID2(cmd, bssid_cam->bssid[2]); FWCMD_SET_ADDR_BSSID_BSSID3(cmd, bssid_cam->bssid[3]); FWCMD_SET_ADDR_BSSID_BSSID4(cmd, bssid_cam->bssid[4]); FWCMD_SET_ADDR_BSSID_BSSID5(cmd, bssid_cam->bssid[5]); return 0; } static u8 rtw89_cam_addr_hash(u8 start, const u8 *addr) { u8 hash = 0; u8 i; for (i = start; i < ETH_ALEN; i++) hash ^= addr[i]; return hash; } void 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) { struct ieee80211_vif *vif = rtwvif_to_vif(rtwvif); struct rtw89_addr_cam_entry *addr_cam = rtw89_get_addr_cam_of(rtwvif, rtwsta); struct ieee80211_sta *sta = rtwsta_to_sta_safe(rtwsta); const u8 *sma = scan_mac_addr ? scan_mac_addr : rtwvif->mac_addr; u8 sma_hash, tma_hash, addr_msk_start; u8 sma_start = 0; u8 tma_start = 0; u8 *tma = sta ? sta->addr : rtwvif->bssid; if (addr_cam->addr_mask != 0) { addr_msk_start = __ffs(addr_cam->addr_mask); if (addr_cam->mask_sel == RTW89_SMA) sma_start = addr_msk_start; else if (addr_cam->mask_sel == RTW89_TMA) tma_start = addr_msk_start; } sma_hash = rtw89_cam_addr_hash(sma_start, sma); tma_hash = rtw89_cam_addr_hash(tma_start, tma); FWCMD_SET_ADDR_IDX(cmd, addr_cam->addr_cam_idx); FWCMD_SET_ADDR_OFFSET(cmd, addr_cam->offset); FWCMD_SET_ADDR_LEN(cmd, addr_cam->len); FWCMD_SET_ADDR_VALID(cmd, addr_cam->valid); FWCMD_SET_ADDR_NET_TYPE(cmd, rtwvif->net_type); FWCMD_SET_ADDR_BCN_HIT_COND(cmd, rtwvif->bcn_hit_cond); FWCMD_SET_ADDR_HIT_RULE(cmd, rtwvif->hit_rule); FWCMD_SET_ADDR_BB_SEL(cmd, rtwvif->phy_idx); FWCMD_SET_ADDR_ADDR_MASK(cmd, addr_cam->addr_mask); FWCMD_SET_ADDR_MASK_SEL(cmd, addr_cam->mask_sel); FWCMD_SET_ADDR_SMA_HASH(cmd, sma_hash); FWCMD_SET_ADDR_TMA_HASH(cmd, tma_hash); FWCMD_SET_ADDR_BSSID_CAM_IDX(cmd, addr_cam->bssid_cam_idx); FWCMD_SET_ADDR_SMA0(cmd, sma[0]); FWCMD_SET_ADDR_SMA1(cmd, sma[1]); FWCMD_SET_ADDR_SMA2(cmd, sma[2]); FWCMD_SET_ADDR_SMA3(cmd, sma[3]); FWCMD_SET_ADDR_SMA4(cmd, sma[4]); FWCMD_SET_ADDR_SMA5(cmd, sma[5]); FWCMD_SET_ADDR_TMA0(cmd, tma[0]); FWCMD_SET_ADDR_TMA1(cmd, tma[1]); FWCMD_SET_ADDR_TMA2(cmd, tma[2]); FWCMD_SET_ADDR_TMA3(cmd, tma[3]); FWCMD_SET_ADDR_TMA4(cmd, tma[4]); FWCMD_SET_ADDR_TMA5(cmd, tma[5]); FWCMD_SET_ADDR_PORT_INT(cmd, rtwvif->port); FWCMD_SET_ADDR_TSF_SYNC(cmd, rtwvif->port); FWCMD_SET_ADDR_TF_TRS(cmd, rtwvif->trigger); FWCMD_SET_ADDR_LSIG_TXOP(cmd, rtwvif->lsig_txop); FWCMD_SET_ADDR_TGT_IND(cmd, rtwvif->tgt_ind); FWCMD_SET_ADDR_FRM_TGT_IND(cmd, rtwvif->frm_tgt_ind); FWCMD_SET_ADDR_MACID(cmd, rtwsta ? rtwsta->mac_id : rtwvif->mac_id); if (rtwvif->net_type == RTW89_NET_TYPE_INFRA) FWCMD_SET_ADDR_AID12(cmd, vif->cfg.aid & 0xfff); else if (rtwvif->net_type == RTW89_NET_TYPE_AP_MODE) FWCMD_SET_ADDR_AID12(cmd, sta ? sta->aid & 0xfff : 0); FWCMD_SET_ADDR_WOL_PATTERN(cmd, rtwvif->wowlan_pattern); FWCMD_SET_ADDR_WOL_UC(cmd, rtwvif->wowlan_uc); FWCMD_SET_ADDR_WOL_MAGIC(cmd, rtwvif->wowlan_magic); FWCMD_SET_ADDR_WAPI(cmd, addr_cam->wapi); FWCMD_SET_ADDR_SEC_ENT_MODE(cmd, addr_cam->sec_ent_mode); FWCMD_SET_ADDR_SEC_ENT0_KEYID(cmd, addr_cam->sec_ent_keyid[0]); FWCMD_SET_ADDR_SEC_ENT1_KEYID(cmd, addr_cam->sec_ent_keyid[1]); FWCMD_SET_ADDR_SEC_ENT2_KEYID(cmd, addr_cam->sec_ent_keyid[2]); FWCMD_SET_ADDR_SEC_ENT3_KEYID(cmd, addr_cam->sec_ent_keyid[3]); FWCMD_SET_ADDR_SEC_ENT4_KEYID(cmd, addr_cam->sec_ent_keyid[4]); FWCMD_SET_ADDR_SEC_ENT5_KEYID(cmd, addr_cam->sec_ent_keyid[5]); FWCMD_SET_ADDR_SEC_ENT6_KEYID(cmd, addr_cam->sec_ent_keyid[6]); FWCMD_SET_ADDR_SEC_ENT_VALID(cmd, addr_cam->sec_cam_map[0] & 0xff); FWCMD_SET_ADDR_SEC_ENT0(cmd, addr_cam->sec_ent[0]); FWCMD_SET_ADDR_SEC_ENT1(cmd, addr_cam->sec_ent[1]); FWCMD_SET_ADDR_SEC_ENT2(cmd, addr_cam->sec_ent[2]); FWCMD_SET_ADDR_SEC_ENT3(cmd, addr_cam->sec_ent[3]); FWCMD_SET_ADDR_SEC_ENT4(cmd, addr_cam->sec_ent[4]); FWCMD_SET_ADDR_SEC_ENT5(cmd, addr_cam->sec_ent[5]); FWCMD_SET_ADDR_SEC_ENT6(cmd, addr_cam->sec_ent[6]); } void rtw89_cam_fill_dctl_sec_cam_info_v1(struct rtw89_dev *rtwdev, struct rtw89_vif *rtwvif, struct rtw89_sta *rtwsta, struct rtw89_h2c_dctlinfo_ud_v1 *h2c) { struct rtw89_addr_cam_entry *addr_cam = rtw89_get_addr_cam_of(rtwvif, rtwsta); struct rtw89_wow_param *rtw_wow = &rtwdev->wow; u8 *ptk_tx_iv = rtw_wow->key_info.ptk_tx_iv; h2c->c0 = le32_encode_bits(rtwsta ? rtwsta->mac_id : rtwvif->mac_id, DCTLINFO_V1_C0_MACID) | le32_encode_bits(1, DCTLINFO_V1_C0_OP); h2c->w4 = le32_encode_bits(addr_cam->sec_ent_keyid[0], DCTLINFO_V1_W4_SEC_ENT0_KEYID) | le32_encode_bits(addr_cam->sec_ent_keyid[1], DCTLINFO_V1_W4_SEC_ENT1_KEYID) | le32_encode_bits(addr_cam->sec_ent_keyid[2], DCTLINFO_V1_W4_SEC_ENT2_KEYID) | le32_encode_bits(addr_cam->sec_ent_keyid[3], DCTLINFO_V1_W4_SEC_ENT3_KEYID) | le32_encode_bits(addr_cam->sec_ent_keyid[4], DCTLINFO_V1_W4_SEC_ENT4_KEYID) | le32_encode_bits(addr_cam->sec_ent_keyid[5], DCTLINFO_V1_W4_SEC_ENT5_KEYID) | le32_encode_bits(addr_cam->sec_ent_keyid[6], DCTLINFO_V1_W4_SEC_ENT6_KEYID); h2c->m4 = cpu_to_le32(DCTLINFO_V1_W4_SEC_ENT0_KEYID | DCTLINFO_V1_W4_SEC_ENT1_KEYID | DCTLINFO_V1_W4_SEC_ENT2_KEYID | DCTLINFO_V1_W4_SEC_ENT3_KEYID | DCTLINFO_V1_W4_SEC_ENT4_KEYID | DCTLINFO_V1_W4_SEC_ENT5_KEYID | DCTLINFO_V1_W4_SEC_ENT6_KEYID); h2c->w5 = le32_encode_bits(addr_cam->sec_cam_map[0] & 0xff, DCTLINFO_V1_W5_SEC_ENT_VALID) | le32_encode_bits(addr_cam->sec_ent[0], DCTLINFO_V1_W5_SEC_ENT0) | le32_encode_bits(addr_cam->sec_ent[1], DCTLINFO_V1_W5_SEC_ENT1) | le32_encode_bits(addr_cam->sec_ent[2], DCTLINFO_V1_W5_SEC_ENT2); h2c->m5 = cpu_to_le32(DCTLINFO_V1_W5_SEC_ENT_VALID | DCTLINFO_V1_W5_SEC_ENT0 | DCTLINFO_V1_W5_SEC_ENT1 | DCTLINFO_V1_W5_SEC_ENT2); h2c->w6 = le32_encode_bits(addr_cam->sec_ent[3], DCTLINFO_V1_W6_SEC_ENT3) | le32_encode_bits(addr_cam->sec_ent[4], DCTLINFO_V1_W6_SEC_ENT4) | le32_encode_bits(addr_cam->sec_ent[5], DCTLINFO_V1_W6_SEC_ENT5) | le32_encode_bits(addr_cam->sec_ent[6], DCTLINFO_V1_W6_SEC_ENT6); h2c->m6 = cpu_to_le32(DCTLINFO_V1_W6_SEC_ENT3 | DCTLINFO_V1_W6_SEC_ENT4 | DCTLINFO_V1_W6_SEC_ENT5 | DCTLINFO_V1_W6_SEC_ENT6); if (rtw_wow->ptk_alg) { h2c->w0 = le32_encode_bits(ptk_tx_iv[0] | ptk_tx_iv[1] << 8, DCTLINFO_V1_W0_AES_IV_L); h2c->m0 = cpu_to_le32(DCTLINFO_V1_W0_AES_IV_L); h2c->w1 = le32_encode_bits(ptk_tx_iv[4] | ptk_tx_iv[5] << 8 | ptk_tx_iv[6] << 16 | ptk_tx_iv[7] << 24, DCTLINFO_V1_W1_AES_IV_H); h2c->m1 = cpu_to_le32(DCTLINFO_V1_W1_AES_IV_H); h2c->w4 |= le32_encode_bits(rtw_wow->ptk_keyidx, DCTLINFO_V1_W4_SEC_KEY_ID); h2c->m4 |= cpu_to_le32(DCTLINFO_V1_W4_SEC_KEY_ID); } } void rtw89_cam_fill_dctl_sec_cam_info_v2(struct rtw89_dev *rtwdev, struct rtw89_vif *rtwvif, struct rtw89_sta *rtwsta, struct rtw89_h2c_dctlinfo_ud_v2 *h2c) { struct rtw89_addr_cam_entry *addr_cam = rtw89_get_addr_cam_of(rtwvif, rtwsta); struct rtw89_wow_param *rtw_wow = &rtwdev->wow; u8 *ptk_tx_iv = rtw_wow->key_info.ptk_tx_iv; h2c->c0 = le32_encode_bits(rtwsta ? rtwsta->mac_id : rtwvif->mac_id, DCTLINFO_V2_C0_MACID) | le32_encode_bits(1, DCTLINFO_V2_C0_OP); h2c->w4 = le32_encode_bits(addr_cam->sec_ent_keyid[0], DCTLINFO_V2_W4_SEC_ENT0_KEYID) | le32_encode_bits(addr_cam->sec_ent_keyid[1], DCTLINFO_V2_W4_SEC_ENT1_KEYID) | le32_encode_bits(addr_cam->sec_ent_keyid[2], DCTLINFO_V2_W4_SEC_ENT2_KEYID) | le32_encode_bits(addr_cam->sec_ent_keyid[3], DCTLINFO_V2_W4_SEC_ENT3_KEYID) | le32_encode_bits(addr_cam->sec_ent_keyid[4], DCTLINFO_V2_W4_SEC_ENT4_KEYID) | le32_encode_bits(addr_cam->sec_ent_keyid[5], DCTLINFO_V2_W4_SEC_ENT5_KEYID) | le32_encode_bits(addr_cam->sec_ent_keyid[6], DCTLINFO_V2_W4_SEC_ENT6_KEYID); h2c->m4 = cpu_to_le32(DCTLINFO_V2_W4_SEC_ENT0_KEYID | DCTLINFO_V2_W4_SEC_ENT1_KEYID | DCTLINFO_V2_W4_SEC_ENT2_KEYID | DCTLINFO_V2_W4_SEC_ENT3_KEYID | DCTLINFO_V2_W4_SEC_ENT4_KEYID | DCTLINFO_V2_W4_SEC_ENT5_KEYID | DCTLINFO_V2_W4_SEC_ENT6_KEYID); h2c->w5 = le32_encode_bits(addr_cam->sec_cam_map[0], DCTLINFO_V2_W5_SEC_ENT_VALID_V1) | le32_encode_bits(addr_cam->sec_ent[0], DCTLINFO_V2_W5_SEC_ENT0_V1); h2c->m5 = cpu_to_le32(DCTLINFO_V2_W5_SEC_ENT_VALID_V1 | DCTLINFO_V2_W5_SEC_ENT0_V1); h2c->w6 = le32_encode_bits(addr_cam->sec_ent[1], DCTLINFO_V2_W6_SEC_ENT1_V1) | le32_encode_bits(addr_cam->sec_ent[2], DCTLINFO_V2_W6_SEC_ENT2_V1) | le32_encode_bits(addr_cam->sec_ent[3], DCTLINFO_V2_W6_SEC_ENT3_V1) | le32_encode_bits(addr_cam->sec_ent[4], DCTLINFO_V2_W6_SEC_ENT4_V1); h2c->m6 = cpu_to_le32(DCTLINFO_V2_W6_SEC_ENT1_V1 | DCTLINFO_V2_W6_SEC_ENT2_V1 | DCTLINFO_V2_W6_SEC_ENT3_V1 | DCTLINFO_V2_W6_SEC_ENT4_V1); h2c->w7 = le32_encode_bits(addr_cam->sec_ent[5], DCTLINFO_V2_W7_SEC_ENT5_V1) | le32_encode_bits(addr_cam->sec_ent[6], DCTLINFO_V2_W7_SEC_ENT6_V1); h2c->m7 = cpu_to_le32(DCTLINFO_V2_W7_SEC_ENT5_V1 | DCTLINFO_V2_W7_SEC_ENT6_V1); if (rtw_wow->ptk_alg) { h2c->w0 = le32_encode_bits(ptk_tx_iv[0] | ptk_tx_iv[1] << 8, DCTLINFO_V2_W0_AES_IV_L); h2c->m0 = cpu_to_le32(DCTLINFO_V2_W0_AES_IV_L); h2c->w1 = le32_encode_bits(ptk_tx_iv[4] | ptk_tx_iv[5] << 8 | ptk_tx_iv[6] << 16 | ptk_tx_iv[7] << 24, DCTLINFO_V2_W1_AES_IV_H); h2c->m1 = cpu_to_le32(DCTLINFO_V2_W1_AES_IV_H); h2c->w4 |= le32_encode_bits(rtw_wow->ptk_keyidx, DCTLINFO_V2_W4_SEC_KEY_ID); h2c->m4 |= cpu_to_le32(DCTLINFO_V2_W4_SEC_KEY_ID); } }
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with Cregit http://github.com/cregit/cregit
Version 2.0-RC1