199 lines · c
1// SPDX-License-Identifier: ISC2/*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 14static int15mt76pci_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 = request_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 72out: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 80static int81mt76pci_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 = request_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 else125 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 151error:152 dev_err(dev->mt76.dev, "Invalid firmware\n");153 release_firmware(fw);154 return -ENOENT;155}156 157static int158mt76pci_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 177int 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 .mcu_parse_response = mt76x02_mcu_parse_response,183 };184 int ret;185 186 dev->mt76.mcu_ops = &mt76x2_mcu_ops;187 188 ret = mt76pci_load_rom_patch(dev);189 if (ret)190 return ret;191 192 ret = mt76pci_load_firmware(dev);193 if (ret)194 return ret;195 196 mt76x02_mcu_function_select(dev, Q_SELECT, 1);197 return 0;198}199