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 * 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(rtwdev, 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 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 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 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 idx = find_first_zero_bit(addr_cam->sec_cam_map, 154 RTW89_SEC_CAM_IN_ADDR_CAM); 155 if (idx >= RTW89_SEC_CAM_IN_ADDR_CAM) 156 return -EBUSY; 157 *key_idx = idx; 158 break; 159 case RTW89_ADDR_CAM_SEC_NORMAL: 160 if (sec_cam->type == RTW89_SEC_KEY_TYPE_BIP_CCMP128) { 161 idx = find_next_zero_bit(addr_cam->sec_cam_map, 162 RTW89_SEC_CAM_IN_ADDR_CAM, 5); 163 if (idx > 6) 164 return -EBUSY; 165 *key_idx = idx; 166 break; 167 } 168 169 if (key->flags & IEEE80211_KEY_FLAG_PAIRWISE) { 170 idx = find_next_zero_bit(addr_cam->sec_cam_map, 171 RTW89_SEC_CAM_IN_ADDR_CAM, 0); 172 if (idx > 1) 173 return -EBUSY; 174 *key_idx = idx; 175 break; 176 } 177 178 /* Group keys */ 179 idx = find_next_zero_bit(addr_cam->sec_cam_map, 180 RTW89_SEC_CAM_IN_ADDR_CAM, 2); 181 if (idx > 4) 182 return -EBUSY; 183 *key_idx = idx; 184 break; 185 case RTW89_ADDR_CAM_SEC_4GROUP: 186 if (sec_cam->type == RTW89_SEC_KEY_TYPE_BIP_CCMP128) { 187 if (test_bit(6, addr_cam->sec_cam_map)) 188 return -EINVAL; 189 *key_idx = 6; 190 break; 191 } 192 193 if (key->flags & IEEE80211_KEY_FLAG_PAIRWISE) { 194 idx = find_next_zero_bit(addr_cam->sec_cam_map, 195 RTW89_SEC_CAM_IN_ADDR_CAM, 0); 196 if (idx > 1) 197 return -EBUSY; 198 *key_idx = idx; 199 break; 200 } 201 202 /* Group keys */ 203 idx = find_next_zero_bit(addr_cam->sec_cam_map, 204 RTW89_SEC_CAM_IN_ADDR_CAM, 2); 205 if (idx > 5) 206 return -EBUSY; 207 *key_idx = idx; 208 break; 209 } 210 211 return 0; 212 } 213 214 static int rtw89_cam_detach_sec_cam(struct rtw89_dev *rtwdev, 215 struct ieee80211_vif *vif, 216 struct ieee80211_sta *sta, 217 const struct rtw89_sec_cam_entry *sec_cam, 218 bool inform_fw) 219 { 220 struct rtw89_sta *rtwsta = sta_to_rtwsta_safe(sta); 221 struct rtw89_vif *rtwvif; 222 struct rtw89_addr_cam_entry *addr_cam; 223 unsigned int i; 224 int ret = 0; 225 226 if (!vif) { 227 rtw89_err(rtwdev, "No iface for deleting sec cam\n"); 228 return -EINVAL; 229 } 230 231 rtwvif = (struct rtw89_vif *)vif->drv_priv; 232 addr_cam = rtw89_get_addr_cam_of(rtwvif, rtwsta); 233 234 for_each_set_bit(i, addr_cam->sec_cam_map, RTW89_SEC_CAM_IN_ADDR_CAM) { 235 if (addr_cam->sec_ent[i] != sec_cam->sec_cam_idx) 236 continue; 237 238 clear_bit(i, addr_cam->sec_cam_map); 239 } 240 241 if (inform_fw) { 242 ret = rtw89_chip_h2c_dctl_sec_cam(rtwdev, rtwvif, rtwsta); 243 if (ret) 244 rtw89_err(rtwdev, 245 "failed to update dctl cam del key: %d\n", ret); 246 ret = rtw89_fw_h2c_cam(rtwdev, rtwvif, rtwsta, NULL); 247 if (ret) 248 rtw89_err(rtwdev, "failed to update cam del key: %d\n", ret); 249 } 250 251 return ret; 252 } 253 254 static int rtw89_cam_attach_sec_cam(struct rtw89_dev *rtwdev, 255 struct ieee80211_vif *vif, 256 struct ieee80211_sta *sta, 257 struct ieee80211_key_conf *key, 258 struct rtw89_sec_cam_entry *sec_cam) 259 { 260 struct rtw89_sta *rtwsta = sta_to_rtwsta_safe(sta); 261 struct rtw89_vif *rtwvif; 262 struct rtw89_addr_cam_entry *addr_cam; 263 u8 key_idx = 0; 264 int ret; 265 266 if (!vif) { 267 rtw89_err(rtwdev, "No iface for adding sec cam\n"); 268 return -EINVAL; 269 } 270 271 rtwvif = (struct rtw89_vif *)vif->drv_priv; 272 addr_cam = rtw89_get_addr_cam_of(rtwvif, rtwsta); 273 274 if (key->cipher == WLAN_CIPHER_SUITE_WEP40 || 275 key->cipher == WLAN_CIPHER_SUITE_WEP104) 276 addr_cam->sec_ent_mode = RTW89_ADDR_CAM_SEC_ALL_UNI; 277 278 ret = rtw89_cam_get_addr_cam_key_idx(addr_cam, sec_cam, key, &key_idx); 279 if (ret) { 280 rtw89_err(rtwdev, "failed to get addr cam key idx %d, %d\n", 281 addr_cam->sec_ent_mode, sec_cam->type); 282 return ret; 283 } 284 285 addr_cam->sec_ent_keyid[key_idx] = key->keyidx; 286 addr_cam->sec_ent[key_idx] = sec_cam->sec_cam_idx; 287 set_bit(key_idx, addr_cam->sec_cam_map); 288 ret = rtw89_chip_h2c_dctl_sec_cam(rtwdev, rtwvif, rtwsta); 289 if (ret) { 290 rtw89_err(rtwdev, "failed to update dctl cam sec entry: %d\n", 291 ret); 292 return ret; 293 } 294 ret = rtw89_fw_h2c_cam(rtwdev, rtwvif, rtwsta, NULL); 295 if (ret) { 296 rtw89_err(rtwdev, "failed to update addr cam sec entry: %d\n", 297 ret); 298 clear_bit(key_idx, addr_cam->sec_cam_map); 299 return ret; 300 } 301 302 return 0; 303 } 304 305 static int rtw89_cam_sec_key_install(struct rtw89_dev *rtwdev, 306 struct ieee80211_vif *vif, 307 struct ieee80211_sta *sta, 308 struct ieee80211_key_conf *key, 309 u8 hw_key_type, bool ext_key) 310 { 311 struct rtw89_sec_cam_entry *sec_cam = NULL; 312 struct rtw89_cam_info *cam_info = &rtwdev->cam_info; 313 u8 sec_cam_idx; 314 int ret; 315 316 /* maximum key length 256-bit */ 317 if (key->keylen > 32) { 318 rtw89_err(rtwdev, "invalid sec key length %d\n", key->keylen); 319 return -EINVAL; 320 } 321 322 ret = rtw89_cam_get_avail_sec_cam(rtwdev, &sec_cam_idx, ext_key); 323 if (ret) { 324 rtw89_warn(rtwdev, "no available sec cam: %d ext: %d\n", 325 ret, ext_key); 326 return ret; 327 } 328 329 sec_cam = kzalloc(sizeof(*sec_cam), GFP_KERNEL); 330 if (!sec_cam) { 331 ret = -ENOMEM; 332 goto err_release_cam; 333 } 334 335 key->hw_key_idx = sec_cam_idx; 336 cam_info->sec_entries[sec_cam_idx] = sec_cam; 337 338 sec_cam->sec_cam_idx = sec_cam_idx; 339 sec_cam->type = hw_key_type; 340 sec_cam->len = RTW89_SEC_CAM_LEN; 341 sec_cam->ext_key = ext_key; 342 memcpy(sec_cam->key, key->key, key->keylen); 343 ret = rtw89_cam_send_sec_key_cmd(rtwdev, sec_cam); 344 if (ret) { 345 rtw89_err(rtwdev, "failed to send sec key cmd: %d\n", ret); 346 goto err_release_cam; 347 } 348 349 /* associate with addr cam */ 350 ret = rtw89_cam_attach_sec_cam(rtwdev, vif, sta, key, sec_cam); 351 if (ret) { 352 rtw89_err(rtwdev, "failed to attach sec cam: %d\n", ret); 353 goto err_release_cam; 354 } 355 356 return 0; 357 358 err_release_cam: 359 cam_info->sec_entries[sec_cam_idx] = NULL; 360 kfree(sec_cam); 361 clear_bit(sec_cam_idx, cam_info->sec_cam_map); 362 if (ext_key) 363 clear_bit(sec_cam_idx + 1, cam_info->sec_cam_map); 364 365 return ret; 366 } 367 368 int rtw89_cam_sec_key_add(struct rtw89_dev *rtwdev, 369 struct ieee80211_vif *vif, 370 struct ieee80211_sta *sta, 371 struct ieee80211_key_conf *key) 372 { 373 const struct rtw89_chip_info *chip = rtwdev->chip; 374 u8 hw_key_type; 375 bool ext_key = false; 376 int ret; 377 378 switch (key->cipher) { 379 case WLAN_CIPHER_SUITE_WEP40: 380 hw_key_type = RTW89_SEC_KEY_TYPE_WEP40; 381 break; 382 case WLAN_CIPHER_SUITE_WEP104: 383 hw_key_type = RTW89_SEC_KEY_TYPE_WEP104; 384 break; 385 case WLAN_CIPHER_SUITE_CCMP: 386 hw_key_type = RTW89_SEC_KEY_TYPE_CCMP128; 387 if (!chip->hw_mgmt_tx_encrypt) 388 key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX; 389 break; 390 case WLAN_CIPHER_SUITE_CCMP_256: 391 hw_key_type = RTW89_SEC_KEY_TYPE_CCMP256; 392 if (!chip->hw_mgmt_tx_encrypt) 393 key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX; 394 ext_key = true; 395 break; 396 case WLAN_CIPHER_SUITE_GCMP: 397 hw_key_type = RTW89_SEC_KEY_TYPE_GCMP128; 398 if (!chip->hw_mgmt_tx_encrypt) 399 key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX; 400 break; 401 case WLAN_CIPHER_SUITE_GCMP_256: 402 hw_key_type = RTW89_SEC_KEY_TYPE_GCMP256; 403 if (!chip->hw_mgmt_tx_encrypt) 404 key->flags |= IEEE80211_KEY_FLAG_SW_MGMT_TX; 405 ext_key = true; 406 break; 407 case WLAN_CIPHER_SUITE_AES_CMAC: 408 hw_key_type = RTW89_SEC_KEY_TYPE_BIP_CCMP128; 409 break; 410 default: 411 return -EOPNOTSUPP; 412 } 413 414 if (!chip->hw_sec_hdr) 415 key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV; 416 417 ret = rtw89_cam_sec_key_install(rtwdev, vif, sta, key, hw_key_type, 418 ext_key); 419 if (ret) { 420 rtw89_err(rtwdev, "failed to install key type %d ext %d: %d\n", 421 hw_key_type, ext_key, ret); 422 return ret; 423 } 424 425 return 0; 426 } 427 428 int rtw89_cam_sec_key_del(struct rtw89_dev *rtwdev, 429 struct ieee80211_vif *vif, 430 struct ieee80211_sta *sta, 431 struct ieee80211_key_conf *key, 432 bool inform_fw) 433 { 434 struct rtw89_cam_info *cam_info = &rtwdev->cam_info; 435 const struct rtw89_sec_cam_entry *sec_cam; 436 u8 sec_cam_idx; 437 int ret; 438 439 sec_cam_idx = key->hw_key_idx; 440 sec_cam = cam_info->sec_entries[sec_cam_idx]; 441 if (!sec_cam) 442 return -EINVAL; 443 444 ret = rtw89_cam_detach_sec_cam(rtwdev, vif, sta, sec_cam, inform_fw); 445 446 /* clear valid bit in addr cam will disable sec cam, 447 * so we don't need to send H2C command again 448 */ 449 cam_info->sec_entries[sec_cam_idx] = NULL; 450 clear_bit(sec_cam_idx, cam_info->sec_cam_map); 451 if (sec_cam->ext_key) 452 clear_bit(sec_cam_idx + 1, cam_info->sec_cam_map); 453 454 kfree(sec_cam); 455 456 return ret; 457 } 458 459 static void rtw89_cam_reset_key_iter(struct ieee80211_hw *hw, 460 struct ieee80211_vif *vif, 461 struct ieee80211_sta *sta, 462 struct ieee80211_key_conf *key, 463 void *data) 464 { 465 struct rtw89_dev *rtwdev = (struct rtw89_dev *)data; 466 467 rtw89_cam_sec_key_del(rtwdev, vif, sta, key, false); 468 } 469 470 void rtw89_cam_deinit_addr_cam(struct rtw89_dev *rtwdev, 471 struct rtw89_addr_cam_entry *addr_cam) 472 { 473 struct rtw89_cam_info *cam_info = &rtwdev->cam_info; 474 475 addr_cam->valid = false; 476 clear_bit(addr_cam->addr_cam_idx, cam_info->addr_cam_map); 477 } 478 479 void rtw89_cam_deinit_bssid_cam(struct rtw89_dev *rtwdev, 480 struct rtw89_bssid_cam_entry *bssid_cam) 481 { 482 struct rtw89_cam_info *cam_info = &rtwdev->cam_info; 483 484 bssid_cam->valid = false; 485 clear_bit(bssid_cam->bssid_cam_idx, cam_info->bssid_cam_map); 486 } 487 488 void rtw89_cam_deinit(struct rtw89_dev *rtwdev, struct rtw89_vif *rtwvif) 489 { 490 struct rtw89_addr_cam_entry *addr_cam = &rtwvif->addr_cam; 491 struct rtw89_bssid_cam_entry *bssid_cam = &rtwvif->bssid_cam; 492 493 rtw89_cam_deinit_addr_cam(rtwdev, addr_cam); 494 rtw89_cam_deinit_bssid_cam(rtwdev, bssid_cam); 495 } 496 497 void rtw89_cam_reset_keys(struct rtw89_dev *rtwdev) 498 { 499 rcu_read_lock(); 500 ieee80211_iter_keys_rcu(rtwdev->hw, NULL, rtw89_cam_reset_key_iter, rtwdev); 501 rcu_read_unlock(); 502 } 503 504 static int rtw89_cam_get_avail_addr_cam(struct rtw89_dev *rtwdev, 505 u8 *addr_cam_idx) 506 { 507 const struct rtw89_chip_info *chip = rtwdev->chip; 508 struct rtw89_cam_info *cam_info = &rtwdev->cam_info; 509 u8 addr_cam_num = chip->acam_num; 510 u8 idx; 511 512 idx = find_first_zero_bit(cam_info->addr_cam_map, addr_cam_num); 513 if (idx >= addr_cam_num) 514 return -EBUSY; 515 516 set_bit(idx, cam_info->addr_cam_map); 517 *addr_cam_idx = idx; 518 519 return 0; 520 } 521 522 static u8 rtw89_get_addr_cam_entry_size(struct rtw89_dev *rtwdev) 523 { 524 const struct rtw89_chip_info *chip = rtwdev->chip; 525 526 switch (chip->chip_id) { 527 case RTL8852A: 528 case RTL8852B: 529 case RTL8851B: 530 case RTL8852BT: 531 return ADDR_CAM_ENT_SIZE; 532 default: 533 return ADDR_CAM_ENT_SHORT_SIZE; 534 } 535 } 536 537 int rtw89_cam_init_addr_cam(struct rtw89_dev *rtwdev, 538 struct rtw89_addr_cam_entry *addr_cam, 539 const struct rtw89_bssid_cam_entry *bssid_cam) 540 { 541 u8 addr_cam_idx; 542 int i; 543 int ret; 544 545 if (unlikely(addr_cam->valid)) { 546 rtw89_debug(rtwdev, RTW89_DBG_FW, 547 "addr cam is already valid; skip init\n"); 548 return 0; 549 } 550 551 ret = rtw89_cam_get_avail_addr_cam(rtwdev, &addr_cam_idx); 552 if (ret) { 553 rtw89_err(rtwdev, "failed to get available addr cam\n"); 554 return ret; 555 } 556 557 addr_cam->addr_cam_idx = addr_cam_idx; 558 addr_cam->len = rtw89_get_addr_cam_entry_size(rtwdev); 559 addr_cam->offset = 0; 560 addr_cam->valid = true; 561 addr_cam->addr_mask = 0; 562 addr_cam->mask_sel = RTW89_NO_MSK; 563 addr_cam->sec_ent_mode = RTW89_ADDR_CAM_SEC_NORMAL; 564 bitmap_zero(addr_cam->sec_cam_map, RTW89_SEC_CAM_IN_ADDR_CAM); 565 566 for (i = 0; i < RTW89_SEC_CAM_IN_ADDR_CAM; i++) { 567 addr_cam->sec_ent_keyid[i] = 0; 568 addr_cam->sec_ent[i] = 0; 569 } 570 571 /* associate addr cam with bssid cam */ 572 addr_cam->bssid_cam_idx = bssid_cam->bssid_cam_idx; 573 574 return 0; 575 } 576 577 static int rtw89_cam_get_avail_bssid_cam(struct rtw89_dev *rtwdev, 578 u8 *bssid_cam_idx) 579 { 580 const struct rtw89_chip_info *chip = rtwdev->chip; 581 struct rtw89_cam_info *cam_info = &rtwdev->cam_info; 582 u8 bssid_cam_num = chip->bcam_num; 583 u8 idx; 584 585 idx = find_first_zero_bit(cam_info->bssid_cam_map, bssid_cam_num); 586 if (idx >= bssid_cam_num) 587 return -EBUSY; 588 589 set_bit(idx, cam_info->bssid_cam_map); 590 *bssid_cam_idx = idx; 591 592 return 0; 593 } 594 595 int rtw89_cam_init_bssid_cam(struct rtw89_dev *rtwdev, 596 struct rtw89_vif *rtwvif, 597 struct rtw89_bssid_cam_entry *bssid_cam, 598 const u8 *bssid) 599 { 600 u8 bssid_cam_idx; 601 int ret; 602 603 if (unlikely(bssid_cam->valid)) { 604 rtw89_debug(rtwdev, RTW89_DBG_FW, 605 "bssid cam is already valid; skip init\n"); 606 return 0; 607 } 608 609 ret = rtw89_cam_get_avail_bssid_cam(rtwdev, &bssid_cam_idx); 610 if (ret) { 611 rtw89_err(rtwdev, "failed to get available bssid cam\n"); 612 return ret; 613 } 614 615 bssid_cam->bssid_cam_idx = bssid_cam_idx; 616 bssid_cam->phy_idx = rtwvif->phy_idx; 617 bssid_cam->len = BSSID_CAM_ENT_SIZE; 618 bssid_cam->offset = 0; 619 bssid_cam->valid = true; 620 ether_addr_copy(bssid_cam->bssid, bssid); 621 622 return 0; 623 } 624 625 void rtw89_cam_bssid_changed(struct rtw89_dev *rtwdev, struct rtw89_vif *rtwvif) 626 { 627 struct rtw89_bssid_cam_entry *bssid_cam = &rtwvif->bssid_cam; 628 629 ether_addr_copy(bssid_cam->bssid, rtwvif->bssid); 630 } 631 632 int rtw89_cam_init(struct rtw89_dev *rtwdev, struct rtw89_vif *rtwvif) 633 { 634 struct rtw89_addr_cam_entry *addr_cam = &rtwvif->addr_cam; 635 struct rtw89_bssid_cam_entry *bssid_cam = &rtwvif->bssid_cam; 636 int ret; 637 638 ret = rtw89_cam_init_bssid_cam(rtwdev, rtwvif, bssid_cam, rtwvif->bssid); 639 if (ret) { 640 rtw89_err(rtwdev, "failed to init bssid cam\n"); 641 return ret; 642 } 643 644 ret = rtw89_cam_init_addr_cam(rtwdev, addr_cam, bssid_cam); 645 if (ret) { 646 rtw89_err(rtwdev, "failed to init addr cam\n"); 647 return ret; 648 } 649 650 return 0; 651 } 652 653 int rtw89_cam_fill_bssid_cam_info(struct rtw89_dev *rtwdev, 654 struct rtw89_vif *rtwvif, 655 struct rtw89_sta *rtwsta, u8 *cmd) 656 { 657 struct ieee80211_vif *vif = rtwvif_to_vif(rtwvif); 658 struct rtw89_bssid_cam_entry *bssid_cam = rtw89_get_bssid_cam_of(rtwvif, rtwsta); 659 u8 bss_color = vif->bss_conf.he_bss_color.color; 660 u8 bss_mask; 661 662 if (vif->bss_conf.nontransmitted) 663 bss_mask = RTW89_BSSID_MATCH_5_BYTES; 664 else 665 bss_mask = RTW89_BSSID_MATCH_ALL; 666 667 FWCMD_SET_ADDR_BSSID_IDX(cmd, bssid_cam->bssid_cam_idx); 668 FWCMD_SET_ADDR_BSSID_OFFSET(cmd, bssid_cam->offset); 669 FWCMD_SET_ADDR_BSSID_LEN(cmd, bssid_cam->len); 670 FWCMD_SET_ADDR_BSSID_VALID(cmd, bssid_cam->valid); 671 FWCMD_SET_ADDR_BSSID_MASK(cmd, bss_mask); 672 FWCMD_SET_ADDR_BSSID_BB_SEL(cmd, bssid_cam->phy_idx); 673 FWCMD_SET_ADDR_BSSID_BSS_COLOR(cmd, bss_color); 674 675 FWCMD_SET_ADDR_BSSID_BSSID0(cmd, bssid_cam->bssid[0]); 676 FWCMD_SET_ADDR_BSSID_BSSID1(cmd, bssid_cam->bssid[1]); 677 FWCMD_SET_ADDR_BSSID_BSSID2(cmd, bssid_cam->bssid[2]); 678 FWCMD_SET_ADDR_BSSID_BSSID3(cmd, bssid_cam->bssid[3]); 679 FWCMD_SET_ADDR_BSSID_BSSID4(cmd, bssid_cam->bssid[4]); 680 FWCMD_SET_ADDR_BSSID_BSSID5(cmd, bssid_cam->bssid[5]); 681 682 return 0; 683 } 684 685 static u8 rtw89_cam_addr_hash(u8 start, const u8 *addr) 686 { 687 u8 hash = 0; 688 u8 i; 689 690 for (i = start; i < ETH_ALEN; i++) 691 hash ^= addr[i]; 692 693 return hash; 694 } 695 696 void rtw89_cam_fill_addr_cam_info(struct rtw89_dev *rtwdev, 697 struct rtw89_vif *rtwvif, 698 struct rtw89_sta *rtwsta, 699 const u8 *scan_mac_addr, 700 u8 *cmd) 701 { 702 struct ieee80211_vif *vif = rtwvif_to_vif(rtwvif); 703 struct rtw89_addr_cam_entry *addr_cam = rtw89_get_addr_cam_of(rtwvif, rtwsta); 704 struct ieee80211_sta *sta = rtwsta_to_sta_safe(rtwsta); 705 const u8 *sma = scan_mac_addr ? scan_mac_addr : rtwvif->mac_addr; 706 u8 sma_hash, tma_hash, addr_msk_start; 707 u8 sma_start = 0; 708 u8 tma_start = 0; 709 u8 *tma = sta ? sta->addr : rtwvif->bssid; 710 711 if (addr_cam->addr_mask != 0) { 712 addr_msk_start = __ffs(addr_cam->addr_mask); 713 if (addr_cam->mask_sel == RTW89_SMA) 714 sma_start = addr_msk_start; 715 else if (addr_cam->mask_sel == RTW89_TMA) 716 tma_start = addr_msk_start; 717 } 718 sma_hash = rtw89_cam_addr_hash(sma_start, sma); 719 tma_hash = rtw89_cam_addr_hash(tma_start, tma); 720 721 FWCMD_SET_ADDR_IDX(cmd, addr_cam->addr_cam_idx); 722 FWCMD_SET_ADDR_OFFSET(cmd, addr_cam->offset); 723 FWCMD_SET_ADDR_LEN(cmd, addr_cam->len); 724 725 FWCMD_SET_ADDR_VALID(cmd, addr_cam->valid); 726 FWCMD_SET_ADDR_NET_TYPE(cmd, rtwvif->net_type); 727 FWCMD_SET_ADDR_BCN_HIT_COND(cmd, rtwvif->bcn_hit_cond); 728 FWCMD_SET_ADDR_HIT_RULE(cmd, rtwvif->hit_rule); 729 FWCMD_SET_ADDR_BB_SEL(cmd, rtwvif->phy_idx); 730 FWCMD_SET_ADDR_ADDR_MASK(cmd, addr_cam->addr_mask); 731 FWCMD_SET_ADDR_MASK_SEL(cmd, addr_cam->mask_sel); 732 FWCMD_SET_ADDR_SMA_HASH(cmd, sma_hash); 733 FWCMD_SET_ADDR_TMA_HASH(cmd, tma_hash); 734 735 FWCMD_SET_ADDR_BSSID_CAM_IDX(cmd, addr_cam->bssid_cam_idx); 736 737 FWCMD_SET_ADDR_SMA0(cmd, sma[0]); 738 FWCMD_SET_ADDR_SMA1(cmd, sma[1]); 739 FWCMD_SET_ADDR_SMA2(cmd, sma[2]); 740 FWCMD_SET_ADDR_SMA3(cmd, sma[3]); 741 FWCMD_SET_ADDR_SMA4(cmd, sma[4]); 742 FWCMD_SET_ADDR_SMA5(cmd, sma[5]); 743 744 FWCMD_SET_ADDR_TMA0(cmd, tma[0]); 745 FWCMD_SET_ADDR_TMA1(cmd, tma[1]); 746 FWCMD_SET_ADDR_TMA2(cmd, tma[2]); 747 FWCMD_SET_ADDR_TMA3(cmd, tma[3]); 748 FWCMD_SET_ADDR_TMA4(cmd, tma[4]); 749 FWCMD_SET_ADDR_TMA5(cmd, tma[5]); 750 751 FWCMD_SET_ADDR_PORT_INT(cmd, rtwvif->port); 752 FWCMD_SET_ADDR_TSF_SYNC(cmd, rtwvif->port); 753 FWCMD_SET_ADDR_TF_TRS(cmd, rtwvif->trigger); 754 FWCMD_SET_ADDR_LSIG_TXOP(cmd, rtwvif->lsig_txop); 755 FWCMD_SET_ADDR_TGT_IND(cmd, rtwvif->tgt_ind); 756 FWCMD_SET_ADDR_FRM_TGT_IND(cmd, rtwvif->frm_tgt_ind); 757 FWCMD_SET_ADDR_MACID(cmd, rtwsta ? rtwsta->mac_id : rtwvif->mac_id); 758 if (rtwvif->net_type == RTW89_NET_TYPE_INFRA) 759 FWCMD_SET_ADDR_AID12(cmd, vif->cfg.aid & 0xfff); 760 else if (rtwvif->net_type == RTW89_NET_TYPE_AP_MODE) 761 FWCMD_SET_ADDR_AID12(cmd, sta ? sta->aid & 0xfff : 0); 762 FWCMD_SET_ADDR_WOL_PATTERN(cmd, rtwvif->wowlan_pattern); 763 FWCMD_SET_ADDR_WOL_UC(cmd, rtwvif->wowlan_uc); 764 FWCMD_SET_ADDR_WOL_MAGIC(cmd, rtwvif->wowlan_magic); 765 FWCMD_SET_ADDR_WAPI(cmd, addr_cam->wapi); 766 FWCMD_SET_ADDR_SEC_ENT_MODE(cmd, addr_cam->sec_ent_mode); 767 FWCMD_SET_ADDR_SEC_ENT0_KEYID(cmd, addr_cam->sec_ent_keyid[0]); 768 FWCMD_SET_ADDR_SEC_ENT1_KEYID(cmd, addr_cam->sec_ent_keyid[1]); 769 FWCMD_SET_ADDR_SEC_ENT2_KEYID(cmd, addr_cam->sec_ent_keyid[2]); 770 FWCMD_SET_ADDR_SEC_ENT3_KEYID(cmd, addr_cam->sec_ent_keyid[3]); 771 FWCMD_SET_ADDR_SEC_ENT4_KEYID(cmd, addr_cam->sec_ent_keyid[4]); 772 FWCMD_SET_ADDR_SEC_ENT5_KEYID(cmd, addr_cam->sec_ent_keyid[5]); 773 FWCMD_SET_ADDR_SEC_ENT6_KEYID(cmd, addr_cam->sec_ent_keyid[6]); 774 775 FWCMD_SET_ADDR_SEC_ENT_VALID(cmd, addr_cam->sec_cam_map[0] & 0xff); 776 FWCMD_SET_ADDR_SEC_ENT0(cmd, addr_cam->sec_ent[0]); 777 FWCMD_SET_ADDR_SEC_ENT1(cmd, addr_cam->sec_ent[1]); 778 FWCMD_SET_ADDR_SEC_ENT2(cmd, addr_cam->sec_ent[2]); 779 FWCMD_SET_ADDR_SEC_ENT3(cmd, addr_cam->sec_ent[3]); 780 FWCMD_SET_ADDR_SEC_ENT4(cmd, addr_cam->sec_ent[4]); 781 FWCMD_SET_ADDR_SEC_ENT5(cmd, addr_cam->sec_ent[5]); 782 FWCMD_SET_ADDR_SEC_ENT6(cmd, addr_cam->sec_ent[6]); 783 } 784 785 void rtw89_cam_fill_dctl_sec_cam_info_v1(struct rtw89_dev *rtwdev, 786 struct rtw89_vif *rtwvif, 787 struct rtw89_sta *rtwsta, 788 struct rtw89_h2c_dctlinfo_ud_v1 *h2c) 789 { 790 struct rtw89_addr_cam_entry *addr_cam = rtw89_get_addr_cam_of(rtwvif, rtwsta); 791 struct rtw89_wow_param *rtw_wow = &rtwdev->wow; 792 u8 *ptk_tx_iv = rtw_wow->key_info.ptk_tx_iv; 793 794 h2c->c0 = le32_encode_bits(rtwsta ? rtwsta->mac_id : rtwvif->mac_id, 795 DCTLINFO_V1_C0_MACID) | 796 le32_encode_bits(1, DCTLINFO_V1_C0_OP); 797 798 h2c->w4 = le32_encode_bits(addr_cam->sec_ent_keyid[0], 799 DCTLINFO_V1_W4_SEC_ENT0_KEYID) | 800 le32_encode_bits(addr_cam->sec_ent_keyid[1], 801 DCTLINFO_V1_W4_SEC_ENT1_KEYID) | 802 le32_encode_bits(addr_cam->sec_ent_keyid[2], 803 DCTLINFO_V1_W4_SEC_ENT2_KEYID) | 804 le32_encode_bits(addr_cam->sec_ent_keyid[3], 805 DCTLINFO_V1_W4_SEC_ENT3_KEYID) | 806 le32_encode_bits(addr_cam->sec_ent_keyid[4], 807 DCTLINFO_V1_W4_SEC_ENT4_KEYID) | 808 le32_encode_bits(addr_cam->sec_ent_keyid[5], 809 DCTLINFO_V1_W4_SEC_ENT5_KEYID) | 810 le32_encode_bits(addr_cam->sec_ent_keyid[6], 811 DCTLINFO_V1_W4_SEC_ENT6_KEYID); 812 h2c->m4 = cpu_to_le32(DCTLINFO_V1_W4_SEC_ENT0_KEYID | 813 DCTLINFO_V1_W4_SEC_ENT1_KEYID | 814 DCTLINFO_V1_W4_SEC_ENT2_KEYID | 815 DCTLINFO_V1_W4_SEC_ENT3_KEYID | 816 DCTLINFO_V1_W4_SEC_ENT4_KEYID | 817 DCTLINFO_V1_W4_SEC_ENT5_KEYID | 818 DCTLINFO_V1_W4_SEC_ENT6_KEYID); 819 820 h2c->w5 = le32_encode_bits(addr_cam->sec_cam_map[0] & 0xff, 821 DCTLINFO_V1_W5_SEC_ENT_VALID) | 822 le32_encode_bits(addr_cam->sec_ent[0], 823 DCTLINFO_V1_W5_SEC_ENT0) | 824 le32_encode_bits(addr_cam->sec_ent[1], 825 DCTLINFO_V1_W5_SEC_ENT1) | 826 le32_encode_bits(addr_cam->sec_ent[2], 827 DCTLINFO_V1_W5_SEC_ENT2); 828 h2c->m5 = cpu_to_le32(DCTLINFO_V1_W5_SEC_ENT_VALID | 829 DCTLINFO_V1_W5_SEC_ENT0 | 830 DCTLINFO_V1_W5_SEC_ENT1 | 831 DCTLINFO_V1_W5_SEC_ENT2); 832 833 h2c->w6 = le32_encode_bits(addr_cam->sec_ent[3], 834 DCTLINFO_V1_W6_SEC_ENT3) | 835 le32_encode_bits(addr_cam->sec_ent[4], 836 DCTLINFO_V1_W6_SEC_ENT4) | 837 le32_encode_bits(addr_cam->sec_ent[5], 838 DCTLINFO_V1_W6_SEC_ENT5) | 839 le32_encode_bits(addr_cam->sec_ent[6], 840 DCTLINFO_V1_W6_SEC_ENT6); 841 h2c->m6 = cpu_to_le32(DCTLINFO_V1_W6_SEC_ENT3 | 842 DCTLINFO_V1_W6_SEC_ENT4 | 843 DCTLINFO_V1_W6_SEC_ENT5 | 844 DCTLINFO_V1_W6_SEC_ENT6); 845 846 if (rtw_wow->ptk_alg) { 847 h2c->w0 = le32_encode_bits(ptk_tx_iv[0] | ptk_tx_iv[1] << 8, 848 DCTLINFO_V1_W0_AES_IV_L); 849 h2c->m0 = cpu_to_le32(DCTLINFO_V1_W0_AES_IV_L); 850 851 h2c->w1 = le32_encode_bits(ptk_tx_iv[4] | 852 ptk_tx_iv[5] << 8 | 853 ptk_tx_iv[6] << 16 | 854 ptk_tx_iv[7] << 24, 855 DCTLINFO_V1_W1_AES_IV_H); 856 h2c->m1 = cpu_to_le32(DCTLINFO_V1_W1_AES_IV_H); 857 858 h2c->w4 |= le32_encode_bits(rtw_wow->ptk_keyidx, 859 DCTLINFO_V1_W4_SEC_KEY_ID); 860 h2c->m4 |= cpu_to_le32(DCTLINFO_V1_W4_SEC_KEY_ID); 861 } 862 } 863 864 void rtw89_cam_fill_dctl_sec_cam_info_v2(struct rtw89_dev *rtwdev, 865 struct rtw89_vif *rtwvif, 866 struct rtw89_sta *rtwsta, 867 struct rtw89_h2c_dctlinfo_ud_v2 *h2c) 868 { 869 struct rtw89_addr_cam_entry *addr_cam = rtw89_get_addr_cam_of(rtwvif, rtwsta); 870 struct rtw89_wow_param *rtw_wow = &rtwdev->wow; 871 u8 *ptk_tx_iv = rtw_wow->key_info.ptk_tx_iv; 872 873 h2c->c0 = le32_encode_bits(rtwsta ? rtwsta->mac_id : rtwvif->mac_id, 874 DCTLINFO_V2_C0_MACID) | 875 le32_encode_bits(1, DCTLINFO_V2_C0_OP); 876 877 h2c->w4 = le32_encode_bits(addr_cam->sec_ent_keyid[0], 878 DCTLINFO_V2_W4_SEC_ENT0_KEYID) | 879 le32_encode_bits(addr_cam->sec_ent_keyid[1], 880 DCTLINFO_V2_W4_SEC_ENT1_KEYID) | 881 le32_encode_bits(addr_cam->sec_ent_keyid[2], 882 DCTLINFO_V2_W4_SEC_ENT2_KEYID) | 883 le32_encode_bits(addr_cam->sec_ent_keyid[3], 884 DCTLINFO_V2_W4_SEC_ENT3_KEYID) | 885 le32_encode_bits(addr_cam->sec_ent_keyid[4], 886 DCTLINFO_V2_W4_SEC_ENT4_KEYID) | 887 le32_encode_bits(addr_cam->sec_ent_keyid[5], 888 DCTLINFO_V2_W4_SEC_ENT5_KEYID) | 889 le32_encode_bits(addr_cam->sec_ent_keyid[6], 890 DCTLINFO_V2_W4_SEC_ENT6_KEYID); 891 h2c->m4 = cpu_to_le32(DCTLINFO_V2_W4_SEC_ENT0_KEYID | 892 DCTLINFO_V2_W4_SEC_ENT1_KEYID | 893 DCTLINFO_V2_W4_SEC_ENT2_KEYID | 894 DCTLINFO_V2_W4_SEC_ENT3_KEYID | 895 DCTLINFO_V2_W4_SEC_ENT4_KEYID | 896 DCTLINFO_V2_W4_SEC_ENT5_KEYID | 897 DCTLINFO_V2_W4_SEC_ENT6_KEYID); 898 899 h2c->w5 = le32_encode_bits(addr_cam->sec_cam_map[0], 900 DCTLINFO_V2_W5_SEC_ENT_VALID_V1) | 901 le32_encode_bits(addr_cam->sec_ent[0], 902 DCTLINFO_V2_W5_SEC_ENT0_V1); 903 h2c->m5 = cpu_to_le32(DCTLINFO_V2_W5_SEC_ENT_VALID_V1 | 904 DCTLINFO_V2_W5_SEC_ENT0_V1); 905 906 h2c->w6 = le32_encode_bits(addr_cam->sec_ent[1], 907 DCTLINFO_V2_W6_SEC_ENT1_V1) | 908 le32_encode_bits(addr_cam->sec_ent[2], 909 DCTLINFO_V2_W6_SEC_ENT2_V1) | 910 le32_encode_bits(addr_cam->sec_ent[3], 911 DCTLINFO_V2_W6_SEC_ENT3_V1) | 912 le32_encode_bits(addr_cam->sec_ent[4], 913 DCTLINFO_V2_W6_SEC_ENT4_V1); 914 h2c->m6 = cpu_to_le32(DCTLINFO_V2_W6_SEC_ENT1_V1 | 915 DCTLINFO_V2_W6_SEC_ENT2_V1 | 916 DCTLINFO_V2_W6_SEC_ENT3_V1 | 917 DCTLINFO_V2_W6_SEC_ENT4_V1); 918 919 h2c->w7 = le32_encode_bits(addr_cam->sec_ent[5], 920 DCTLINFO_V2_W7_SEC_ENT5_V1) | 921 le32_encode_bits(addr_cam->sec_ent[6], 922 DCTLINFO_V2_W7_SEC_ENT6_V1); 923 h2c->m7 = cpu_to_le32(DCTLINFO_V2_W7_SEC_ENT5_V1 | 924 DCTLINFO_V2_W7_SEC_ENT6_V1); 925 926 if (rtw_wow->ptk_alg) { 927 h2c->w0 = le32_encode_bits(ptk_tx_iv[0] | ptk_tx_iv[1] << 8, 928 DCTLINFO_V2_W0_AES_IV_L); 929 h2c->m0 = cpu_to_le32(DCTLINFO_V2_W0_AES_IV_L); 930 931 h2c->w1 = le32_encode_bits(ptk_tx_iv[4] | 932 ptk_tx_iv[5] << 8 | 933 ptk_tx_iv[6] << 16 | 934 ptk_tx_iv[7] << 24, 935 DCTLINFO_V2_W1_AES_IV_H); 936 h2c->m1 = cpu_to_le32(DCTLINFO_V2_W1_AES_IV_H); 937 938 h2c->w4 |= le32_encode_bits(rtw_wow->ptk_keyidx, 939 DCTLINFO_V2_W4_SEC_KEY_ID); 940 h2c->m4 |= cpu_to_le32(DCTLINFO_V2_W4_SEC_KEY_ID); 941 } 942 } 943