1 // SPDX-License-Identifier: ISC 2 /* Copyright (C) 2020 MediaTek Inc. */ 3 4 #include <linux/devcoredump.h> 5 #include <linux/etherdevice.h> 6 #include <linux/timekeeping.h> 7 #if defined(__FreeBSD__) 8 #include <linux/delay.h> 9 #endif 10 #include "mt7921.h" 11 #include "../dma.h" 12 #include "../mt76_connac2_mac.h" 13 #include "mcu.h" 14 15 #define MT_WTBL_TXRX_CAP_RATE_OFFSET 7 16 #define MT_WTBL_TXRX_RATE_G2_HE 24 17 #define MT_WTBL_TXRX_RATE_G2 12 18 19 #define MT_WTBL_AC0_CTT_OFFSET 20 20 21 bool mt7921_mac_wtbl_update(struct mt792x_dev *dev, int idx, u32 mask) 22 { 23 mt76_rmw(dev, MT_WTBL_UPDATE, MT_WTBL_UPDATE_WLAN_IDX, 24 FIELD_PREP(MT_WTBL_UPDATE_WLAN_IDX, idx) | mask); 25 26 return mt76_poll(dev, MT_WTBL_UPDATE, MT_WTBL_UPDATE_BUSY, 27 0, 5000); 28 } 29 30 static u32 mt7921_mac_wtbl_lmac_addr(int idx, u8 offset) 31 { 32 return MT_WTBL_LMAC_OFFS(idx, 0) + offset * 4; 33 } 34 35 static void mt7921_mac_sta_poll(struct mt792x_dev *dev) 36 { 37 static const u8 ac_to_tid[] = { 38 [IEEE80211_AC_BE] = 0, 39 [IEEE80211_AC_BK] = 1, 40 [IEEE80211_AC_VI] = 4, 41 [IEEE80211_AC_VO] = 6 42 }; 43 struct ieee80211_sta *sta; 44 struct mt792x_sta *msta; 45 struct mt792x_link_sta *mlink; 46 u32 tx_time[IEEE80211_NUM_ACS], rx_time[IEEE80211_NUM_ACS]; 47 #if defined(__linux__) 48 LIST_HEAD(sta_poll_list); 49 #elif defined(__FreeBSD__) 50 LINUX_LIST_HEAD(sta_poll_list); 51 #endif 52 struct rate_info *rate; 53 s8 rssi[4]; 54 int i; 55 56 spin_lock_bh(&dev->mt76.sta_poll_lock); 57 list_splice_init(&dev->mt76.sta_poll_list, &sta_poll_list); 58 spin_unlock_bh(&dev->mt76.sta_poll_lock); 59 60 while (true) { 61 bool clear = false; 62 u32 addr, val; 63 u16 idx; 64 u8 bw; 65 66 spin_lock_bh(&dev->mt76.sta_poll_lock); 67 if (list_empty(&sta_poll_list)) { 68 spin_unlock_bh(&dev->mt76.sta_poll_lock); 69 break; 70 } 71 mlink = list_first_entry(&sta_poll_list, 72 struct mt792x_link_sta, 73 wcid.poll_list); 74 msta = container_of(mlink, struct mt792x_sta, deflink); 75 list_del_init(&mlink->wcid.poll_list); 76 spin_unlock_bh(&dev->mt76.sta_poll_lock); 77 78 idx = mlink->wcid.idx; 79 addr = mt7921_mac_wtbl_lmac_addr(idx, MT_WTBL_AC0_CTT_OFFSET); 80 81 for (i = 0; i < IEEE80211_NUM_ACS; i++) { 82 u32 tx_last = mlink->airtime_ac[i]; 83 u32 rx_last = mlink->airtime_ac[i + 4]; 84 85 mlink->airtime_ac[i] = mt76_rr(dev, addr); 86 mlink->airtime_ac[i + 4] = mt76_rr(dev, addr + 4); 87 88 tx_time[i] = mlink->airtime_ac[i] - tx_last; 89 rx_time[i] = mlink->airtime_ac[i + 4] - rx_last; 90 91 if ((tx_last | rx_last) & BIT(30)) 92 clear = true; 93 94 addr += 8; 95 } 96 97 if (clear) { 98 mt7921_mac_wtbl_update(dev, idx, 99 MT_WTBL_UPDATE_ADM_COUNT_CLEAR); 100 memset(mlink->airtime_ac, 0, sizeof(mlink->airtime_ac)); 101 } 102 103 if (!mlink->wcid.sta) 104 continue; 105 106 sta = container_of((void *)msta, struct ieee80211_sta, 107 drv_priv); 108 for (i = 0; i < IEEE80211_NUM_ACS; i++) { 109 u8 q = mt76_connac_lmac_mapping(i); 110 u32 tx_cur = tx_time[q]; 111 u32 rx_cur = rx_time[q]; 112 u8 tid = ac_to_tid[i]; 113 114 if (!tx_cur && !rx_cur) 115 continue; 116 117 ieee80211_sta_register_airtime(sta, tid, tx_cur, 118 rx_cur); 119 } 120 121 /* We don't support reading GI info from txs packets. 122 * For accurate tx status reporting and AQL improvement, 123 * we need to make sure that flags match so polling GI 124 * from per-sta counters directly. 125 */ 126 rate = &mlink->wcid.rate; 127 addr = mt7921_mac_wtbl_lmac_addr(idx, 128 MT_WTBL_TXRX_CAP_RATE_OFFSET); 129 val = mt76_rr(dev, addr); 130 131 switch (rate->bw) { 132 case RATE_INFO_BW_160: 133 bw = IEEE80211_STA_RX_BW_160; 134 break; 135 case RATE_INFO_BW_80: 136 bw = IEEE80211_STA_RX_BW_80; 137 break; 138 case RATE_INFO_BW_40: 139 bw = IEEE80211_STA_RX_BW_40; 140 break; 141 default: 142 bw = IEEE80211_STA_RX_BW_20; 143 break; 144 } 145 146 if (rate->flags & RATE_INFO_FLAGS_HE_MCS) { 147 u8 offs = MT_WTBL_TXRX_RATE_G2_HE + 2 * bw; 148 149 rate->he_gi = (val & (0x3 << offs)) >> offs; 150 } else if (rate->flags & 151 (RATE_INFO_FLAGS_VHT_MCS | RATE_INFO_FLAGS_MCS)) { 152 if (val & BIT(MT_WTBL_TXRX_RATE_G2 + bw)) 153 rate->flags |= RATE_INFO_FLAGS_SHORT_GI; 154 else 155 rate->flags &= ~RATE_INFO_FLAGS_SHORT_GI; 156 } 157 158 /* get signal strength of resp frames (CTS/BA/ACK) */ 159 addr = mt7921_mac_wtbl_lmac_addr(idx, 30); 160 val = mt76_rr(dev, addr); 161 162 rssi[0] = to_rssi(GENMASK(7, 0), val); 163 rssi[1] = to_rssi(GENMASK(15, 8), val); 164 rssi[2] = to_rssi(GENMASK(23, 16), val); 165 rssi[3] = to_rssi(GENMASK(31, 14), val); 166 167 mlink->ack_signal = 168 mt76_rx_signal(msta->vif->phy->mt76->antenna_mask, rssi); 169 170 ewma_avg_signal_add(&mlink->avg_ack_signal, -mlink->ack_signal); 171 } 172 } 173 174 static int 175 mt7921_mac_fill_rx(struct mt792x_dev *dev, struct sk_buff *skb) 176 { 177 u32 csum_mask = MT_RXD0_NORMAL_IP_SUM | MT_RXD0_NORMAL_UDP_TCP_SUM; 178 struct mt76_rx_status *status = (struct mt76_rx_status *)skb->cb; 179 bool hdr_trans, unicast, insert_ccmp_hdr = false; 180 u8 chfreq, qos_ctl = 0, remove_pad, amsdu_info; 181 u16 hdr_gap; 182 __le32 *rxv = NULL, *rxd = (__le32 *)skb->data; 183 struct mt76_phy *mphy = &dev->mt76.phy; 184 struct mt792x_phy *phy = &dev->phy; 185 struct ieee80211_supported_band *sband; 186 u32 csum_status = *(u32 *)skb->cb; 187 u32 rxd0 = le32_to_cpu(rxd[0]); 188 u32 rxd1 = le32_to_cpu(rxd[1]); 189 u32 rxd2 = le32_to_cpu(rxd[2]); 190 u32 rxd3 = le32_to_cpu(rxd[3]); 191 u32 rxd4 = le32_to_cpu(rxd[4]); 192 struct mt792x_sta *msta = NULL; 193 struct mt792x_link_sta *mlink; 194 u16 seq_ctrl = 0; 195 __le16 fc = 0; 196 u8 mode = 0; 197 int i, idx; 198 199 memset(status, 0, sizeof(*status)); 200 201 if (rxd1 & MT_RXD1_NORMAL_BAND_IDX) 202 return -EINVAL; 203 204 if (!test_bit(MT76_STATE_RUNNING, &mphy->state)) 205 return -EINVAL; 206 207 if (rxd2 & MT_RXD2_NORMAL_AMSDU_ERR) 208 return -EINVAL; 209 210 hdr_trans = rxd2 & MT_RXD2_NORMAL_HDR_TRANS; 211 if (hdr_trans && (rxd1 & MT_RXD1_NORMAL_CM)) 212 return -EINVAL; 213 214 /* ICV error or CCMP/BIP/WPI MIC error */ 215 if (rxd1 & MT_RXD1_NORMAL_ICV_ERR) 216 status->flag |= RX_FLAG_ONLY_MONITOR; 217 218 chfreq = FIELD_GET(MT_RXD3_NORMAL_CH_FREQ, rxd3); 219 unicast = FIELD_GET(MT_RXD3_NORMAL_ADDR_TYPE, rxd3) == MT_RXD3_NORMAL_U2M; 220 idx = FIELD_GET(MT_RXD1_NORMAL_WLAN_IDX, rxd1); 221 status->wcid = mt792x_rx_get_wcid(dev, idx, unicast); 222 223 if (status->wcid) { 224 mlink = container_of(status->wcid, struct mt792x_link_sta, wcid); 225 msta = container_of(mlink, struct mt792x_sta, deflink); 226 mt76_wcid_add_poll(&dev->mt76, &mlink->wcid); 227 } 228 229 mt792x_get_status_freq_info(status, chfreq); 230 231 switch (status->band) { 232 case NL80211_BAND_5GHZ: 233 sband = &mphy->sband_5g.sband; 234 break; 235 case NL80211_BAND_6GHZ: 236 sband = &mphy->sband_6g.sband; 237 break; 238 default: 239 sband = &mphy->sband_2g.sband; 240 break; 241 } 242 243 if (!sband->channels) 244 return -EINVAL; 245 246 if (mt76_is_mmio(&dev->mt76) && (rxd0 & csum_mask) == csum_mask && 247 !(csum_status & (BIT(0) | BIT(2) | BIT(3)))) 248 skb->ip_summed = CHECKSUM_UNNECESSARY; 249 250 if (rxd1 & MT_RXD1_NORMAL_FCS_ERR) 251 status->flag |= RX_FLAG_FAILED_FCS_CRC; 252 253 if (rxd1 & MT_RXD1_NORMAL_TKIP_MIC_ERR) 254 status->flag |= RX_FLAG_MMIC_ERROR; 255 256 if (FIELD_GET(MT_RXD1_NORMAL_SEC_MODE, rxd1) != 0 && 257 !(rxd1 & (MT_RXD1_NORMAL_CLM | MT_RXD1_NORMAL_CM))) { 258 status->flag |= RX_FLAG_DECRYPTED; 259 status->flag |= RX_FLAG_IV_STRIPPED; 260 status->flag |= RX_FLAG_MMIC_STRIPPED | RX_FLAG_MIC_STRIPPED; 261 } 262 263 remove_pad = FIELD_GET(MT_RXD2_NORMAL_HDR_OFFSET, rxd2); 264 265 if (rxd2 & MT_RXD2_NORMAL_MAX_LEN_ERROR) 266 return -EINVAL; 267 268 rxd += 6; 269 if (rxd1 & MT_RXD1_NORMAL_GROUP_4) { 270 u32 v0 = le32_to_cpu(rxd[0]); 271 u32 v2 = le32_to_cpu(rxd[2]); 272 273 fc = cpu_to_le16(FIELD_GET(MT_RXD6_FRAME_CONTROL, v0)); 274 seq_ctrl = FIELD_GET(MT_RXD8_SEQ_CTRL, v2); 275 qos_ctl = FIELD_GET(MT_RXD8_QOS_CTL, v2); 276 277 rxd += 4; 278 if ((u8 *)rxd - skb->data >= skb->len) 279 return -EINVAL; 280 } 281 282 if (rxd1 & MT_RXD1_NORMAL_GROUP_1) { 283 u8 *data = (u8 *)rxd; 284 285 if (status->flag & RX_FLAG_DECRYPTED) { 286 switch (FIELD_GET(MT_RXD1_NORMAL_SEC_MODE, rxd1)) { 287 case MT_CIPHER_AES_CCMP: 288 case MT_CIPHER_CCMP_CCX: 289 case MT_CIPHER_CCMP_256: 290 insert_ccmp_hdr = 291 FIELD_GET(MT_RXD2_NORMAL_FRAG, rxd2); 292 fallthrough; 293 case MT_CIPHER_TKIP: 294 case MT_CIPHER_TKIP_NO_MIC: 295 case MT_CIPHER_GCMP: 296 case MT_CIPHER_GCMP_256: 297 status->iv[0] = data[5]; 298 status->iv[1] = data[4]; 299 status->iv[2] = data[3]; 300 status->iv[3] = data[2]; 301 status->iv[4] = data[1]; 302 status->iv[5] = data[0]; 303 break; 304 default: 305 break; 306 } 307 } 308 rxd += 4; 309 if ((u8 *)rxd - skb->data >= skb->len) 310 return -EINVAL; 311 } 312 313 if (rxd1 & MT_RXD1_NORMAL_GROUP_2) { 314 status->timestamp = le32_to_cpu(rxd[0]); 315 status->flag |= RX_FLAG_MACTIME_START; 316 317 if (!(rxd2 & MT_RXD2_NORMAL_NON_AMPDU)) { 318 status->flag |= RX_FLAG_AMPDU_DETAILS; 319 320 /* all subframes of an A-MPDU have the same timestamp */ 321 if (phy->rx_ampdu_ts != status->timestamp) { 322 if (!++phy->ampdu_ref) 323 phy->ampdu_ref++; 324 } 325 phy->rx_ampdu_ts = status->timestamp; 326 327 status->ampdu_ref = phy->ampdu_ref; 328 } 329 330 rxd += 2; 331 if ((u8 *)rxd - skb->data >= skb->len) 332 return -EINVAL; 333 } 334 335 /* RXD Group 3 - P-RXV */ 336 if (rxd1 & MT_RXD1_NORMAL_GROUP_3) { 337 u32 v0, v1; 338 int ret; 339 340 rxv = rxd; 341 rxd += 2; 342 if ((u8 *)rxd - skb->data >= skb->len) 343 return -EINVAL; 344 345 v0 = le32_to_cpu(rxv[0]); 346 v1 = le32_to_cpu(rxv[1]); 347 348 if (v0 & MT_PRXV_HT_AD_CODE) 349 status->enc_flags |= RX_ENC_FLAG_LDPC; 350 351 ret = mt76_connac2_mac_fill_rx_rate(&dev->mt76, status, sband, 352 rxv, &mode); 353 if (ret < 0) 354 return ret; 355 356 if (rxd1 & MT_RXD1_NORMAL_GROUP_5) { 357 rxd += 6; 358 if ((u8 *)rxd - skb->data >= skb->len) 359 return -EINVAL; 360 361 rxv = rxd; 362 /* Monitor mode would use RCPI described in GROUP 5 363 * instead. 364 */ 365 v1 = le32_to_cpu(rxv[0]); 366 367 rxd += 12; 368 if ((u8 *)rxd - skb->data >= skb->len) 369 return -EINVAL; 370 } 371 372 status->chains = mphy->antenna_mask; 373 status->chain_signal[0] = to_rssi(MT_PRXV_RCPI0, v1); 374 status->chain_signal[1] = to_rssi(MT_PRXV_RCPI1, v1); 375 status->chain_signal[2] = to_rssi(MT_PRXV_RCPI2, v1); 376 status->chain_signal[3] = to_rssi(MT_PRXV_RCPI3, v1); 377 status->signal = -128; 378 for (i = 0; i < hweight8(mphy->antenna_mask); i++) { 379 if (!(status->chains & BIT(i)) || 380 status->chain_signal[i] >= 0) 381 continue; 382 383 status->signal = max(status->signal, 384 status->chain_signal[i]); 385 } 386 } 387 388 amsdu_info = FIELD_GET(MT_RXD4_NORMAL_PAYLOAD_FORMAT, rxd4); 389 status->amsdu = !!amsdu_info; 390 if (status->amsdu) { 391 status->first_amsdu = amsdu_info == MT_RXD4_FIRST_AMSDU_FRAME; 392 status->last_amsdu = amsdu_info == MT_RXD4_LAST_AMSDU_FRAME; 393 } 394 395 hdr_gap = (u8 *)rxd - skb->data + 2 * remove_pad; 396 if (hdr_trans && ieee80211_has_morefrags(fc)) { 397 struct ieee80211_vif *vif; 398 int err; 399 400 if (!msta || !msta->vif) 401 return -EINVAL; 402 403 vif = container_of((void *)msta->vif, struct ieee80211_vif, 404 drv_priv); 405 err = mt76_connac2_reverse_frag0_hdr_trans(vif, skb, hdr_gap); 406 if (err) 407 return err; 408 409 hdr_trans = false; 410 } else { 411 skb_pull(skb, hdr_gap); 412 if (!hdr_trans && status->amsdu) { 413 memmove(skb->data + 2, skb->data, 414 ieee80211_get_hdrlen_from_skb(skb)); 415 skb_pull(skb, 2); 416 } 417 } 418 419 if (!hdr_trans) { 420 struct ieee80211_hdr *hdr; 421 422 if (insert_ccmp_hdr) { 423 u8 key_id = FIELD_GET(MT_RXD1_NORMAL_KEY_ID, rxd1); 424 425 mt76_insert_ccmp_hdr(skb, key_id); 426 } 427 428 hdr = mt76_skb_get_hdr(skb); 429 fc = hdr->frame_control; 430 if (ieee80211_is_data_qos(fc)) { 431 seq_ctrl = le16_to_cpu(hdr->seq_ctrl); 432 qos_ctl = *ieee80211_get_qos_ctl(hdr); 433 } 434 } else { 435 status->flag |= RX_FLAG_8023; 436 } 437 438 mt792x_mac_assoc_rssi(dev, skb); 439 440 if (rxv && mode >= MT_PHY_TYPE_HE_SU && !(status->flag & RX_FLAG_8023)) 441 mt76_connac2_mac_decode_he_radiotap(&dev->mt76, skb, rxv, mode); 442 443 if (!status->wcid || !ieee80211_is_data_qos(fc)) 444 return 0; 445 446 status->aggr = unicast && !ieee80211_is_qos_nullfunc(fc); 447 status->seqno = IEEE80211_SEQ_TO_SN(seq_ctrl); 448 status->qos_ctl = qos_ctl; 449 450 return 0; 451 } 452 453 void mt7921_mac_add_txs(struct mt792x_dev *dev, void *data) 454 { 455 struct mt792x_link_sta *mlink; 456 struct mt76_wcid *wcid; 457 __le32 *txs_data = data; 458 u16 wcidx; 459 u8 pid; 460 461 if (le32_get_bits(txs_data[0], MT_TXS0_TXS_FORMAT) > 1) 462 return; 463 464 wcidx = le32_get_bits(txs_data[2], MT_TXS2_WCID); 465 pid = le32_get_bits(txs_data[3], MT_TXS3_PID); 466 467 if (pid < MT_PACKET_ID_FIRST) 468 return; 469 470 if (wcidx >= MT792x_WTBL_SIZE) 471 return; 472 473 rcu_read_lock(); 474 475 wcid = rcu_dereference(dev->mt76.wcid[wcidx]); 476 if (!wcid) 477 goto out; 478 479 mlink = container_of(wcid, struct mt792x_link_sta, wcid); 480 481 mt76_connac2_mac_add_txs_skb(&dev->mt76, wcid, pid, txs_data); 482 if (!wcid->sta) 483 goto out; 484 485 mt76_wcid_add_poll(&dev->mt76, &mlink->wcid); 486 487 out: 488 rcu_read_unlock(); 489 } 490 491 static void mt7921_mac_tx_free(struct mt792x_dev *dev, void *data, int len) 492 { 493 struct mt76_connac_tx_free *free = data; 494 #if defined(__linux__) 495 __le32 *tx_info = (__le32 *)(data + sizeof(*free)); 496 #elif defined(__FreeBSD__) 497 __le32 *tx_info = (__le32 *)((u8 *)data + sizeof(*free)); 498 #endif 499 struct mt76_dev *mdev = &dev->mt76; 500 struct mt76_txwi_cache *txwi; 501 struct ieee80211_sta *sta = NULL; 502 struct mt76_wcid *wcid = NULL; 503 struct sk_buff *skb, *tmp; 504 #if defined(__linux__) 505 void *end = data + len; 506 #elif defined(__FreeBSD__) 507 void *end = (u8 *)data + len; 508 #endif 509 LIST_HEAD(free_list); 510 bool wake = false; 511 u8 i, count; 512 513 /* clean DMA queues and unmap buffers first */ 514 mt76_queue_tx_cleanup(dev, dev->mphy.q_tx[MT_TXQ_PSD], false); 515 mt76_queue_tx_cleanup(dev, dev->mphy.q_tx[MT_TXQ_BE], false); 516 517 count = le16_get_bits(free->ctrl, MT_TX_FREE_MSDU_CNT); 518 if (WARN_ON_ONCE((void *)&tx_info[count] > end)) 519 return; 520 521 for (i = 0; i < count; i++) { 522 u32 msdu, info = le32_to_cpu(tx_info[i]); 523 u8 stat; 524 525 /* 1'b1: new wcid pair. 526 * 1'b0: msdu_id with the same 'wcid pair' as above. 527 */ 528 if (info & MT_TX_FREE_PAIR) { 529 struct mt792x_link_sta *mlink; 530 u16 idx; 531 532 count++; 533 idx = FIELD_GET(MT_TX_FREE_WLAN_ID, info); 534 wcid = rcu_dereference(dev->mt76.wcid[idx]); 535 sta = wcid_to_sta(wcid); 536 if (!sta) 537 continue; 538 539 mlink = container_of(wcid, struct mt792x_link_sta, wcid); 540 mt76_wcid_add_poll(&dev->mt76, &mlink->wcid); 541 continue; 542 } 543 544 msdu = FIELD_GET(MT_TX_FREE_MSDU_ID, info); 545 stat = FIELD_GET(MT_TX_FREE_STATUS, info); 546 547 if (wcid) { 548 wcid->stats.tx_retries += 549 FIELD_GET(MT_TX_FREE_COUNT, info) - 1; 550 wcid->stats.tx_failed += !!stat; 551 } 552 553 txwi = mt76_token_release(mdev, msdu, &wake); 554 if (!txwi) 555 continue; 556 557 mt76_connac2_txwi_free(mdev, txwi, sta, &free_list); 558 } 559 560 if (wake) 561 mt76_set_tx_blocked(&dev->mt76, false); 562 563 list_for_each_entry_safe(skb, tmp, &free_list, list) { 564 skb_list_del_init(skb); 565 napi_consume_skb(skb, 1); 566 } 567 568 rcu_read_lock(); 569 mt7921_mac_sta_poll(dev); 570 rcu_read_unlock(); 571 572 mt76_worker_schedule(&dev->mt76.tx_worker); 573 } 574 575 bool mt7921_rx_check(struct mt76_dev *mdev, void *data, int len) 576 { 577 struct mt792x_dev *dev = container_of(mdev, struct mt792x_dev, mt76); 578 __le32 *rxd = (__le32 *)data; 579 __le32 *end = (__le32 *)&rxd[len / 4]; 580 enum rx_pkt_type type; 581 582 type = le32_get_bits(rxd[0], MT_RXD0_PKT_TYPE); 583 584 switch (type) { 585 case PKT_TYPE_TXRX_NOTIFY: 586 /* PKT_TYPE_TXRX_NOTIFY can be received only by mmio devices */ 587 mt7921_mac_tx_free(dev, data, len); /* mmio */ 588 return false; 589 case PKT_TYPE_TXS: 590 for (rxd += 2; rxd + 8 <= end; rxd += 8) 591 mt7921_mac_add_txs(dev, rxd); 592 return false; 593 default: 594 return true; 595 } 596 } 597 EXPORT_SYMBOL_GPL(mt7921_rx_check); 598 599 void mt7921_queue_rx_skb(struct mt76_dev *mdev, enum mt76_rxq_id q, 600 struct sk_buff *skb, u32 *info) 601 { 602 struct mt792x_dev *dev = container_of(mdev, struct mt792x_dev, mt76); 603 __le32 *rxd = (__le32 *)skb->data; 604 __le32 *end = (__le32 *)&skb->data[skb->len]; 605 enum rx_pkt_type type; 606 u16 flag; 607 608 type = le32_get_bits(rxd[0], MT_RXD0_PKT_TYPE); 609 flag = le32_get_bits(rxd[0], MT_RXD0_PKT_FLAG); 610 611 if (type == PKT_TYPE_RX_EVENT && flag == 0x1) 612 type = PKT_TYPE_NORMAL_MCU; 613 614 switch (type) { 615 case PKT_TYPE_TXRX_NOTIFY: 616 /* PKT_TYPE_TXRX_NOTIFY can be received only by mmio devices */ 617 mt7921_mac_tx_free(dev, skb->data, skb->len); 618 napi_consume_skb(skb, 1); 619 break; 620 case PKT_TYPE_RX_EVENT: 621 mt7921_mcu_rx_event(dev, skb); 622 break; 623 case PKT_TYPE_TXS: 624 for (rxd += 2; rxd + 8 <= end; rxd += 8) 625 mt7921_mac_add_txs(dev, rxd); 626 dev_kfree_skb(skb); 627 break; 628 case PKT_TYPE_NORMAL_MCU: 629 case PKT_TYPE_NORMAL: 630 if (!mt7921_mac_fill_rx(dev, skb)) { 631 mt76_rx(&dev->mt76, q, skb); 632 return; 633 } 634 fallthrough; 635 default: 636 dev_kfree_skb(skb); 637 break; 638 } 639 } 640 EXPORT_SYMBOL_GPL(mt7921_queue_rx_skb); 641 642 static void 643 mt7921_vif_connect_iter(void *priv, u8 *mac, 644 struct ieee80211_vif *vif) 645 { 646 struct mt792x_vif *mvif = (struct mt792x_vif *)vif->drv_priv; 647 struct mt792x_dev *dev = mvif->phy->dev; 648 struct ieee80211_hw *hw = mt76_hw(dev); 649 650 if (vif->type == NL80211_IFTYPE_STATION) 651 ieee80211_disconnect(vif, true); 652 653 mt76_connac_mcu_uni_add_dev(&dev->mphy, &vif->bss_conf, 654 &mvif->bss_conf.mt76, 655 &mvif->sta.deflink.wcid, true); 656 mt7921_mcu_set_tx(dev, vif); 657 658 if (vif->type == NL80211_IFTYPE_AP) { 659 mt76_connac_mcu_uni_add_bss(dev->phy.mt76, vif, &mvif->sta.deflink.wcid, 660 true, NULL); 661 mt7921_mcu_sta_update(dev, NULL, vif, true, 662 MT76_STA_INFO_STATE_NONE); 663 mt7921_mcu_uni_add_beacon_offload(dev, hw, vif, true); 664 } 665 } 666 667 /* system error recovery */ 668 void mt7921_mac_reset_work(struct work_struct *work) 669 { 670 struct mt792x_dev *dev = container_of(work, struct mt792x_dev, 671 reset_work); 672 struct ieee80211_hw *hw = mt76_hw(dev); 673 struct mt76_connac_pm *pm = &dev->pm; 674 int i, ret; 675 676 dev_dbg(dev->mt76.dev, "chip reset\n"); 677 set_bit(MT76_RESET, &dev->mphy.state); 678 dev->hw_full_reset = true; 679 ieee80211_stop_queues(hw); 680 681 cancel_delayed_work_sync(&dev->mphy.mac_work); 682 cancel_delayed_work_sync(&pm->ps_work); 683 cancel_work_sync(&pm->wake_work); 684 685 for (i = 0; i < 10; i++) { 686 mutex_lock(&dev->mt76.mutex); 687 ret = mt792x_dev_reset(dev); 688 mutex_unlock(&dev->mt76.mutex); 689 690 if (!ret) 691 break; 692 } 693 694 if (i == 10) 695 dev_err(dev->mt76.dev, "chip reset failed\n"); 696 697 if (test_and_clear_bit(MT76_HW_SCANNING, &dev->mphy.state)) { 698 struct cfg80211_scan_info info = { 699 .aborted = true, 700 }; 701 702 ieee80211_scan_completed(dev->mphy.hw, &info); 703 } 704 705 dev->hw_full_reset = false; 706 clear_bit(MT76_RESET, &dev->mphy.state); 707 pm->suspended = false; 708 ieee80211_wake_queues(hw); 709 ieee80211_iterate_active_interfaces(hw, 710 IEEE80211_IFACE_ITER_RESUME_ALL, 711 mt7921_vif_connect_iter, NULL); 712 mt76_connac_power_save_sched(&dev->mt76.phy, pm); 713 } 714 715 void mt7921_coredump_work(struct work_struct *work) 716 { 717 struct mt792x_dev *dev; 718 char *dump, *data; 719 720 dev = (struct mt792x_dev *)container_of(work, struct mt792x_dev, 721 coredump.work.work); 722 723 if (time_is_after_jiffies(dev->coredump.last_activity + 724 4 * MT76_CONNAC_COREDUMP_TIMEOUT)) { 725 queue_delayed_work(dev->mt76.wq, &dev->coredump.work, 726 MT76_CONNAC_COREDUMP_TIMEOUT); 727 return; 728 } 729 730 dump = vzalloc(MT76_CONNAC_COREDUMP_SZ); 731 data = dump; 732 733 while (true) { 734 struct sk_buff *skb; 735 736 spin_lock_bh(&dev->mt76.lock); 737 skb = __skb_dequeue(&dev->coredump.msg_list); 738 spin_unlock_bh(&dev->mt76.lock); 739 740 if (!skb) 741 break; 742 743 skb_pull(skb, sizeof(struct mt76_connac2_mcu_rxd)); 744 if (!dump || data + skb->len - dump > MT76_CONNAC_COREDUMP_SZ) { 745 dev_kfree_skb(skb); 746 continue; 747 } 748 749 memcpy(data, skb->data, skb->len); 750 data += skb->len; 751 752 dev_kfree_skb(skb); 753 } 754 755 if (dump) 756 dev_coredumpv(dev->mt76.dev, dump, MT76_CONNAC_COREDUMP_SZ, 757 GFP_KERNEL); 758 759 mt792x_reset(&dev->mt76); 760 } 761 762 /* usb_sdio */ 763 static void 764 mt7921_usb_sdio_write_txwi(struct mt792x_dev *dev, struct mt76_wcid *wcid, 765 enum mt76_txq_id qid, struct ieee80211_sta *sta, 766 struct ieee80211_key_conf *key, int pid, 767 struct sk_buff *skb) 768 { 769 __le32 *txwi = (__le32 *)(skb->data - MT_SDIO_TXD_SIZE); 770 771 memset(txwi, 0, MT_SDIO_TXD_SIZE); 772 mt76_connac2_mac_write_txwi(&dev->mt76, txwi, skb, wcid, key, pid, qid, 0); 773 skb_push(skb, MT_SDIO_TXD_SIZE); 774 } 775 776 int mt7921_usb_sdio_tx_prepare_skb(struct mt76_dev *mdev, void *txwi_ptr, 777 enum mt76_txq_id qid, struct mt76_wcid *wcid, 778 struct ieee80211_sta *sta, 779 struct mt76_tx_info *tx_info) 780 { 781 struct mt792x_dev *dev = container_of(mdev, struct mt792x_dev, mt76); 782 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(tx_info->skb); 783 struct ieee80211_key_conf *key = info->control.hw_key; 784 struct sk_buff *skb = tx_info->skb; 785 int err, pad, pktid, type; 786 787 if (unlikely(tx_info->skb->len <= ETH_HLEN)) 788 return -EINVAL; 789 790 err = skb_cow_head(skb, MT_SDIO_TXD_SIZE + MT_SDIO_HDR_SIZE); 791 if (err) 792 return err; 793 794 if (!wcid) 795 wcid = &dev->mt76.global_wcid; 796 797 if (sta) { 798 struct mt792x_sta *msta = (struct mt792x_sta *)sta->drv_priv; 799 800 if (time_after(jiffies, msta->deflink.last_txs + HZ / 4)) { 801 info->flags |= IEEE80211_TX_CTL_REQ_TX_STATUS; 802 msta->deflink.last_txs = jiffies; 803 } 804 } 805 806 pktid = mt76_tx_status_skb_add(&dev->mt76, wcid, skb); 807 mt7921_usb_sdio_write_txwi(dev, wcid, qid, sta, key, pktid, skb); 808 809 type = mt76_is_sdio(mdev) ? MT7921_SDIO_DATA : 0; 810 mt792x_skb_add_usb_sdio_hdr(dev, skb, type); 811 pad = round_up(skb->len, 4) - skb->len; 812 if (mt76_is_usb(mdev)) 813 pad += 4; 814 815 err = mt76_skb_adjust_pad(skb, pad); 816 if (err) 817 /* Release pktid in case of error. */ 818 idr_remove(&wcid->pktid, pktid); 819 820 return err; 821 } 822 EXPORT_SYMBOL_GPL(mt7921_usb_sdio_tx_prepare_skb); 823 824 void mt7921_usb_sdio_tx_complete_skb(struct mt76_dev *mdev, 825 struct mt76_queue_entry *e) 826 { 827 __le32 *txwi = (__le32 *)(e->skb->data + MT_SDIO_HDR_SIZE); 828 unsigned int headroom = MT_SDIO_TXD_SIZE + MT_SDIO_HDR_SIZE; 829 struct ieee80211_sta *sta; 830 struct mt76_wcid *wcid; 831 u16 idx; 832 833 idx = le32_get_bits(txwi[1], MT_TXD1_WLAN_IDX); 834 wcid = rcu_dereference(mdev->wcid[idx]); 835 sta = wcid_to_sta(wcid); 836 837 if (sta && likely(e->skb->protocol != cpu_to_be16(ETH_P_PAE))) 838 mt76_connac2_tx_check_aggr(sta, txwi); 839 840 skb_pull(e->skb, headroom); 841 mt76_tx_complete_skb(mdev, e->wcid, e->skb); 842 } 843 EXPORT_SYMBOL_GPL(mt7921_usb_sdio_tx_complete_skb); 844 845 bool mt7921_usb_sdio_tx_status_data(struct mt76_dev *mdev, u8 *update) 846 { 847 struct mt792x_dev *dev = container_of(mdev, struct mt792x_dev, mt76); 848 849 mt792x_mutex_acquire(dev); 850 mt7921_mac_sta_poll(dev); 851 mt792x_mutex_release(dev); 852 853 return false; 854 } 855 EXPORT_SYMBOL_GPL(mt7921_usb_sdio_tx_status_data); 856 857 #if IS_ENABLED(CONFIG_IPV6) 858 void mt7921_set_ipv6_ns_work(struct work_struct *work) 859 { 860 struct mt792x_dev *dev = container_of(work, struct mt792x_dev, 861 ipv6_ns_work); 862 struct sk_buff *skb; 863 int ret = 0; 864 865 do { 866 skb = skb_dequeue(&dev->ipv6_ns_list); 867 868 if (!skb) 869 break; 870 871 mt792x_mutex_acquire(dev); 872 ret = mt76_mcu_skb_send_msg(&dev->mt76, skb, 873 MCU_UNI_CMD(OFFLOAD), true); 874 mt792x_mutex_release(dev); 875 876 } while (!ret); 877 878 if (ret) 879 skb_queue_purge(&dev->ipv6_ns_list); 880 } 881 #endif 882