root/drivers/net/wireless/mediatek/mt76/mt7615/mcu.c

/* [<][>][^][v][top][bottom][index][help] */

DEFINITIONS

This source file includes following definitions.
  1. __mt7615_mcu_msg_send
  2. mt7615_mcu_parse_response
  3. mt7615_mcu_msg_send
  4. mt7615_mcu_csa_finish
  5. mt7615_mcu_rx_ext_event
  6. mt7615_mcu_rx_unsolicited_event
  7. mt7615_mcu_rx_event
  8. mt7615_mcu_init_download
  9. mt7615_mcu_send_firmware
  10. mt7615_mcu_start_firmware
  11. mt7615_mcu_restart
  12. mt7615_mcu_patch_sem_ctrl
  13. mt7615_mcu_start_patch
  14. mt7615_driver_own
  15. mt7615_load_patch
  16. mt7615_mcu_gen_dl_mode
  17. mt7615_mcu_send_ram_firmware
  18. mt7615_load_ram
  19. mt7615_load_firmware
  20. mt7615_mcu_init
  21. mt7615_mcu_exit
  22. mt7615_mcu_set_eeprom
  23. mt7615_mcu_init_mac
  24. mt7615_mcu_set_rts_thresh
  25. mt7615_mcu_set_wmm
  26. mt7615_mcu_ctrl_pm_state
  27. mt7615_mcu_set_dev_info
  28. mt7615_mcu_bss_info_omac_header
  29. mt7615_mcu_bss_info_basic_header
  30. mt7615_mcu_bss_info_ext_header
  31. mt7615_mcu_set_bss_info
  32. mt7615_mcu_add_wtbl_bmc
  33. mt7615_mcu_wtbl_bmc
  34. mt7615_mcu_add_wtbl
  35. mt7615_mcu_del_wtbl
  36. mt7615_mcu_del_wtbl_all
  37. mt7615_mcu_set_sta_rec_bmc
  38. mt7615_mcu_set_sta_rec
  39. mt7615_mcu_set_bcn
  40. mt7615_mcu_set_tx_power
  41. mt7615_mcu_rdd_cmd
  42. mt7615_mcu_rdd_send_pattern
  43. mt7615_mcu_set_channel
  44. mt7615_mcu_set_ht_cap
  45. mt7615_mcu_set_tx_ba
  46. mt7615_mcu_set_rx_ba
  47. mt7615_mcu_get_temperature

   1 // SPDX-License-Identifier: ISC
   2 /* Copyright (C) 2019 MediaTek Inc.
   3  *
   4  * Author: Roy Luo <royluo@google.com>
   5  *         Ryder Lee <ryder.lee@mediatek.com>
   6  */
   7 
   8 #include <linux/firmware.h>
   9 #include "mt7615.h"
  10 #include "mcu.h"
  11 #include "mac.h"
  12 #include "eeprom.h"
  13 
  14 struct mt7615_patch_hdr {
  15         char build_date[16];
  16         char platform[4];
  17         __be32 hw_sw_ver;
  18         __be32 patch_ver;
  19         __be16 checksum;
  20 } __packed;
  21 
  22 struct mt7615_fw_trailer {
  23         __le32 addr;
  24         u8 chip_id;
  25         u8 feature_set;
  26         u8 eco_code;
  27         char fw_ver[10];
  28         char build_date[15];
  29         __le32 len;
  30 } __packed;
  31 
  32 #define MCU_PATCH_ADDRESS               0x80000
  33 
  34 #define N9_REGION_NUM                   2
  35 #define CR4_REGION_NUM                  1
  36 
  37 #define IMG_CRC_LEN                     4
  38 
  39 #define FW_FEATURE_SET_ENCRYPT          BIT(0)
  40 #define FW_FEATURE_SET_KEY_IDX          GENMASK(2, 1)
  41 
  42 #define DL_MODE_ENCRYPT                 BIT(0)
  43 #define DL_MODE_KEY_IDX                 GENMASK(2, 1)
  44 #define DL_MODE_RESET_SEC_IV            BIT(3)
  45 #define DL_MODE_WORKING_PDA_CR4         BIT(4)
  46 #define DL_MODE_NEED_RSP                BIT(31)
  47 
  48 #define FW_START_OVERRIDE               BIT(0)
  49 #define FW_START_WORKING_PDA_CR4        BIT(2)
  50 
  51 static int __mt7615_mcu_msg_send(struct mt7615_dev *dev, struct sk_buff *skb,
  52                                  int cmd, int *wait_seq)
  53 {
  54         struct mt7615_mcu_txd *mcu_txd;
  55         u8 seq, q_idx, pkt_fmt;
  56         enum mt76_txq_id qid;
  57         u32 val;
  58         __le32 *txd;
  59 
  60         seq = ++dev->mt76.mmio.mcu.msg_seq & 0xf;
  61         if (!seq)
  62                 seq = ++dev->mt76.mmio.mcu.msg_seq & 0xf;
  63 
  64         mcu_txd = (struct mt7615_mcu_txd *)skb_push(skb,
  65                    sizeof(struct mt7615_mcu_txd));
  66         memset(mcu_txd, 0, sizeof(struct mt7615_mcu_txd));
  67 
  68         if (cmd != -MCU_CMD_FW_SCATTER) {
  69                 q_idx = MT_TX_MCU_PORT_RX_Q0;
  70                 pkt_fmt = MT_TX_TYPE_CMD;
  71         } else {
  72                 q_idx = MT_TX_MCU_PORT_RX_FWDL;
  73                 pkt_fmt = MT_TX_TYPE_FW;
  74         }
  75 
  76         txd = mcu_txd->txd;
  77 
  78         val = FIELD_PREP(MT_TXD0_TX_BYTES, skb->len) |
  79               FIELD_PREP(MT_TXD0_P_IDX, MT_TX_PORT_IDX_MCU) |
  80               FIELD_PREP(MT_TXD0_Q_IDX, q_idx);
  81         txd[0] = cpu_to_le32(val);
  82 
  83         val = MT_TXD1_LONG_FORMAT |
  84               FIELD_PREP(MT_TXD1_HDR_FORMAT, MT_HDR_FORMAT_CMD) |
  85               FIELD_PREP(MT_TXD1_PKT_FMT, pkt_fmt);
  86         txd[1] = cpu_to_le32(val);
  87 
  88         mcu_txd->len = cpu_to_le16(skb->len - sizeof(mcu_txd->txd));
  89         mcu_txd->pq_id = cpu_to_le16(MCU_PQ_ID(MT_TX_PORT_IDX_MCU, q_idx));
  90         mcu_txd->pkt_type = MCU_PKT_ID;
  91         mcu_txd->seq = seq;
  92 
  93         if (cmd < 0) {
  94                 mcu_txd->set_query = MCU_Q_NA;
  95                 mcu_txd->cid = -cmd;
  96         } else {
  97                 mcu_txd->cid = MCU_CMD_EXT_CID;
  98                 mcu_txd->set_query = MCU_Q_SET;
  99                 mcu_txd->ext_cid = cmd;
 100                 mcu_txd->ext_cid_ack = 1;
 101         }
 102         mcu_txd->s2d_index = MCU_S2D_H2N;
 103 
 104         if (wait_seq)
 105                 *wait_seq = seq;
 106 
 107         if (test_bit(MT76_STATE_MCU_RUNNING, &dev->mt76.state))
 108                 qid = MT_TXQ_MCU;
 109         else
 110                 qid = MT_TXQ_FWDL;
 111 
 112         return mt76_tx_queue_skb_raw(dev, qid, skb, 0);
 113 }
 114 
 115 static int
 116 mt7615_mcu_parse_response(struct mt7615_dev *dev, int cmd,
 117                           struct sk_buff *skb, int seq)
 118 {
 119         struct mt7615_mcu_rxd *rxd = (struct mt7615_mcu_rxd *)skb->data;
 120         int ret = 0;
 121 
 122         if (seq != rxd->seq)
 123                 return -EAGAIN;
 124 
 125         switch (cmd) {
 126         case -MCU_CMD_PATCH_SEM_CONTROL:
 127                 skb_pull(skb, sizeof(*rxd) - 4);
 128                 ret = *skb->data;
 129                 break;
 130         case MCU_EXT_CMD_GET_TEMP:
 131                 skb_pull(skb, sizeof(*rxd));
 132                 ret = le32_to_cpu(*(__le32 *)skb->data);
 133                 break;
 134         default:
 135                 break;
 136         }
 137         dev_kfree_skb(skb);
 138 
 139         return ret;
 140 }
 141 
 142 static int
 143 mt7615_mcu_msg_send(struct mt76_dev *mdev, int cmd, const void *data,
 144                     int len, bool wait_resp)
 145 {
 146         struct mt7615_dev *dev = container_of(mdev, struct mt7615_dev, mt76);
 147         unsigned long expires = jiffies + 10 * HZ;
 148         struct sk_buff *skb;
 149         int ret, seq;
 150 
 151         skb = mt7615_mcu_msg_alloc(data, len);
 152         if (!skb)
 153                 return -ENOMEM;
 154 
 155         mutex_lock(&mdev->mmio.mcu.mutex);
 156 
 157         ret = __mt7615_mcu_msg_send(dev, skb, cmd, &seq);
 158         if (ret)
 159                 goto out;
 160 
 161         while (wait_resp) {
 162                 skb = mt76_mcu_get_response(mdev, expires);
 163                 if (!skb) {
 164                         dev_err(mdev->dev, "Message %d (seq %d) timeout\n",
 165                                 cmd, seq);
 166                         ret = -ETIMEDOUT;
 167                         break;
 168                 }
 169 
 170                 ret = mt7615_mcu_parse_response(dev, cmd, skb, seq);
 171                 if (ret != -EAGAIN)
 172                         break;
 173         }
 174 
 175 out:
 176         mutex_unlock(&mdev->mmio.mcu.mutex);
 177 
 178         return ret;
 179 }
 180 
 181 static void
 182 mt7615_mcu_csa_finish(void *priv, u8 *mac, struct ieee80211_vif *vif)
 183 {
 184         if (vif->csa_active)
 185                 ieee80211_csa_finish(vif);
 186 }
 187 
 188 static void
 189 mt7615_mcu_rx_ext_event(struct mt7615_dev *dev, struct sk_buff *skb)
 190 {
 191         struct mt7615_mcu_rxd *rxd = (struct mt7615_mcu_rxd *)skb->data;
 192 
 193         switch (rxd->ext_eid) {
 194         case MCU_EXT_EVENT_RDD_REPORT:
 195                 ieee80211_radar_detected(dev->mt76.hw);
 196                 dev->hw_pattern++;
 197                 break;
 198         case MCU_EXT_EVENT_CSA_NOTIFY:
 199                 ieee80211_iterate_active_interfaces_atomic(dev->mt76.hw,
 200                                 IEEE80211_IFACE_ITER_RESUME_ALL,
 201                                 mt7615_mcu_csa_finish, dev);
 202                 break;
 203         default:
 204                 break;
 205         }
 206 }
 207 
 208 static void
 209 mt7615_mcu_rx_unsolicited_event(struct mt7615_dev *dev, struct sk_buff *skb)
 210 {
 211         struct mt7615_mcu_rxd *rxd = (struct mt7615_mcu_rxd *)skb->data;
 212 
 213         switch (rxd->eid) {
 214         case MCU_EVENT_EXT:
 215                 mt7615_mcu_rx_ext_event(dev, skb);
 216                 break;
 217         default:
 218                 break;
 219         }
 220         dev_kfree_skb(skb);
 221 }
 222 
 223 void mt7615_mcu_rx_event(struct mt7615_dev *dev, struct sk_buff *skb)
 224 {
 225         struct mt7615_mcu_rxd *rxd = (struct mt7615_mcu_rxd *)skb->data;
 226 
 227         if (rxd->ext_eid == MCU_EXT_EVENT_THERMAL_PROTECT ||
 228             rxd->ext_eid == MCU_EXT_EVENT_FW_LOG_2_HOST ||
 229             rxd->ext_eid == MCU_EXT_EVENT_ASSERT_DUMP ||
 230             rxd->ext_eid == MCU_EXT_EVENT_PS_SYNC ||
 231             !rxd->seq)
 232                 mt7615_mcu_rx_unsolicited_event(dev, skb);
 233         else
 234                 mt76_mcu_rx_event(&dev->mt76, skb);
 235 }
 236 
 237 static int mt7615_mcu_init_download(struct mt7615_dev *dev, u32 addr,
 238                                     u32 len, u32 mode)
 239 {
 240         struct {
 241                 __le32 addr;
 242                 __le32 len;
 243                 __le32 mode;
 244         } req = {
 245                 .addr = cpu_to_le32(addr),
 246                 .len = cpu_to_le32(len),
 247                 .mode = cpu_to_le32(mode),
 248         };
 249 
 250         return __mt76_mcu_send_msg(&dev->mt76, -MCU_CMD_TARGET_ADDRESS_LEN_REQ,
 251                                    &req, sizeof(req), true);
 252 }
 253 
 254 static int mt7615_mcu_send_firmware(struct mt7615_dev *dev, const void *data,
 255                                     int len)
 256 {
 257         int ret = 0, cur_len;
 258 
 259         while (len > 0) {
 260                 cur_len = min_t(int, 4096 - sizeof(struct mt7615_mcu_txd),
 261                                 len);
 262 
 263                 ret = __mt76_mcu_send_msg(&dev->mt76, -MCU_CMD_FW_SCATTER,
 264                                           data, cur_len, false);
 265                 if (ret)
 266                         break;
 267 
 268                 data += cur_len;
 269                 len -= cur_len;
 270                 mt76_queue_tx_cleanup(dev, MT_TXQ_FWDL, false);
 271         }
 272 
 273         return ret;
 274 }
 275 
 276 static int mt7615_mcu_start_firmware(struct mt7615_dev *dev, u32 addr,
 277                                      u32 option)
 278 {
 279         struct {
 280                 __le32 option;
 281                 __le32 addr;
 282         } req = {
 283                 .option = cpu_to_le32(option),
 284                 .addr = cpu_to_le32(addr),
 285         };
 286 
 287         return __mt76_mcu_send_msg(&dev->mt76, -MCU_CMD_FW_START_REQ,
 288                                    &req, sizeof(req), true);
 289 }
 290 
 291 static int mt7615_mcu_restart(struct mt76_dev *dev)
 292 {
 293         return __mt76_mcu_send_msg(dev, -MCU_CMD_RESTART_DL_REQ, NULL,
 294                                    0, true);
 295 }
 296 
 297 static int mt7615_mcu_patch_sem_ctrl(struct mt7615_dev *dev, bool get)
 298 {
 299         struct {
 300                 __le32 op;
 301         } req = {
 302                 .op = cpu_to_le32(get ? PATCH_SEM_GET : PATCH_SEM_RELEASE),
 303         };
 304 
 305         return __mt76_mcu_send_msg(&dev->mt76, -MCU_CMD_PATCH_SEM_CONTROL,
 306                                    &req, sizeof(req), true);
 307 }
 308 
 309 static int mt7615_mcu_start_patch(struct mt7615_dev *dev)
 310 {
 311         struct {
 312                 u8 check_crc;
 313                 u8 reserved[3];
 314         } req = {
 315                 .check_crc = 0,
 316         };
 317 
 318         return __mt76_mcu_send_msg(&dev->mt76, -MCU_CMD_PATCH_FINISH_REQ,
 319                                    &req, sizeof(req), true);
 320 }
 321 
 322 static int mt7615_driver_own(struct mt7615_dev *dev)
 323 {
 324         mt76_wr(dev, MT_CFG_LPCR_HOST, MT_CFG_LPCR_HOST_DRV_OWN);
 325         if (!mt76_poll_msec(dev, MT_CFG_LPCR_HOST,
 326                             MT_CFG_LPCR_HOST_FW_OWN, 0, 500)) {
 327                 dev_err(dev->mt76.dev, "Timeout for driver own\n");
 328                 return -EIO;
 329         }
 330 
 331         return 0;
 332 }
 333 
 334 static int mt7615_load_patch(struct mt7615_dev *dev)
 335 {
 336         const struct mt7615_patch_hdr *hdr;
 337         const struct firmware *fw = NULL;
 338         int len, ret, sem;
 339 
 340         sem = mt7615_mcu_patch_sem_ctrl(dev, 1);
 341         switch (sem) {
 342         case PATCH_IS_DL:
 343                 return 0;
 344         case PATCH_NOT_DL_SEM_SUCCESS:
 345                 break;
 346         default:
 347                 dev_err(dev->mt76.dev, "Failed to get patch semaphore\n");
 348                 return -EAGAIN;
 349         }
 350 
 351         ret = request_firmware(&fw, MT7615_ROM_PATCH, dev->mt76.dev);
 352         if (ret)
 353                 goto out;
 354 
 355         if (!fw || !fw->data || fw->size < sizeof(*hdr)) {
 356                 dev_err(dev->mt76.dev, "Invalid firmware\n");
 357                 ret = -EINVAL;
 358                 goto out;
 359         }
 360 
 361         hdr = (const struct mt7615_patch_hdr *)(fw->data);
 362 
 363         dev_info(dev->mt76.dev, "HW/SW Version: 0x%x, Build Time: %.16s\n",
 364                  be32_to_cpu(hdr->hw_sw_ver), hdr->build_date);
 365 
 366         len = fw->size - sizeof(*hdr);
 367 
 368         ret = mt7615_mcu_init_download(dev, MCU_PATCH_ADDRESS, len,
 369                                        DL_MODE_NEED_RSP);
 370         if (ret) {
 371                 dev_err(dev->mt76.dev, "Download request failed\n");
 372                 goto out;
 373         }
 374 
 375         ret = mt7615_mcu_send_firmware(dev, fw->data + sizeof(*hdr), len);
 376         if (ret) {
 377                 dev_err(dev->mt76.dev, "Failed to send firmware to device\n");
 378                 goto out;
 379         }
 380 
 381         ret = mt7615_mcu_start_patch(dev);
 382         if (ret)
 383                 dev_err(dev->mt76.dev, "Failed to start patch\n");
 384 
 385 out:
 386         release_firmware(fw);
 387 
 388         sem = mt7615_mcu_patch_sem_ctrl(dev, 0);
 389         switch (sem) {
 390         case PATCH_REL_SEM_SUCCESS:
 391                 break;
 392         default:
 393                 ret = -EAGAIN;
 394                 dev_err(dev->mt76.dev, "Failed to release patch semaphore\n");
 395                 break;
 396         }
 397 
 398         return ret;
 399 }
 400 
 401 static u32 mt7615_mcu_gen_dl_mode(u8 feature_set, bool is_cr4)
 402 {
 403         u32 ret = 0;
 404 
 405         ret |= (feature_set & FW_FEATURE_SET_ENCRYPT) ?
 406                (DL_MODE_ENCRYPT | DL_MODE_RESET_SEC_IV) : 0;
 407         ret |= FIELD_PREP(DL_MODE_KEY_IDX,
 408                           FIELD_GET(FW_FEATURE_SET_KEY_IDX, feature_set));
 409         ret |= DL_MODE_NEED_RSP;
 410         ret |= is_cr4 ? DL_MODE_WORKING_PDA_CR4 : 0;
 411 
 412         return ret;
 413 }
 414 
 415 static int
 416 mt7615_mcu_send_ram_firmware(struct mt7615_dev *dev,
 417                              const struct mt7615_fw_trailer *hdr,
 418                              const u8 *data, bool is_cr4)
 419 {
 420         int n_region = is_cr4 ? CR4_REGION_NUM : N9_REGION_NUM;
 421         int err, i, offset = 0;
 422         u32 len, addr, mode;
 423 
 424         for (i = 0; i < n_region; i++) {
 425                 mode = mt7615_mcu_gen_dl_mode(hdr[i].feature_set, is_cr4);
 426                 len = le32_to_cpu(hdr[i].len) + IMG_CRC_LEN;
 427                 addr = le32_to_cpu(hdr[i].addr);
 428 
 429                 err = mt7615_mcu_init_download(dev, addr, len, mode);
 430                 if (err) {
 431                         dev_err(dev->mt76.dev, "Download request failed\n");
 432                         return err;
 433                 }
 434 
 435                 err = mt7615_mcu_send_firmware(dev, data + offset, len);
 436                 if (err) {
 437                         dev_err(dev->mt76.dev, "Failed to send firmware to device\n");
 438                         return err;
 439                 }
 440 
 441                 offset += len;
 442         }
 443 
 444         return 0;
 445 }
 446 
 447 static int mt7615_load_ram(struct mt7615_dev *dev)
 448 {
 449         const struct mt7615_fw_trailer *hdr;
 450         const struct firmware *fw;
 451         int ret;
 452 
 453         ret = request_firmware(&fw, MT7615_FIRMWARE_N9, dev->mt76.dev);
 454         if (ret)
 455                 return ret;
 456 
 457         if (!fw || !fw->data || fw->size < N9_REGION_NUM * sizeof(*hdr)) {
 458                 dev_err(dev->mt76.dev, "Invalid firmware\n");
 459                 ret = -EINVAL;
 460                 goto out;
 461         }
 462 
 463         hdr = (const struct mt7615_fw_trailer *)(fw->data + fw->size -
 464                                         N9_REGION_NUM * sizeof(*hdr));
 465 
 466         dev_info(dev->mt76.dev, "N9 Firmware Version: %.10s, Build Time: %.15s\n",
 467                  hdr->fw_ver, hdr->build_date);
 468 
 469         ret = mt7615_mcu_send_ram_firmware(dev, hdr, fw->data, false);
 470         if (ret)
 471                 goto out;
 472 
 473         ret = mt7615_mcu_start_firmware(dev, le32_to_cpu(hdr->addr),
 474                                         FW_START_OVERRIDE);
 475         if (ret) {
 476                 dev_err(dev->mt76.dev, "Failed to start N9 firmware\n");
 477                 goto out;
 478         }
 479 
 480         release_firmware(fw);
 481 
 482         ret = request_firmware(&fw, MT7615_FIRMWARE_CR4, dev->mt76.dev);
 483         if (ret)
 484                 return ret;
 485 
 486         if (!fw || !fw->data || fw->size < CR4_REGION_NUM * sizeof(*hdr)) {
 487                 dev_err(dev->mt76.dev, "Invalid firmware\n");
 488                 ret = -EINVAL;
 489                 goto out;
 490         }
 491 
 492         hdr = (const struct mt7615_fw_trailer *)(fw->data + fw->size -
 493                                         CR4_REGION_NUM * sizeof(*hdr));
 494 
 495         dev_info(dev->mt76.dev, "CR4 Firmware Version: %.10s, Build Time: %.15s\n",
 496                  hdr->fw_ver, hdr->build_date);
 497 
 498         ret = mt7615_mcu_send_ram_firmware(dev, hdr, fw->data, true);
 499         if (ret)
 500                 goto out;
 501 
 502         ret = mt7615_mcu_start_firmware(dev, 0, FW_START_WORKING_PDA_CR4);
 503         if (ret)
 504                 dev_err(dev->mt76.dev, "Failed to start CR4 firmware\n");
 505 
 506 out:
 507         release_firmware(fw);
 508 
 509         return ret;
 510 }
 511 
 512 static int mt7615_load_firmware(struct mt7615_dev *dev)
 513 {
 514         int ret;
 515         u32 val;
 516 
 517         val = mt76_get_field(dev, MT_TOP_MISC2, MT_TOP_MISC2_FW_STATE);
 518 
 519         if (val != FW_STATE_FW_DOWNLOAD) {
 520                 dev_err(dev->mt76.dev, "Firmware is not ready for download\n");
 521                 return -EIO;
 522         }
 523 
 524         ret = mt7615_load_patch(dev);
 525         if (ret)
 526                 return ret;
 527 
 528         ret = mt7615_load_ram(dev);
 529         if (ret)
 530                 return ret;
 531 
 532         if (!mt76_poll_msec(dev, MT_TOP_MISC2, MT_TOP_MISC2_FW_STATE,
 533                             FIELD_PREP(MT_TOP_MISC2_FW_STATE,
 534                                        FW_STATE_CR4_RDY), 500)) {
 535                 dev_err(dev->mt76.dev, "Timeout for initializing firmware\n");
 536                 return -EIO;
 537         }
 538 
 539         mt76_queue_tx_cleanup(dev, MT_TXQ_FWDL, false);
 540 
 541         dev_dbg(dev->mt76.dev, "Firmware init done\n");
 542 
 543         return 0;
 544 }
 545 
 546 int mt7615_mcu_init(struct mt7615_dev *dev)
 547 {
 548         static const struct mt76_mcu_ops mt7615_mcu_ops = {
 549                 .mcu_send_msg = mt7615_mcu_msg_send,
 550                 .mcu_restart = mt7615_mcu_restart,
 551         };
 552         int ret;
 553 
 554         dev->mt76.mcu_ops = &mt7615_mcu_ops,
 555 
 556         ret = mt7615_driver_own(dev);
 557         if (ret)
 558                 return ret;
 559 
 560         ret = mt7615_load_firmware(dev);
 561         if (ret)
 562                 return ret;
 563 
 564         set_bit(MT76_STATE_MCU_RUNNING, &dev->mt76.state);
 565 
 566         return 0;
 567 }
 568 
 569 void mt7615_mcu_exit(struct mt7615_dev *dev)
 570 {
 571         __mt76_mcu_restart(&dev->mt76);
 572         mt76_wr(dev, MT_CFG_LPCR_HOST, MT_CFG_LPCR_HOST_FW_OWN);
 573         skb_queue_purge(&dev->mt76.mmio.mcu.res_q);
 574 }
 575 
 576 int mt7615_mcu_set_eeprom(struct mt7615_dev *dev)
 577 {
 578         struct {
 579                 u8 buffer_mode;
 580                 u8 pad;
 581                 u16 len;
 582         } __packed req_hdr = {
 583                 .buffer_mode = 1,
 584                 .len = __MT_EE_MAX - MT_EE_NIC_CONF_0,
 585         };
 586         int ret, len = sizeof(req_hdr) + __MT_EE_MAX - MT_EE_NIC_CONF_0;
 587         u8 *req, *eep = (u8 *)dev->mt76.eeprom.data;
 588 
 589         req = kzalloc(len, GFP_KERNEL);
 590         if (!req)
 591                 return -ENOMEM;
 592 
 593         memcpy(req, &req_hdr, sizeof(req_hdr));
 594         memcpy(req + sizeof(req_hdr), eep + MT_EE_NIC_CONF_0,
 595                __MT_EE_MAX - MT_EE_NIC_CONF_0);
 596 
 597         ret = __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_EFUSE_BUFFER_MODE,
 598                                   req, len, true);
 599         kfree(req);
 600 
 601         return ret;
 602 }
 603 
 604 int mt7615_mcu_init_mac(struct mt7615_dev *dev)
 605 {
 606         struct {
 607                 u8 enable;
 608                 u8 band;
 609                 u8 rsv[2];
 610         } __packed req = {
 611                 .enable = 1,
 612                 .band = 0,
 613         };
 614 
 615         return __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_MAC_INIT_CTRL,
 616                                    &req, sizeof(req), true);
 617 }
 618 
 619 int mt7615_mcu_set_rts_thresh(struct mt7615_dev *dev, u32 val)
 620 {
 621         struct {
 622                 u8 prot_idx;
 623                 u8 band;
 624                 u8 rsv[2];
 625                 __le32 len_thresh;
 626                 __le32 pkt_thresh;
 627         } __packed req = {
 628                 .prot_idx = 1,
 629                 .band = 0,
 630                 .len_thresh = cpu_to_le32(val),
 631                 .pkt_thresh = cpu_to_le32(0x2),
 632         };
 633 
 634         return __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_PROTECT_CTRL,
 635                                    &req, sizeof(req), true);
 636 }
 637 
 638 int mt7615_mcu_set_wmm(struct mt7615_dev *dev, u8 queue,
 639                        const struct ieee80211_tx_queue_params *params)
 640 {
 641 #define WMM_AIFS_SET    BIT(0)
 642 #define WMM_CW_MIN_SET  BIT(1)
 643 #define WMM_CW_MAX_SET  BIT(2)
 644 #define WMM_TXOP_SET    BIT(3)
 645 #define WMM_PARAM_SET   (WMM_AIFS_SET | WMM_CW_MIN_SET | \
 646                          WMM_CW_MAX_SET | WMM_TXOP_SET)
 647         struct req_data {
 648                 u8 number;
 649                 u8 rsv[3];
 650                 u8 queue;
 651                 u8 valid;
 652                 u8 aifs;
 653                 u8 cw_min;
 654                 __le16 cw_max;
 655                 __le16 txop;
 656         } __packed req = {
 657                 .number = 1,
 658                 .queue = queue,
 659                 .valid = WMM_PARAM_SET,
 660                 .aifs = params->aifs,
 661                 .cw_min = 5,
 662                 .cw_max = cpu_to_le16(10),
 663                 .txop = cpu_to_le16(params->txop),
 664         };
 665 
 666         if (params->cw_min)
 667                 req.cw_min = fls(params->cw_min);
 668         if (params->cw_max)
 669                 req.cw_max = cpu_to_le16(fls(params->cw_max));
 670 
 671         return __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_EDCA_UPDATE,
 672                                    &req, sizeof(req), true);
 673 }
 674 
 675 int mt7615_mcu_ctrl_pm_state(struct mt7615_dev *dev, int enter)
 676 {
 677 #define ENTER_PM_STATE  1
 678 #define EXIT_PM_STATE   2
 679         struct {
 680                 u8 pm_number;
 681                 u8 pm_state;
 682                 u8 bssid[ETH_ALEN];
 683                 u8 dtim_period;
 684                 u8 wlan_idx;
 685                 __le16 bcn_interval;
 686                 __le32 aid;
 687                 __le32 rx_filter;
 688                 u8 band_idx;
 689                 u8 rsv[3];
 690                 __le32 feature;
 691                 u8 omac_idx;
 692                 u8 wmm_idx;
 693                 u8 bcn_loss_cnt;
 694                 u8 bcn_sp_duration;
 695         } __packed req = {
 696                 .pm_number = 5,
 697                 .pm_state = (enter) ? ENTER_PM_STATE : EXIT_PM_STATE,
 698                 .band_idx = 0,
 699         };
 700 
 701         return __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_PM_STATE_CTRL,
 702                                    &req, sizeof(req), true);
 703 }
 704 
 705 int mt7615_mcu_set_dev_info(struct mt7615_dev *dev,
 706                             struct ieee80211_vif *vif, bool enable)
 707 {
 708         struct mt7615_vif *mvif = (struct mt7615_vif *)vif->drv_priv;
 709         struct {
 710                 struct req_hdr {
 711                         u8 omac_idx;
 712                         u8 band_idx;
 713                         __le16 tlv_num;
 714                         u8 is_tlv_append;
 715                         u8 rsv[3];
 716                 } __packed hdr;
 717                 struct req_tlv {
 718                         __le16 tag;
 719                         __le16 len;
 720                         u8 active;
 721                         u8 band_idx;
 722                         u8 omac_addr[ETH_ALEN];
 723                 } __packed tlv;
 724         } data = {
 725                 .hdr = {
 726                         .omac_idx = mvif->omac_idx,
 727                         .band_idx = mvif->band_idx,
 728                         .tlv_num = cpu_to_le16(1),
 729                         .is_tlv_append = 1,
 730                 },
 731                 .tlv = {
 732                         .tag = cpu_to_le16(DEV_INFO_ACTIVE),
 733                         .len = cpu_to_le16(sizeof(struct req_tlv)),
 734                         .active = enable,
 735                         .band_idx = mvif->band_idx,
 736                 },
 737         };
 738 
 739         memcpy(data.tlv.omac_addr, vif->addr, ETH_ALEN);
 740         return __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_DEV_INFO_UPDATE,
 741                                    &data, sizeof(data), true);
 742 }
 743 
 744 static void
 745 mt7615_mcu_bss_info_omac_header(struct mt7615_vif *mvif, u8 *data,
 746                                 u32 conn_type)
 747 {
 748         struct bss_info_omac *hdr = (struct bss_info_omac *)data;
 749         u8 idx;
 750 
 751         idx = mvif->omac_idx > EXT_BSSID_START ? HW_BSSID_0 : mvif->omac_idx;
 752         hdr->tag = cpu_to_le16(BSS_INFO_OMAC);
 753         hdr->len = cpu_to_le16(sizeof(struct bss_info_omac));
 754         hdr->hw_bss_idx = idx;
 755         hdr->omac_idx = mvif->omac_idx;
 756         hdr->band_idx = mvif->band_idx;
 757         hdr->conn_type = cpu_to_le32(conn_type);
 758 }
 759 
 760 static void
 761 mt7615_mcu_bss_info_basic_header(struct ieee80211_vif *vif, u8 *data,
 762                                  u32 net_type, u8 tx_wlan_idx,
 763                                  bool enable)
 764 {
 765         struct mt7615_vif *mvif = (struct mt7615_vif *)vif->drv_priv;
 766         struct bss_info_basic *hdr = (struct bss_info_basic *)data;
 767 
 768         hdr->tag = cpu_to_le16(BSS_INFO_BASIC);
 769         hdr->len = cpu_to_le16(sizeof(struct bss_info_basic));
 770         hdr->network_type = cpu_to_le32(net_type);
 771         hdr->active = enable;
 772         hdr->bcn_interval = cpu_to_le16(vif->bss_conf.beacon_int);
 773         memcpy(hdr->bssid, vif->bss_conf.bssid, ETH_ALEN);
 774         hdr->wmm_idx = mvif->wmm_idx;
 775         hdr->dtim_period = vif->bss_conf.dtim_period;
 776         hdr->bmc_tx_wlan_idx = tx_wlan_idx;
 777 }
 778 
 779 static void
 780 mt7615_mcu_bss_info_ext_header(struct mt7615_vif *mvif, u8 *data)
 781 {
 782 /* SIFS 20us + 512 byte beacon tranmitted by 1Mbps (3906us) */
 783 #define BCN_TX_ESTIMATE_TIME (4096 + 20)
 784         struct bss_info_ext_bss *hdr = (struct bss_info_ext_bss *)data;
 785         int ext_bss_idx, tsf_offset;
 786 
 787         ext_bss_idx = mvif->omac_idx - EXT_BSSID_START;
 788         if (ext_bss_idx < 0)
 789                 return;
 790 
 791         hdr->tag = cpu_to_le16(BSS_INFO_EXT_BSS);
 792         hdr->len = cpu_to_le16(sizeof(struct bss_info_ext_bss));
 793         tsf_offset = ext_bss_idx * BCN_TX_ESTIMATE_TIME;
 794         hdr->mbss_tsf_offset = cpu_to_le32(tsf_offset);
 795 }
 796 
 797 int mt7615_mcu_set_bss_info(struct mt7615_dev *dev,
 798                             struct ieee80211_vif *vif, int en)
 799 {
 800         struct mt7615_vif *mvif = (struct mt7615_vif *)vif->drv_priv;
 801         struct req_hdr {
 802                 u8 bss_idx;
 803                 u8 rsv0;
 804                 __le16 tlv_num;
 805                 u8 is_tlv_append;
 806                 u8 rsv1[3];
 807         } __packed;
 808         int len = sizeof(struct req_hdr) + sizeof(struct bss_info_basic);
 809         int ret, i, features = BIT(BSS_INFO_BASIC), ntlv = 1;
 810         u32 conn_type = 0, net_type = NETWORK_INFRA;
 811         u8 *buf, *data, tx_wlan_idx = 0;
 812         struct req_hdr *hdr;
 813 
 814         if (en) {
 815                 len += sizeof(struct bss_info_omac);
 816                 features |= BIT(BSS_INFO_OMAC);
 817                 if (mvif->omac_idx > EXT_BSSID_START) {
 818                         len += sizeof(struct bss_info_ext_bss);
 819                         features |= BIT(BSS_INFO_EXT_BSS);
 820                         ntlv++;
 821                 }
 822                 ntlv++;
 823         }
 824 
 825         switch (vif->type) {
 826         case NL80211_IFTYPE_AP:
 827         case NL80211_IFTYPE_MESH_POINT:
 828                 tx_wlan_idx = mvif->sta.wcid.idx;
 829                 conn_type = CONNECTION_INFRA_AP;
 830                 break;
 831         case NL80211_IFTYPE_STATION: {
 832                 /* TODO: enable BSS_INFO_UAPSD & BSS_INFO_PM */
 833                 if (en) {
 834                         struct ieee80211_sta *sta;
 835                         struct mt7615_sta *msta;
 836 
 837                         rcu_read_lock();
 838                         sta = ieee80211_find_sta(vif, vif->bss_conf.bssid);
 839                         if (!sta) {
 840                                 rcu_read_unlock();
 841                                 return -EINVAL;
 842                         }
 843 
 844                         msta = (struct mt7615_sta *)sta->drv_priv;
 845                         tx_wlan_idx = msta->wcid.idx;
 846                         rcu_read_unlock();
 847                 }
 848                 conn_type = CONNECTION_INFRA_STA;
 849                 break;
 850         }
 851         default:
 852                 WARN_ON(1);
 853                 break;
 854         }
 855 
 856         buf = kzalloc(len, GFP_KERNEL);
 857         if (!buf)
 858                 return -ENOMEM;
 859 
 860         hdr = (struct req_hdr *)buf;
 861         hdr->bss_idx = mvif->idx;
 862         hdr->tlv_num = cpu_to_le16(ntlv);
 863         hdr->is_tlv_append = 1;
 864 
 865         data = buf + sizeof(*hdr);
 866         for (i = 0; i < BSS_INFO_MAX_NUM; i++) {
 867                 int tag = ffs(features & BIT(i)) - 1;
 868 
 869                 switch (tag) {
 870                 case BSS_INFO_OMAC:
 871                         mt7615_mcu_bss_info_omac_header(mvif, data,
 872                                                         conn_type);
 873                         data += sizeof(struct bss_info_omac);
 874                         break;
 875                 case BSS_INFO_BASIC:
 876                         mt7615_mcu_bss_info_basic_header(vif, data, net_type,
 877                                                          tx_wlan_idx, en);
 878                         data += sizeof(struct bss_info_basic);
 879                         break;
 880                 case BSS_INFO_EXT_BSS:
 881                         mt7615_mcu_bss_info_ext_header(mvif, data);
 882                         data += sizeof(struct bss_info_ext_bss);
 883                         break;
 884                 default:
 885                         break;
 886                 }
 887         }
 888 
 889         ret = __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_BSS_INFO_UPDATE,
 890                                   buf, len, true);
 891         kfree(buf);
 892 
 893         return ret;
 894 }
 895 
 896 static int
 897 mt7615_mcu_add_wtbl_bmc(struct mt7615_dev *dev,
 898                         struct mt7615_vif *mvif)
 899 {
 900         struct {
 901                 struct wtbl_req_hdr hdr;
 902                 struct wtbl_generic g_wtbl;
 903                 struct wtbl_rx rx_wtbl;
 904         } req = {
 905                 .hdr = {
 906                         .wlan_idx = mvif->sta.wcid.idx,
 907                         .operation = WTBL_RESET_AND_SET,
 908                         .tlv_num = cpu_to_le16(2),
 909                 },
 910                 .g_wtbl = {
 911                         .tag = cpu_to_le16(WTBL_GENERIC),
 912                         .len = cpu_to_le16(sizeof(struct wtbl_generic)),
 913                         .muar_idx = 0xe,
 914                 },
 915                 .rx_wtbl = {
 916                         .tag = cpu_to_le16(WTBL_RX),
 917                         .len = cpu_to_le16(sizeof(struct wtbl_rx)),
 918                         .rca1 = 1,
 919                         .rca2 = 1,
 920                         .rv = 1,
 921                 },
 922         };
 923         eth_broadcast_addr(req.g_wtbl.peer_addr);
 924 
 925         return __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_WTBL_UPDATE,
 926                                    &req, sizeof(req), true);
 927 }
 928 
 929 int mt7615_mcu_wtbl_bmc(struct mt7615_dev *dev,
 930                         struct ieee80211_vif *vif, bool enable)
 931 {
 932         struct mt7615_vif *mvif = (struct mt7615_vif *)vif->drv_priv;
 933 
 934         if (!enable) {
 935                 struct wtbl_req_hdr req = {
 936                         .wlan_idx = mvif->sta.wcid.idx,
 937                         .operation = WTBL_RESET_AND_SET,
 938                 };
 939 
 940                 return __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_WTBL_UPDATE,
 941                                            &req, sizeof(req), true);
 942         }
 943 
 944         return mt7615_mcu_add_wtbl_bmc(dev, mvif);
 945 }
 946 
 947 int mt7615_mcu_add_wtbl(struct mt7615_dev *dev, struct ieee80211_vif *vif,
 948                         struct ieee80211_sta *sta)
 949 {
 950         struct mt7615_vif *mvif = (struct mt7615_vif *)vif->drv_priv;
 951         struct mt7615_sta *msta = (struct mt7615_sta *)sta->drv_priv;
 952         struct {
 953                 struct wtbl_req_hdr hdr;
 954                 struct wtbl_generic g_wtbl;
 955                 struct wtbl_rx rx_wtbl;
 956         } req = {
 957                 .hdr = {
 958                         .wlan_idx = msta->wcid.idx,
 959                         .operation = WTBL_RESET_AND_SET,
 960                         .tlv_num = cpu_to_le16(2),
 961                 },
 962                 .g_wtbl = {
 963                         .tag = cpu_to_le16(WTBL_GENERIC),
 964                         .len = cpu_to_le16(sizeof(struct wtbl_generic)),
 965                         .muar_idx = mvif->omac_idx,
 966                         .qos = sta->wme,
 967                         .partial_aid = cpu_to_le16(sta->aid),
 968                 },
 969                 .rx_wtbl = {
 970                         .tag = cpu_to_le16(WTBL_RX),
 971                         .len = cpu_to_le16(sizeof(struct wtbl_rx)),
 972                         .rca1 = vif->type != NL80211_IFTYPE_AP,
 973                         .rca2 = 1,
 974                         .rv = 1,
 975                 },
 976         };
 977         memcpy(req.g_wtbl.peer_addr, sta->addr, ETH_ALEN);
 978 
 979         return __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_WTBL_UPDATE,
 980                                    &req, sizeof(req), true);
 981 }
 982 
 983 int mt7615_mcu_del_wtbl(struct mt7615_dev *dev,
 984                         struct ieee80211_sta *sta)
 985 {
 986         struct mt7615_sta *msta = (struct mt7615_sta *)sta->drv_priv;
 987         struct wtbl_req_hdr req = {
 988                 .wlan_idx = msta->wcid.idx,
 989                 .operation = WTBL_RESET_AND_SET,
 990         };
 991 
 992         return __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_WTBL_UPDATE,
 993                                    &req, sizeof(req), true);
 994 }
 995 
 996 int mt7615_mcu_del_wtbl_all(struct mt7615_dev *dev)
 997 {
 998         struct wtbl_req_hdr req = {
 999                 .operation = WTBL_RESET_ALL,
1000         };
1001 
1002         return __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_WTBL_UPDATE,
1003                                    &req, sizeof(req), true);
1004 }
1005 
1006 int mt7615_mcu_set_sta_rec_bmc(struct mt7615_dev *dev,
1007                                struct ieee80211_vif *vif, bool en)
1008 {
1009         struct mt7615_vif *mvif = (struct mt7615_vif *)vif->drv_priv;
1010         struct {
1011                 struct sta_req_hdr hdr;
1012                 struct sta_rec_basic basic;
1013         } req = {
1014                 .hdr = {
1015                         .bss_idx = mvif->idx,
1016                         .wlan_idx = mvif->sta.wcid.idx,
1017                         .tlv_num = cpu_to_le16(1),
1018                         .is_tlv_append = 1,
1019                         .muar_idx = mvif->omac_idx,
1020                 },
1021                 .basic = {
1022                         .tag = cpu_to_le16(STA_REC_BASIC),
1023                         .len = cpu_to_le16(sizeof(struct sta_rec_basic)),
1024                         .conn_type = cpu_to_le32(CONNECTION_INFRA_BC),
1025                 },
1026         };
1027         eth_broadcast_addr(req.basic.peer_addr);
1028 
1029         if (en) {
1030                 req.basic.conn_state = CONN_STATE_PORT_SECURE;
1031                 req.basic.extra_info = cpu_to_le16(EXTRA_INFO_VER |
1032                                                    EXTRA_INFO_NEW);
1033         } else {
1034                 req.basic.conn_state = CONN_STATE_DISCONNECT;
1035                 req.basic.extra_info = cpu_to_le16(EXTRA_INFO_VER);
1036         }
1037 
1038         return __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_STA_REC_UPDATE,
1039                                    &req, sizeof(req), true);
1040 }
1041 
1042 int mt7615_mcu_set_sta_rec(struct mt7615_dev *dev, struct ieee80211_vif *vif,
1043                            struct ieee80211_sta *sta, bool en)
1044 {
1045         struct mt7615_vif *mvif = (struct mt7615_vif *)vif->drv_priv;
1046         struct mt7615_sta *msta = (struct mt7615_sta *)sta->drv_priv;
1047 
1048         struct {
1049                 struct sta_req_hdr hdr;
1050                 struct sta_rec_basic basic;
1051         } req = {
1052                 .hdr = {
1053                         .bss_idx = mvif->idx,
1054                         .wlan_idx = msta->wcid.idx,
1055                         .tlv_num = cpu_to_le16(1),
1056                         .is_tlv_append = 1,
1057                         .muar_idx = mvif->omac_idx,
1058                 },
1059                 .basic = {
1060                         .tag = cpu_to_le16(STA_REC_BASIC),
1061                         .len = cpu_to_le16(sizeof(struct sta_rec_basic)),
1062                         .qos = sta->wme,
1063                         .aid = cpu_to_le16(sta->aid),
1064                 },
1065         };
1066         memcpy(req.basic.peer_addr, sta->addr, ETH_ALEN);
1067 
1068         switch (vif->type) {
1069         case NL80211_IFTYPE_AP:
1070         case NL80211_IFTYPE_MESH_POINT:
1071                 req.basic.conn_type = cpu_to_le32(CONNECTION_INFRA_STA);
1072                 break;
1073         case NL80211_IFTYPE_STATION:
1074                 req.basic.conn_type = cpu_to_le32(CONNECTION_INFRA_AP);
1075                 break;
1076         default:
1077                 WARN_ON(1);
1078                 break;
1079         };
1080 
1081         if (en) {
1082                 req.basic.conn_state = CONN_STATE_PORT_SECURE;
1083                 req.basic.extra_info = cpu_to_le16(EXTRA_INFO_VER |
1084                                                    EXTRA_INFO_NEW);
1085         } else {
1086                 req.basic.conn_state = CONN_STATE_DISCONNECT;
1087                 req.basic.extra_info = cpu_to_le16(EXTRA_INFO_VER);
1088         }
1089 
1090         return __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_STA_REC_UPDATE,
1091                                    &req, sizeof(req), true);
1092 }
1093 
1094 int mt7615_mcu_set_bcn(struct mt7615_dev *dev, struct ieee80211_vif *vif,
1095                        int en)
1096 {
1097         struct mt7615_vif *mvif = (struct mt7615_vif *)vif->drv_priv;
1098         struct mt76_wcid *wcid = &dev->mt76.global_wcid;
1099         struct ieee80211_mutable_offsets offs;
1100         struct req {
1101                 u8 omac_idx;
1102                 u8 enable;
1103                 u8 wlan_idx;
1104                 u8 band_idx;
1105                 u8 pkt_type;
1106                 u8 need_pre_tbtt_int;
1107                 __le16 csa_ie_pos;
1108                 __le16 pkt_len;
1109                 __le16 tim_ie_pos;
1110                 u8 pkt[512];
1111                 u8 csa_cnt;
1112                 /* bss color change */
1113                 u8 bcc_cnt;
1114                 __le16 bcc_ie_pos;
1115         } __packed req = {
1116                 .omac_idx = mvif->omac_idx,
1117                 .enable = en,
1118                 .wlan_idx = wcid->idx,
1119                 .band_idx = mvif->band_idx,
1120         };
1121         struct sk_buff *skb;
1122 
1123         skb = ieee80211_beacon_get_template(mt76_hw(dev), vif, &offs);
1124         if (!skb)
1125                 return -EINVAL;
1126 
1127         if (skb->len > 512 - MT_TXD_SIZE) {
1128                 dev_err(dev->mt76.dev, "Bcn size limit exceed\n");
1129                 dev_kfree_skb(skb);
1130                 return -EINVAL;
1131         }
1132 
1133         mt7615_mac_write_txwi(dev, (__le32 *)(req.pkt), skb, wcid, NULL,
1134                               0, NULL);
1135         memcpy(req.pkt + MT_TXD_SIZE, skb->data, skb->len);
1136         req.pkt_len = cpu_to_le16(MT_TXD_SIZE + skb->len);
1137         req.tim_ie_pos = cpu_to_le16(MT_TXD_SIZE + offs.tim_offset);
1138         if (offs.csa_counter_offs[0]) {
1139                 u16 csa_offs;
1140 
1141                 csa_offs = MT_TXD_SIZE + offs.csa_counter_offs[0] - 4;
1142                 req.csa_ie_pos = cpu_to_le16(csa_offs);
1143                 req.csa_cnt = skb->data[offs.csa_counter_offs[0]];
1144         }
1145         dev_kfree_skb(skb);
1146 
1147         return __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_BCN_OFFLOAD,
1148                                    &req, sizeof(req), true);
1149 }
1150 
1151 int mt7615_mcu_set_tx_power(struct mt7615_dev *dev)
1152 {
1153         int i, ret, n_chains = hweight8(dev->mt76.antenna_mask);
1154         struct cfg80211_chan_def *chandef = &dev->mt76.chandef;
1155         int freq = chandef->center_freq1, len, target_chains;
1156         u8 *req, *data, *eep = (u8 *)dev->mt76.eeprom.data;
1157         enum nl80211_band band = chandef->chan->band;
1158         struct ieee80211_hw *hw = mt76_hw(dev);
1159         struct {
1160                 u8 center_chan;
1161                 u8 dbdc_idx;
1162                 u8 band;
1163                 u8 rsv;
1164         } __packed req_hdr = {
1165                 .center_chan = ieee80211_frequency_to_channel(freq),
1166                 .band = band,
1167         };
1168         s8 tx_power;
1169 
1170         len = sizeof(req_hdr) + __MT_EE_MAX - MT_EE_NIC_CONF_0;
1171         req = kzalloc(len, GFP_KERNEL);
1172         if (!req)
1173                 return -ENOMEM;
1174 
1175         memcpy(req, &req_hdr, sizeof(req_hdr));
1176         data = req + sizeof(req_hdr);
1177         memcpy(data, eep + MT_EE_NIC_CONF_0,
1178                __MT_EE_MAX - MT_EE_NIC_CONF_0);
1179 
1180         tx_power = hw->conf.power_level * 2;
1181         switch (n_chains) {
1182         case 4:
1183                 tx_power -= 12;
1184                 break;
1185         case 3:
1186                 tx_power -= 8;
1187                 break;
1188         case 2:
1189                 tx_power -= 6;
1190                 break;
1191         default:
1192                 break;
1193         }
1194         tx_power = max_t(s8, tx_power, 0);
1195         dev->mt76.txpower_cur = tx_power;
1196 
1197         target_chains = mt7615_ext_pa_enabled(dev, band) ? 1 : n_chains;
1198         for (i = 0; i < target_chains; i++) {
1199                 int index = -MT_EE_NIC_CONF_0;
1200 
1201                 ret = mt7615_eeprom_get_power_index(dev, chandef->chan, i);
1202                 if (ret < 0)
1203                         goto out;
1204 
1205                 index += ret;
1206                 data[index] = min_t(u8, data[index], tx_power);
1207         }
1208 
1209         ret = __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_SET_TX_POWER_CTRL,
1210                                   req, len, true);
1211 out:
1212         kfree(req);
1213 
1214         return ret;
1215 }
1216 
1217 int mt7615_mcu_rdd_cmd(struct mt7615_dev *dev,
1218                        enum mt7615_rdd_cmd cmd, u8 index,
1219                        u8 rx_sel, u8 val)
1220 {
1221         struct {
1222                 u8 ctrl;
1223                 u8 rdd_idx;
1224                 u8 rdd_rx_sel;
1225                 u8 val;
1226                 u8 rsv[4];
1227         } req = {
1228                 .ctrl = cmd,
1229                 .rdd_idx = index,
1230                 .rdd_rx_sel = rx_sel,
1231                 .val = val,
1232         };
1233 
1234         return __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_SET_RDD_CTRL,
1235                                    &req, sizeof(req), true);
1236 }
1237 
1238 int mt7615_mcu_rdd_send_pattern(struct mt7615_dev *dev)
1239 {
1240         struct {
1241                 u8 pulse_num;
1242                 u8 rsv[3];
1243                 struct {
1244                         u32 start_time;
1245                         u16 width;
1246                         s16 power;
1247                 } pattern[32];
1248         } req = {
1249                 .pulse_num = dev->radar_pattern.n_pulses,
1250         };
1251         u32 start_time = ktime_to_ms(ktime_get_boottime());
1252         int i;
1253 
1254         if (dev->radar_pattern.n_pulses > ARRAY_SIZE(req.pattern))
1255                 return -EINVAL;
1256 
1257         /* TODO: add some noise here */
1258         for (i = 0; i < dev->radar_pattern.n_pulses; i++) {
1259                 req.pattern[i].width = dev->radar_pattern.width;
1260                 req.pattern[i].power = dev->radar_pattern.power;
1261                 req.pattern[i].start_time = start_time +
1262                                             i * dev->radar_pattern.period;
1263         }
1264 
1265         return __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_SET_RDD_PATTERN,
1266                                    &req, sizeof(req), false);
1267 }
1268 
1269 int mt7615_mcu_set_channel(struct mt7615_dev *dev)
1270 {
1271         struct cfg80211_chan_def *chandef = &dev->mt76.chandef;
1272         int freq1 = chandef->center_freq1, freq2 = chandef->center_freq2;
1273         struct {
1274                 u8 control_chan;
1275                 u8 center_chan;
1276                 u8 bw;
1277                 u8 tx_streams;
1278                 u8 rx_streams_mask;
1279                 u8 switch_reason;
1280                 u8 band_idx;
1281                 /* for 80+80 only */
1282                 u8 center_chan2;
1283                 __le16 cac_case;
1284                 u8 channel_band;
1285                 u8 rsv0;
1286                 __le32 outband_freq;
1287                 u8 txpower_drop;
1288                 u8 rsv1[3];
1289                 u8 txpower_sku[53];
1290                 u8 rsv2[3];
1291         } req = {
1292                 .control_chan = chandef->chan->hw_value,
1293                 .center_chan = ieee80211_frequency_to_channel(freq1),
1294                 .tx_streams = (dev->mt76.chainmask >> 8) & 0xf,
1295                 .rx_streams_mask = dev->mt76.antenna_mask,
1296                 .center_chan2 = ieee80211_frequency_to_channel(freq2),
1297         };
1298         int ret;
1299 
1300         if ((chandef->chan->flags & IEEE80211_CHAN_RADAR) &&
1301             chandef->chan->dfs_state != NL80211_DFS_AVAILABLE)
1302                 req.switch_reason = CH_SWITCH_DFS;
1303         else
1304                 req.switch_reason = CH_SWITCH_NORMAL;
1305 
1306         switch (dev->mt76.chandef.width) {
1307         case NL80211_CHAN_WIDTH_40:
1308                 req.bw = CMD_CBW_40MHZ;
1309                 break;
1310         case NL80211_CHAN_WIDTH_80:
1311                 req.bw = CMD_CBW_80MHZ;
1312                 break;
1313         case NL80211_CHAN_WIDTH_80P80:
1314                 req.bw = CMD_CBW_8080MHZ;
1315                 break;
1316         case NL80211_CHAN_WIDTH_160:
1317                 req.bw = CMD_CBW_160MHZ;
1318                 break;
1319         case NL80211_CHAN_WIDTH_5:
1320                 req.bw = CMD_CBW_5MHZ;
1321                 break;
1322         case NL80211_CHAN_WIDTH_10:
1323                 req.bw = CMD_CBW_10MHZ;
1324                 break;
1325         case NL80211_CHAN_WIDTH_20_NOHT:
1326         case NL80211_CHAN_WIDTH_20:
1327         default:
1328                 req.bw = CMD_CBW_20MHZ;
1329                 break;
1330         }
1331         memset(req.txpower_sku, 0x3f, 49);
1332 
1333         ret = __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_CHANNEL_SWITCH,
1334                                   &req, sizeof(req), true);
1335         if (ret)
1336                 return ret;
1337 
1338         return __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_SET_RX_PATH,
1339                                    &req, sizeof(req), true);
1340 }
1341 
1342 int mt7615_mcu_set_ht_cap(struct mt7615_dev *dev, struct ieee80211_vif *vif,
1343                           struct ieee80211_sta *sta)
1344 {
1345         struct mt7615_sta *msta = (struct mt7615_sta *)sta->drv_priv;
1346         struct mt7615_vif *mvif = (struct mt7615_vif *)vif->drv_priv;
1347         struct wtbl_req_hdr *wtbl_hdr;
1348         struct sta_req_hdr *sta_hdr;
1349         struct wtbl_raw *wtbl_raw;
1350         struct sta_rec_ht *sta_ht;
1351         struct wtbl_ht *wtbl_ht;
1352         int buf_len, ret, ntlv = 2;
1353         u32 msk, val = 0;
1354         u8 *buf;
1355 
1356         buf = kzalloc(MT7615_WTBL_UPDATE_MAX_SIZE, GFP_KERNEL);
1357         if (!buf)
1358                 return -ENOMEM;
1359 
1360         wtbl_hdr = (struct wtbl_req_hdr *)buf;
1361         wtbl_hdr->wlan_idx = msta->wcid.idx;
1362         wtbl_hdr->operation = WTBL_SET;
1363         buf_len = sizeof(*wtbl_hdr);
1364 
1365         /* ht basic */
1366         wtbl_ht = (struct wtbl_ht *)(buf + buf_len);
1367         wtbl_ht->tag = cpu_to_le16(WTBL_HT);
1368         wtbl_ht->len = cpu_to_le16(sizeof(*wtbl_ht));
1369         wtbl_ht->ht = 1;
1370         wtbl_ht->ldpc = sta->ht_cap.cap & IEEE80211_HT_CAP_LDPC_CODING;
1371         wtbl_ht->af = sta->ht_cap.ampdu_factor;
1372         wtbl_ht->mm = sta->ht_cap.ampdu_density;
1373         buf_len += sizeof(*wtbl_ht);
1374 
1375         if (sta->ht_cap.cap & IEEE80211_HT_CAP_SGI_20)
1376                 val |= MT_WTBL_W5_SHORT_GI_20;
1377         if (sta->ht_cap.cap & IEEE80211_HT_CAP_SGI_40)
1378                 val |= MT_WTBL_W5_SHORT_GI_40;
1379 
1380         /* vht basic */
1381         if (sta->vht_cap.vht_supported) {
1382                 struct wtbl_vht *wtbl_vht;
1383 
1384                 wtbl_vht = (struct wtbl_vht *)(buf + buf_len);
1385                 buf_len += sizeof(*wtbl_vht);
1386                 wtbl_vht->tag = cpu_to_le16(WTBL_VHT);
1387                 wtbl_vht->len = cpu_to_le16(sizeof(*wtbl_vht));
1388                 wtbl_vht->ldpc = sta->vht_cap.cap & IEEE80211_VHT_CAP_RXLDPC;
1389                 wtbl_vht->vht = 1;
1390                 ntlv++;
1391 
1392                 if (sta->vht_cap.cap & IEEE80211_VHT_CAP_SHORT_GI_80)
1393                         val |= MT_WTBL_W5_SHORT_GI_80;
1394                 if (sta->vht_cap.cap & IEEE80211_VHT_CAP_SHORT_GI_160)
1395                         val |= MT_WTBL_W5_SHORT_GI_160;
1396         }
1397 
1398         /* smps */
1399         if (sta->smps_mode == IEEE80211_SMPS_DYNAMIC) {
1400                 struct wtbl_smps *wtbl_smps;
1401 
1402                 wtbl_smps = (struct wtbl_smps *)(buf + buf_len);
1403                 buf_len += sizeof(*wtbl_smps);
1404                 wtbl_smps->tag = cpu_to_le16(WTBL_SMPS);
1405                 wtbl_smps->len = cpu_to_le16(sizeof(*wtbl_smps));
1406                 wtbl_smps->smps = 1;
1407                 ntlv++;
1408         }
1409 
1410         /* sgi */
1411         msk = MT_WTBL_W5_SHORT_GI_20 | MT_WTBL_W5_SHORT_GI_40 |
1412               MT_WTBL_W5_SHORT_GI_80 | MT_WTBL_W5_SHORT_GI_160;
1413 
1414         wtbl_raw = (struct wtbl_raw *)(buf + buf_len);
1415         buf_len += sizeof(*wtbl_raw);
1416         wtbl_raw->tag = cpu_to_le16(WTBL_RAW_DATA);
1417         wtbl_raw->len = cpu_to_le16(sizeof(*wtbl_raw));
1418         wtbl_raw->wtbl_idx = 1;
1419         wtbl_raw->dw = 5;
1420         wtbl_raw->msk = cpu_to_le32(~msk);
1421         wtbl_raw->val = cpu_to_le32(val);
1422 
1423         wtbl_hdr->tlv_num = cpu_to_le16(ntlv);
1424         ret = __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_WTBL_UPDATE,
1425                                   buf, buf_len, true);
1426         if (ret)
1427                 goto out;
1428 
1429         memset(buf, 0, MT7615_WTBL_UPDATE_MAX_SIZE);
1430 
1431         sta_hdr = (struct sta_req_hdr *)buf;
1432         sta_hdr->bss_idx = mvif->idx;
1433         sta_hdr->wlan_idx = msta->wcid.idx;
1434         sta_hdr->is_tlv_append = 1;
1435         ntlv = sta->vht_cap.vht_supported ? 2 : 1;
1436         sta_hdr->tlv_num = cpu_to_le16(ntlv);
1437         sta_hdr->muar_idx = mvif->omac_idx;
1438         buf_len = sizeof(*sta_hdr);
1439 
1440         sta_ht = (struct sta_rec_ht *)(buf + buf_len);
1441         sta_ht->tag = cpu_to_le16(STA_REC_HT);
1442         sta_ht->len = cpu_to_le16(sizeof(*sta_ht));
1443         sta_ht->ht_cap = cpu_to_le16(sta->ht_cap.cap);
1444         buf_len += sizeof(*sta_ht);
1445 
1446         if (sta->vht_cap.vht_supported) {
1447                 struct sta_rec_vht *sta_vht;
1448 
1449                 sta_vht = (struct sta_rec_vht *)(buf + buf_len);
1450                 buf_len += sizeof(*sta_vht);
1451                 sta_vht->tag = cpu_to_le16(STA_REC_VHT);
1452                 sta_vht->len = cpu_to_le16(sizeof(*sta_vht));
1453                 sta_vht->vht_cap = cpu_to_le32(sta->vht_cap.cap);
1454                 sta_vht->vht_rx_mcs_map = sta->vht_cap.vht_mcs.rx_mcs_map;
1455                 sta_vht->vht_tx_mcs_map = sta->vht_cap.vht_mcs.tx_mcs_map;
1456         }
1457 
1458         ret = __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_STA_REC_UPDATE,
1459                                   buf, buf_len, true);
1460 out:
1461         kfree(buf);
1462 
1463         return ret;
1464 }
1465 
1466 int mt7615_mcu_set_tx_ba(struct mt7615_dev *dev,
1467                          struct ieee80211_ampdu_params *params,
1468                          bool add)
1469 {
1470         struct mt7615_sta *msta = (struct mt7615_sta *)params->sta->drv_priv;
1471         struct mt7615_vif *mvif = msta->vif;
1472         struct {
1473                 struct wtbl_req_hdr hdr;
1474                 struct wtbl_ba ba;
1475         } wtbl_req = {
1476                 .hdr = {
1477                         .wlan_idx = msta->wcid.idx,
1478                         .operation = WTBL_SET,
1479                         .tlv_num = cpu_to_le16(1),
1480                 },
1481                 .ba = {
1482                         .tag = cpu_to_le16(WTBL_BA),
1483                         .len = cpu_to_le16(sizeof(struct wtbl_ba)),
1484                         .tid = params->tid,
1485                         .ba_type = MT_BA_TYPE_ORIGINATOR,
1486                         .sn = add ? cpu_to_le16(params->ssn) : 0,
1487                         .ba_en = add,
1488                 },
1489         };
1490         struct {
1491                 struct sta_req_hdr hdr;
1492                 struct sta_rec_ba ba;
1493         } sta_req = {
1494                 .hdr = {
1495                         .bss_idx = mvif->idx,
1496                         .wlan_idx = msta->wcid.idx,
1497                         .tlv_num = cpu_to_le16(1),
1498                         .is_tlv_append = 1,
1499                         .muar_idx = mvif->omac_idx,
1500                 },
1501                 .ba = {
1502                         .tag = cpu_to_le16(STA_REC_BA),
1503                         .len = cpu_to_le16(sizeof(struct sta_rec_ba)),
1504                         .tid = params->tid,
1505                         .ba_type = MT_BA_TYPE_ORIGINATOR,
1506                         .amsdu = params->amsdu,
1507                         .ba_en = add << params->tid,
1508                         .ssn = cpu_to_le16(params->ssn),
1509                         .winsize = cpu_to_le16(params->buf_size),
1510                 },
1511         };
1512         int ret;
1513 
1514         if (add) {
1515                 u8 idx, ba_range[] = { 4, 8, 12, 24, 36, 48, 54, 64 };
1516 
1517                 for (idx = 7; idx > 0; idx--) {
1518                         if (params->buf_size >= ba_range[idx])
1519                                 break;
1520                 }
1521 
1522                 wtbl_req.ba.ba_winsize_idx = idx;
1523         }
1524 
1525         ret = __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_WTBL_UPDATE,
1526                                   &wtbl_req, sizeof(wtbl_req), true);
1527         if (ret)
1528                 return ret;
1529 
1530         return __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_STA_REC_UPDATE,
1531                                    &sta_req, sizeof(sta_req), true);
1532 }
1533 
1534 int mt7615_mcu_set_rx_ba(struct mt7615_dev *dev,
1535                          struct ieee80211_ampdu_params *params,
1536                          bool add)
1537 {
1538         struct mt7615_sta *msta = (struct mt7615_sta *)params->sta->drv_priv;
1539         struct mt7615_vif *mvif = msta->vif;
1540         struct {
1541                 struct wtbl_req_hdr hdr;
1542                 struct wtbl_ba ba;
1543         } wtbl_req = {
1544                 .hdr = {
1545                         .wlan_idx = msta->wcid.idx,
1546                         .operation = WTBL_SET,
1547                         .tlv_num = cpu_to_le16(1),
1548                 },
1549                 .ba = {
1550                         .tag = cpu_to_le16(WTBL_BA),
1551                         .len = cpu_to_le16(sizeof(struct wtbl_ba)),
1552                         .tid = params->tid,
1553                         .ba_type = MT_BA_TYPE_RECIPIENT,
1554                         .rst_ba_tid = params->tid,
1555                         .rst_ba_sel = RST_BA_MAC_TID_MATCH,
1556                         .rst_ba_sb = 1,
1557                 },
1558         };
1559         struct {
1560                 struct sta_req_hdr hdr;
1561                 struct sta_rec_ba ba;
1562         } sta_req = {
1563                 .hdr = {
1564                         .bss_idx = mvif->idx,
1565                         .wlan_idx = msta->wcid.idx,
1566                         .tlv_num = cpu_to_le16(1),
1567                         .is_tlv_append = 1,
1568                         .muar_idx = mvif->omac_idx,
1569                 },
1570                 .ba = {
1571                         .tag = cpu_to_le16(STA_REC_BA),
1572                         .len = cpu_to_le16(sizeof(struct sta_rec_ba)),
1573                         .tid = params->tid,
1574                         .ba_type = MT_BA_TYPE_RECIPIENT,
1575                         .amsdu = params->amsdu,
1576                         .ba_en = add << params->tid,
1577                         .ssn = cpu_to_le16(params->ssn),
1578                         .winsize = cpu_to_le16(params->buf_size),
1579                 },
1580         };
1581         int ret;
1582 
1583         memcpy(wtbl_req.ba.peer_addr, params->sta->addr, ETH_ALEN);
1584 
1585         ret = __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_STA_REC_UPDATE,
1586                                   &sta_req, sizeof(sta_req), true);
1587         if (ret || !add)
1588                 return ret;
1589 
1590         return __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_WTBL_UPDATE,
1591                                    &wtbl_req, sizeof(wtbl_req), true);
1592 }
1593 
1594 int mt7615_mcu_get_temperature(struct mt7615_dev *dev, int index)
1595 {
1596         struct {
1597                 u8 action;
1598                 u8 rsv[3];
1599         } req = {
1600                 .action = index,
1601         };
1602 
1603         return __mt76_mcu_send_msg(&dev->mt76, MCU_EXT_CMD_GET_TEMP, &req,
1604                                    sizeof(req), true);
1605 }

/* [<][>][^][v][top][bottom][index][help] */