drivers/net/wireless/mediatek/mt76/mt76x2/pci_mcu.c

   1 // SPDX-License-Identifier: ISC
   2 /*
   3  * Copyright (C) 2016 Felix Fietkau <nbd@nbd.name>
   4  */
   5
   6 #include <linux/kernel.h>
   7 #include <linux/firmware.h>
   8 #include <linux/delay.h>
   9
  10 #include "mt76x2.h"
  11 #include "mcu.h"
  12 #include "eeprom.h"
  13
  14 static int
  15 mt76pci_load_rom_patch(struct mt76x02_dev *dev)
  16 {
  17         const struct firmware *fw = NULL;
  18         struct mt76x02_patch_header *hdr;
  19         bool rom_protect = !is_mt7612(dev);
  20         int len, ret = 0;
  21         __le32 *cur;
  22         u32 patch_mask, patch_reg;
  23
  24         if (rom_protect && !mt76_poll(dev, MT_MCU_SEMAPHORE_03, 1, 1, 600)) {
  25                 dev_err(dev->mt76.dev,
  26                         "Could not get hardware semaphore for ROM PATCH\n");
  27                 return -ETIMEDOUT;
  28         }
  29
  30         if (mt76xx_rev(dev) >= MT76XX_REV_E3) {
  31                 patch_mask = BIT(0);
  32                 patch_reg = MT_MCU_CLOCK_CTL;
  33         } else {
  34                 patch_mask = BIT(1);
  35                 patch_reg = MT_MCU_COM_REG0;
  36         }
  37
  38         if (rom_protect && (mt76_rr(dev, patch_reg) & patch_mask)) {
  39                 dev_info(dev->mt76.dev, "ROM patch already applied\n");
  40                 goto out;
  41         }
  42
  43         ret = reject_firmware(&fw, MT7662_ROM_PATCH, dev->mt76.dev);
  44         if (ret)
  45                 goto out;
  46
  47         if (!fw || !fw->data || fw->size <= sizeof(*hdr)) {
  48                 ret = -EIO;
  49                 dev_err(dev->mt76.dev, "Failed to load firmware\n");
  50                 goto out;
  51         }
  52
  53         hdr = (struct mt76x02_patch_header *)fw->data;
  54         dev_info(dev->mt76.dev, "ROM patch build: %.15s\n", hdr->build_time);
  55
  56         mt76_wr(dev, MT_MCU_PCIE_REMAP_BASE4, MT_MCU_ROM_PATCH_OFFSET);
  57
  58         cur = (__le32 *)(fw->data + sizeof(*hdr));
  59         len = fw->size - sizeof(*hdr);
  60         mt76_wr_copy(dev, MT_MCU_ROM_PATCH_ADDR, cur, len);
  61
  62         mt76_wr(dev, MT_MCU_PCIE_REMAP_BASE4, 0);
  63
  64         /* Trigger ROM */
  65         mt76_wr(dev, MT_MCU_INT_LEVEL, 4);
  66
  67         if (!mt76_poll_msec(dev, patch_reg, patch_mask, patch_mask, 2000)) {
  68                 dev_err(dev->mt76.dev, "Failed to load ROM patch\n");
  69                 ret = -ETIMEDOUT;
  70         }
  71
  72 out:
  73         /* release semaphore */
  74         if (rom_protect)
  75                 mt76_wr(dev, MT_MCU_SEMAPHORE_03, 1);
  76         release_firmware(fw);
  77         return ret;
  78 }
  79
  80 static int
  81 mt76pci_load_firmware(struct mt76x02_dev *dev)
  82 {
  83         const struct firmware *fw;
  84         const struct mt76x02_fw_header *hdr;
  85         int len, ret;
  86         __le32 *cur;
  87         u32 offset, val;
  88
  89         ret = reject_firmware(&fw, MT7662_FIRMWARE, dev->mt76.dev);
  90         if (ret)
  91                 return ret;
  92
  93         if (!fw || !fw->data || fw->size < sizeof(*hdr))
  94                 goto error;
  95
  96         hdr = (const struct mt76x02_fw_header *)fw->data;
  97
  98         len = sizeof(*hdr);
  99         len += le32_to_cpu(hdr->ilm_len);
 100         len += le32_to_cpu(hdr->dlm_len);
 101
 102         if (fw->size != len)
 103                 goto error;
 104
 105         val = le16_to_cpu(hdr->fw_ver);
 106         dev_info(dev->mt76.dev, "Firmware Version: %d.%d.%02d\n",
 107                  (val >> 12) & 0xf, (val >> 8) & 0xf, val & 0xf);
 108
 109         val = le16_to_cpu(hdr->build_ver);
 110         dev_info(dev->mt76.dev, "Build: %x\n", val);
 111         dev_info(dev->mt76.dev, "Build Time: %.16s\n", hdr->build_time);
 112
 113         cur = (__le32 *)(fw->data + sizeof(*hdr));
 114         len = le32_to_cpu(hdr->ilm_len);
 115
 116         mt76_wr(dev, MT_MCU_PCIE_REMAP_BASE4, MT_MCU_ILM_OFFSET);
 117         mt76_wr_copy(dev, MT_MCU_ILM_ADDR, cur, len);
 118
 119         cur += len / sizeof(*cur);
 120         len = le32_to_cpu(hdr->dlm_len);
 121
 122         if (mt76xx_rev(dev) >= MT76XX_REV_E3)
 123                 offset = MT_MCU_DLM_ADDR_E3;
 124         else
 125                 offset = MT_MCU_DLM_ADDR;
 126
 127         mt76_wr(dev, MT_MCU_PCIE_REMAP_BASE4, MT_MCU_DLM_OFFSET);
 128         mt76_wr_copy(dev, offset, cur, len);
 129
 130         mt76_wr(dev, MT_MCU_PCIE_REMAP_BASE4, 0);
 131
 132         val = mt76x02_eeprom_get(dev, MT_EE_NIC_CONF_2);
 133         if (FIELD_GET(MT_EE_NIC_CONF_2_XTAL_OPTION, val) == 1)
 134                 mt76_set(dev, MT_MCU_COM_REG0, BIT(30));
 135
 136         /* trigger firmware */
 137         mt76_wr(dev, MT_MCU_INT_LEVEL, 2);
 138         if (!mt76_poll_msec(dev, MT_MCU_COM_REG0, 1, 1, 200)) {
 139                 dev_err(dev->mt76.dev, "Firmware failed to start\n");
 140                 release_firmware(fw);
 141                 return -ETIMEDOUT;
 142         }
 143
 144         mt76x02_set_ethtool_fwver(dev, hdr);
 145         dev_info(dev->mt76.dev, "Firmware running!\n");
 146
 147         release_firmware(fw);
 148
 149         return ret;
 150
 151 error:
 152         dev_err(dev->mt76.dev, "Invalid firmware\n");
 153         release_firmware(fw);
 154         return -ENOENT;
 155 }
 156
 157 static int
 158 mt76pci_mcu_restart(struct mt76_dev *mdev)
 159 {
 160         struct mt76x02_dev *dev;
 161         int ret;
 162
 163         dev = container_of(mdev, struct mt76x02_dev, mt76);
 164
 165         mt76x02_mcu_cleanup(dev);
 166         mt76x2_mac_reset(dev, true);
 167
 168         ret = mt76pci_load_firmware(dev);
 169         if (ret)
 170                 return ret;
 171
 172         mt76_wr(dev, MT_WPDMA_RST_IDX, ~0);
 173
 174         return 0;
 175 }
 176
 177 int mt76x2_mcu_init(struct mt76x02_dev *dev)
 178 {
 179         static const struct mt76_mcu_ops mt76x2_mcu_ops = {
 180                 .mcu_restart = mt76pci_mcu_restart,
 181                 .mcu_send_msg = mt76x02_mcu_msg_send,
 182         };
 183         int ret;
 184
 185         dev->mt76.mcu_ops = &mt76x2_mcu_ops;
 186
 187         ret = mt76pci_load_rom_patch(dev);
 188         if (ret)
 189                 return ret;
 190
 191         ret = mt76pci_load_firmware(dev);
 192         if (ret)
 193                 return ret;
 194
 195         mt76x02_mcu_function_select(dev, Q_SELECT, 1);
 196         return 0;
 197 }