1 /* 2 * Copyright (C) 2018 Lorenzo Bianconi <lorenzo.bianconi83@gmail.com> 3 * 4 * Permission to use, copy, modify, and/or distribute this software for any 5 * purpose with or without fee is hereby granted, provided that the above 6 * copyright notice and this permission notice appear in all copies. 7 * 8 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 9 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 10 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 11 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 12 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 13 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 14 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 15 */ 16 #include <linux/kernel.h> 17 #include <linux/firmware.h> 18 19 #include "mt76x0.h" 20 #include "mcu.h" 21 #include "../mt76x02_usb.h" 22 23 #define MCU_FW_URB_MAX_PAYLOAD 0x38f8 24 #define MCU_FW_URB_SIZE (MCU_FW_URB_MAX_PAYLOAD + 12) 25 #define MT7610U_FIRMWARE "mediatek/mt7610u.bin" 26 27 static int 28 mt76x0u_upload_firmware(struct mt76x02_dev *dev, 29 const struct mt76x02_fw_header *hdr) 30 { 31 u8 *fw_payload = (u8 *)(hdr + 1); 32 u32 ilm_len, dlm_len; 33 void *ivb; 34 int err; 35 36 ivb = kmemdup(fw_payload, MT_MCU_IVB_SIZE, GFP_KERNEL); 37 if (!ivb) 38 return -ENOMEM; 39 40 ilm_len = le32_to_cpu(hdr->ilm_len) - MT_MCU_IVB_SIZE; 41 dev_dbg(dev->mt76.dev, "loading FW - ILM %u + IVB %u\n", 42 ilm_len, MT_MCU_IVB_SIZE); 43 err = mt76x02u_mcu_fw_send_data(&dev->mt76, 44 fw_payload + MT_MCU_IVB_SIZE, 45 ilm_len, MCU_FW_URB_MAX_PAYLOAD, 46 MT_MCU_IVB_SIZE); 47 if (err) 48 goto out; 49 50 dlm_len = le32_to_cpu(hdr->dlm_len); 51 dev_dbg(dev->mt76.dev, "loading FW - DLM %u\n", dlm_len); 52 err = mt76x02u_mcu_fw_send_data(&dev->mt76, 53 fw_payload + le32_to_cpu(hdr->ilm_len), 54 dlm_len, MCU_FW_URB_MAX_PAYLOAD, 55 MT_MCU_DLM_OFFSET); 56 if (err) 57 goto out; 58 59 err = mt76u_vendor_request(&dev->mt76, MT_VEND_DEV_MODE, 60 USB_DIR_OUT | USB_TYPE_VENDOR, 61 0x12, 0, ivb, MT_MCU_IVB_SIZE); 62 if (err < 0) 63 goto out; 64 65 if (!mt76_poll_msec(dev, MT_MCU_COM_REG0, 1, 1, 1000)) { 66 dev_err(dev->mt76.dev, "Firmware failed to start\n"); 67 err = -ETIMEDOUT; 68 goto out; 69 } 70 71 dev_dbg(dev->mt76.dev, "Firmware running!\n"); 72 73 out: 74 kfree(ivb); 75 76 return err; 77 } 78 79 static int mt76x0u_load_firmware(struct mt76x02_dev *dev) 80 { 81 const struct firmware *fw; 82 const struct mt76x02_fw_header *hdr; 83 int len, ret; 84 u32 val; 85 86 mt76_wr(dev, MT_USB_DMA_CFG, (MT_USB_DMA_CFG_RX_BULK_EN | 87 MT_USB_DMA_CFG_TX_BULK_EN)); 88 89 if (mt76x0_firmware_running(dev)) 90 return 0; 91 92 ret = request_firmware(&fw, MT7610U_FIRMWARE, dev->mt76.dev); 93 if (ret) 94 return ret; 95 96 if (!fw || !fw->data || fw->size < sizeof(*hdr)) 97 goto err_inv_fw; 98 99 hdr = (const struct mt76x02_fw_header *)fw->data; 100 101 if (le32_to_cpu(hdr->ilm_len) <= MT_MCU_IVB_SIZE) 102 goto err_inv_fw; 103 104 len = sizeof(*hdr); 105 len += le32_to_cpu(hdr->ilm_len); 106 len += le32_to_cpu(hdr->dlm_len); 107 108 if (fw->size != len) 109 goto err_inv_fw; 110 111 val = le16_to_cpu(hdr->fw_ver); 112 dev_dbg(dev->mt76.dev, 113 "Firmware Version: %d.%d.%02d Build: %x Build time: %.16s\n", 114 (val >> 12) & 0xf, (val >> 8) & 0xf, val & 0xf, 115 le16_to_cpu(hdr->build_ver), hdr->build_time); 116 117 len = le32_to_cpu(hdr->ilm_len); 118 119 mt76_wr(dev, 0x1004, 0x2c); 120 121 mt76_set(dev, MT_USB_DMA_CFG, 122 (MT_USB_DMA_CFG_RX_BULK_EN | MT_USB_DMA_CFG_TX_BULK_EN) | 123 FIELD_PREP(MT_USB_DMA_CFG_RX_BULK_AGG_TOUT, 0x20)); 124 mt76x02u_mcu_fw_reset(&dev->mt76); 125 usleep_range(5000, 6000); 126 /* 127 mt76x0_rmw(dev, MT_PBF_CFG, 0, (MT_PBF_CFG_TX0Q_EN | 128 MT_PBF_CFG_TX1Q_EN | 129 MT_PBF_CFG_TX2Q_EN | 130 MT_PBF_CFG_TX3Q_EN)); 131 */ 132 133 mt76_wr(dev, MT_FCE_PSE_CTRL, 1); 134 135 /* FCE tx_fs_base_ptr */ 136 mt76_wr(dev, MT_TX_CPU_FROM_FCE_BASE_PTR, 0x400230); 137 /* FCE tx_fs_max_cnt */ 138 mt76_wr(dev, MT_TX_CPU_FROM_FCE_MAX_COUNT, 1); 139 /* FCE pdma enable */ 140 mt76_wr(dev, MT_FCE_PDMA_GLOBAL_CONF, 0x44); 141 /* FCE skip_fs_en */ 142 mt76_wr(dev, MT_FCE_SKIP_FS, 3); 143 144 val = mt76_rr(dev, MT_USB_DMA_CFG); 145 val |= MT_USB_DMA_CFG_UDMA_TX_WL_DROP; 146 mt76_wr(dev, MT_USB_DMA_CFG, val); 147 val &= ~MT_USB_DMA_CFG_UDMA_TX_WL_DROP; 148 mt76_wr(dev, MT_USB_DMA_CFG, val); 149 150 ret = mt76x0u_upload_firmware(dev, hdr); 151 release_firmware(fw); 152 153 mt76_wr(dev, MT_FCE_PSE_CTRL, 1); 154 155 return ret; 156 157 err_inv_fw: 158 dev_err(dev->mt76.dev, "Invalid firmware image\n"); 159 release_firmware(fw); 160 return -ENOENT; 161 } 162 163 int mt76x0u_mcu_init(struct mt76x02_dev *dev) 164 { 165 int ret; 166 167 ret = mt76x0u_load_firmware(dev); 168 if (ret < 0) 169 return ret; 170 171 set_bit(MT76_STATE_MCU_RUNNING, &dev->mt76.state); 172 173 return 0; 174 } 175 176 MODULE_FIRMWARE(MT7610U_FIRMWARE); 177