1 // SPDX-License-Identifier: ISC 2 /* 3 * Copyright (C) 2018 Lorenzo Bianconi <lorenzo.bianconi83@gmail.com> 4 */ 5 6 #include <linux/delay.h> 7 8 #include "mt76x2u.h" 9 #include "eeprom.h" 10 #include "../mt76x02_phy.h" 11 #include "../mt76x02_usb.h" 12 13 static void mt76x2u_init_dma(struct mt76x02_dev *dev) 14 { 15 u32 val = mt76_rr(dev, MT_VEND_ADDR(CFG, MT_USB_U3DMA_CFG)); 16 17 val |= MT_USB_DMA_CFG_RX_DROP_OR_PAD | 18 MT_USB_DMA_CFG_RX_BULK_EN | 19 MT_USB_DMA_CFG_TX_BULK_EN; 20 21 /* disable AGGR_BULK_RX in order to receive one 22 * frame in each rx urb and avoid copies 23 */ 24 val &= ~MT_USB_DMA_CFG_RX_BULK_AGG_EN; 25 mt76_wr(dev, MT_VEND_ADDR(CFG, MT_USB_U3DMA_CFG), val); 26 } 27 28 static void mt76x2u_power_on_rf_patch(struct mt76x02_dev *dev) 29 { 30 mt76_set(dev, MT_VEND_ADDR(CFG, 0x130), BIT(0) | BIT(16)); 31 udelay(1); 32 33 mt76_clear(dev, MT_VEND_ADDR(CFG, 0x1c), 0xff); 34 mt76_set(dev, MT_VEND_ADDR(CFG, 0x1c), 0x30); 35 36 mt76_wr(dev, MT_VEND_ADDR(CFG, 0x14), 0x484f); 37 udelay(1); 38 39 mt76_set(dev, MT_VEND_ADDR(CFG, 0x130), BIT(17)); 40 usleep_range(150, 200); 41 42 mt76_clear(dev, MT_VEND_ADDR(CFG, 0x130), BIT(16)); 43 usleep_range(50, 100); 44 45 mt76_set(dev, MT_VEND_ADDR(CFG, 0x14c), BIT(19) | BIT(20)); 46 } 47 48 static void mt76x2u_power_on_rf(struct mt76x02_dev *dev, int unit) 49 { 50 int shift = unit ? 8 : 0; 51 u32 val = (BIT(1) | BIT(3) | BIT(4) | BIT(5)) << shift; 52 53 /* Enable RF BG */ 54 mt76_set(dev, MT_VEND_ADDR(CFG, 0x130), BIT(0) << shift); 55 usleep_range(10, 20); 56 57 /* Enable RFDIG LDO/AFE/ABB/ADDA */ 58 mt76_set(dev, MT_VEND_ADDR(CFG, 0x130), val); 59 usleep_range(10, 20); 60 61 /* Switch RFDIG power to internal LDO */ 62 mt76_clear(dev, MT_VEND_ADDR(CFG, 0x130), BIT(2) << shift); 63 usleep_range(10, 20); 64 65 mt76x2u_power_on_rf_patch(dev); 66 67 mt76_set(dev, 0x530, 0xf); 68 } 69 70 static void mt76x2u_power_on(struct mt76x02_dev *dev) 71 { 72 u32 val; 73 74 /* Turn on WL MTCMOS */ 75 mt76_set(dev, MT_VEND_ADDR(CFG, 0x148), 76 MT_WLAN_MTC_CTRL_MTCMOS_PWR_UP); 77 78 val = MT_WLAN_MTC_CTRL_STATE_UP | 79 MT_WLAN_MTC_CTRL_PWR_ACK | 80 MT_WLAN_MTC_CTRL_PWR_ACK_S; 81 82 mt76_poll(dev, MT_VEND_ADDR(CFG, 0x148), val, val, 1000); 83 84 mt76_clear(dev, MT_VEND_ADDR(CFG, 0x148), 0x7f << 16); 85 usleep_range(10, 20); 86 87 mt76_clear(dev, MT_VEND_ADDR(CFG, 0x148), 0xf << 24); 88 usleep_range(10, 20); 89 90 mt76_set(dev, MT_VEND_ADDR(CFG, 0x148), 0xf << 24); 91 mt76_clear(dev, MT_VEND_ADDR(CFG, 0x148), 0xfff); 92 93 /* Turn on AD/DA power down */ 94 mt76_clear(dev, MT_VEND_ADDR(CFG, 0x1204), BIT(3)); 95 96 /* WLAN function enable */ 97 mt76_set(dev, MT_VEND_ADDR(CFG, 0x80), BIT(0)); 98 99 /* Release BBP software reset */ 100 mt76_clear(dev, MT_VEND_ADDR(CFG, 0x64), BIT(18)); 101 102 mt76x2u_power_on_rf(dev, 0); 103 mt76x2u_power_on_rf(dev, 1); 104 } 105 106 static int mt76x2u_init_eeprom(struct mt76x02_dev *dev) 107 { 108 u32 val, i; 109 110 dev->mt76.eeprom.data = devm_kzalloc(dev->mt76.dev, 111 MT7612U_EEPROM_SIZE, 112 GFP_KERNEL); 113 dev->mt76.eeprom.size = MT7612U_EEPROM_SIZE; 114 if (!dev->mt76.eeprom.data) 115 return -ENOMEM; 116 117 for (i = 0; i + 4 <= MT7612U_EEPROM_SIZE; i += 4) { 118 val = mt76_rr(dev, MT_VEND_ADDR(EEPROM, i)); 119 put_unaligned_le32(val, dev->mt76.eeprom.data + i); 120 } 121 122 mt76x02_eeprom_parse_hw_cap(dev); 123 return 0; 124 } 125 126 int mt76x2u_init_hardware(struct mt76x02_dev *dev) 127 { 128 int i, k, err; 129 130 mt76x2_reset_wlan(dev, true); 131 mt76x2u_power_on(dev); 132 133 if (!mt76x02_wait_for_mac(&dev->mt76)) 134 return -ETIMEDOUT; 135 136 err = mt76x2u_mcu_fw_init(dev); 137 if (err < 0) 138 return err; 139 140 if (!mt76_poll_msec(dev, MT_WPDMA_GLO_CFG, 141 MT_WPDMA_GLO_CFG_TX_DMA_BUSY | 142 MT_WPDMA_GLO_CFG_RX_DMA_BUSY, 0, 100)) 143 return -EIO; 144 145 /* wait for asic ready after fw load. */ 146 if (!mt76x02_wait_for_mac(&dev->mt76)) 147 return -ETIMEDOUT; 148 149 mt76x2u_init_dma(dev); 150 151 err = mt76x2u_mcu_init(dev); 152 if (err < 0) 153 return err; 154 155 err = mt76x2u_mac_reset(dev); 156 if (err < 0) 157 return err; 158 159 mt76x02_mac_setaddr(dev, dev->mt76.eeprom.data + MT_EE_MAC_ADDR); 160 dev->mt76.rxfilter = mt76_rr(dev, MT_RX_FILTR_CFG); 161 162 if (!mt76x02_wait_for_txrx_idle(&dev->mt76)) 163 return -ETIMEDOUT; 164 165 /* reset wcid table */ 166 for (i = 0; i < 256; i++) 167 mt76x02_mac_wcid_setup(dev, i, 0, NULL); 168 169 /* reset shared key table and pairwise key table */ 170 for (i = 0; i < 16; i++) { 171 for (k = 0; k < 4; k++) 172 mt76x02_mac_shared_key_setup(dev, i, k, NULL); 173 } 174 175 mt76x02u_init_beacon_config(dev); 176 177 mt76_rmw(dev, MT_US_CYC_CFG, MT_US_CYC_CNT, 0x1e); 178 mt76_wr(dev, MT_TXOP_CTRL_CFG, 0x583f); 179 180 err = mt76x2_mcu_load_cr(dev, MT_RF_BBP_CR, 0, 0); 181 if (err < 0) 182 return err; 183 184 mt76x02_phy_set_rxpath(dev); 185 mt76x02_phy_set_txdac(dev); 186 187 return mt76x2u_mac_stop(dev); 188 } 189 190 int mt76x2u_register_device(struct mt76x02_dev *dev) 191 { 192 struct ieee80211_hw *hw = mt76_hw(dev); 193 struct mt76_usb *usb = &dev->mt76.usb; 194 int err; 195 196 INIT_DELAYED_WORK(&dev->cal_work, mt76x2u_phy_calibrate); 197 mt76x02_init_device(dev); 198 199 err = mt76x2u_init_eeprom(dev); 200 if (err < 0) 201 return err; 202 203 usb->mcu.data = devm_kmalloc(dev->mt76.dev, MCU_RESP_URB_SIZE, 204 GFP_KERNEL); 205 if (!usb->mcu.data) 206 return -ENOMEM; 207 208 err = mt76u_alloc_queues(&dev->mt76); 209 if (err < 0) 210 goto fail; 211 212 err = mt76x2u_init_hardware(dev); 213 if (err < 0) 214 goto fail; 215 216 /* check hw sg support in order to enable AMSDU */ 217 hw->max_tx_fragments = dev->mt76.usb.sg_en ? MT_TX_SG_MAX_SIZE : 1; 218 err = mt76_register_device(&dev->mt76, true, mt76x02_rates, 219 ARRAY_SIZE(mt76x02_rates)); 220 if (err) 221 goto fail; 222 223 set_bit(MT76_STATE_INITIALIZED, &dev->mphy.state); 224 225 mt76x02_init_debugfs(dev); 226 mt76x2_init_txpower(dev, &dev->mphy.sband_2g.sband); 227 mt76x2_init_txpower(dev, &dev->mphy.sband_5g.sband); 228 229 return 0; 230 231 fail: 232 mt76x2u_cleanup(dev); 233 return err; 234 } 235 236 void mt76x2u_stop_hw(struct mt76x02_dev *dev) 237 { 238 cancel_delayed_work_sync(&dev->cal_work); 239 cancel_delayed_work_sync(&dev->mphy.mac_work); 240 mt76x2u_mac_stop(dev); 241 } 242 243 void mt76x2u_cleanup(struct mt76x02_dev *dev) 244 { 245 mt76x02_mcu_set_radio_state(dev, false); 246 mt76x2u_stop_hw(dev); 247 mt76u_queues_deinit(&dev->mt76); 248 } 249