1 // SPDX-License-Identifier: ISC 2 /* 3 * Copyright (C) 2016 Felix Fietkau <nbd@nbd.name> 4 */ 5 6 #include <linux/delay.h> 7 #include "mt76x2.h" 8 #include "eeprom.h" 9 #include "mcu.h" 10 #include "../mt76x02_mac.h" 11 12 static void 13 mt76x2_mac_pbf_init(struct mt76x02_dev *dev) 14 { 15 u32 val; 16 17 val = MT_PBF_SYS_CTRL_MCU_RESET | 18 MT_PBF_SYS_CTRL_DMA_RESET | 19 MT_PBF_SYS_CTRL_MAC_RESET | 20 MT_PBF_SYS_CTRL_PBF_RESET | 21 MT_PBF_SYS_CTRL_ASY_RESET; 22 23 mt76_set(dev, MT_PBF_SYS_CTRL, val); 24 mt76_clear(dev, MT_PBF_SYS_CTRL, val); 25 26 mt76_wr(dev, MT_PBF_TX_MAX_PCNT, 0xefef3f1f); 27 mt76_wr(dev, MT_PBF_RX_MAX_PCNT, 0xfebf); 28 } 29 30 static void 31 mt76x2_fixup_xtal(struct mt76x02_dev *dev) 32 { 33 u16 eep_val; 34 s8 offset = 0; 35 36 eep_val = mt76x02_eeprom_get(dev, MT_EE_XTAL_TRIM_2); 37 38 offset = eep_val & 0x7f; 39 if ((eep_val & 0xff) == 0xff) 40 offset = 0; 41 else if (eep_val & 0x80) 42 offset = 0 - offset; 43 44 eep_val >>= 8; 45 if (eep_val == 0x00 || eep_val == 0xff) { 46 eep_val = mt76x02_eeprom_get(dev, MT_EE_XTAL_TRIM_1); 47 eep_val &= 0xff; 48 49 if (eep_val == 0x00 || eep_val == 0xff) 50 eep_val = 0x14; 51 } 52 53 eep_val &= 0x7f; 54 mt76_rmw_field(dev, MT_XO_CTRL5, MT_XO_CTRL5_C2_VAL, eep_val + offset); 55 mt76_set(dev, MT_XO_CTRL6, MT_XO_CTRL6_C2_CTRL); 56 57 eep_val = mt76x02_eeprom_get(dev, MT_EE_NIC_CONF_2); 58 switch (FIELD_GET(MT_EE_NIC_CONF_2_XTAL_OPTION, eep_val)) { 59 case 0: 60 mt76_wr(dev, MT_XO_CTRL7, 0x5c1fee80); 61 break; 62 case 1: 63 mt76_wr(dev, MT_XO_CTRL7, 0x5c1feed0); 64 break; 65 default: 66 break; 67 } 68 } 69 70 int mt76x2_mac_reset(struct mt76x02_dev *dev, bool hard) 71 { 72 const u8 *macaddr = dev->mt76.macaddr; 73 u32 val; 74 int i, k; 75 76 if (!mt76x02_wait_for_mac(&dev->mt76)) 77 return -ETIMEDOUT; 78 79 val = mt76_rr(dev, MT_WPDMA_GLO_CFG); 80 81 val &= ~(MT_WPDMA_GLO_CFG_TX_DMA_EN | 82 MT_WPDMA_GLO_CFG_TX_DMA_BUSY | 83 MT_WPDMA_GLO_CFG_RX_DMA_EN | 84 MT_WPDMA_GLO_CFG_RX_DMA_BUSY | 85 MT_WPDMA_GLO_CFG_DMA_BURST_SIZE); 86 val |= FIELD_PREP(MT_WPDMA_GLO_CFG_DMA_BURST_SIZE, 3); 87 88 mt76_wr(dev, MT_WPDMA_GLO_CFG, val); 89 90 mt76x2_mac_pbf_init(dev); 91 mt76_write_mac_initvals(dev); 92 mt76x2_fixup_xtal(dev); 93 94 mt76_clear(dev, MT_MAC_SYS_CTRL, 95 MT_MAC_SYS_CTRL_RESET_CSR | 96 MT_MAC_SYS_CTRL_RESET_BBP); 97 98 if (is_mt7612(dev)) 99 mt76_clear(dev, MT_COEXCFG0, MT_COEXCFG0_COEX_EN); 100 101 mt76_set(dev, MT_EXT_CCA_CFG, 0x0000f000); 102 mt76_clear(dev, MT_TX_ALC_CFG_4, BIT(31)); 103 104 mt76_wr(dev, MT_RF_BYPASS_0, 0x06000000); 105 mt76_wr(dev, MT_RF_SETTING_0, 0x08800000); 106 usleep_range(5000, 10000); 107 mt76_wr(dev, MT_RF_BYPASS_0, 0x00000000); 108 109 mt76_wr(dev, MT_MCU_CLOCK_CTL, 0x1401); 110 mt76_clear(dev, MT_FCE_L2_STUFF, MT_FCE_L2_STUFF_WR_MPDU_LEN_EN); 111 112 mt76x02_mac_setaddr(dev, macaddr); 113 mt76x02e_init_beacon_config(dev); 114 if (!hard) 115 return 0; 116 117 for (i = 0; i < 256 / 32; i++) 118 mt76_wr(dev, MT_WCID_DROP_BASE + i * 4, 0); 119 120 for (i = 0; i < 256; i++) { 121 mt76x02_mac_wcid_setup(dev, i, 0, NULL); 122 mt76_wr(dev, MT_WCID_TX_RATE(i), 0); 123 mt76_wr(dev, MT_WCID_TX_RATE(i) + 4, 0); 124 } 125 126 for (i = 0; i < MT_MAX_VIFS; i++) 127 mt76x02_mac_wcid_setup(dev, MT_VIF_WCID(i), i, NULL); 128 129 for (i = 0; i < 16; i++) 130 for (k = 0; k < 4; k++) 131 mt76x02_mac_shared_key_setup(dev, i, k, NULL); 132 133 for (i = 0; i < 16; i++) 134 mt76_rr(dev, MT_TX_STAT_FIFO); 135 136 mt76x02_set_tx_ackto(dev); 137 138 return 0; 139 } 140 141 static void 142 mt76x2_power_on_rf_patch(struct mt76x02_dev *dev) 143 { 144 mt76_set(dev, 0x10130, BIT(0) | BIT(16)); 145 udelay(1); 146 147 mt76_clear(dev, 0x1001c, 0xff); 148 mt76_set(dev, 0x1001c, 0x30); 149 150 mt76_wr(dev, 0x10014, 0x484f); 151 udelay(1); 152 153 mt76_set(dev, 0x10130, BIT(17)); 154 udelay(125); 155 156 mt76_clear(dev, 0x10130, BIT(16)); 157 udelay(50); 158 159 mt76_set(dev, 0x1014c, BIT(19) | BIT(20)); 160 } 161 162 static void 163 mt76x2_power_on_rf(struct mt76x02_dev *dev, int unit) 164 { 165 int shift = unit ? 8 : 0; 166 167 /* Enable RF BG */ 168 mt76_set(dev, 0x10130, BIT(0) << shift); 169 udelay(10); 170 171 /* Enable RFDIG LDO/AFE/ABB/ADDA */ 172 mt76_set(dev, 0x10130, (BIT(1) | BIT(3) | BIT(4) | BIT(5)) << shift); 173 udelay(10); 174 175 /* Switch RFDIG power to internal LDO */ 176 mt76_clear(dev, 0x10130, BIT(2) << shift); 177 udelay(10); 178 179 mt76x2_power_on_rf_patch(dev); 180 181 mt76_set(dev, 0x530, 0xf); 182 } 183 184 static void 185 mt76x2_power_on(struct mt76x02_dev *dev) 186 { 187 u32 val; 188 189 /* Turn on WL MTCMOS */ 190 mt76_set(dev, MT_WLAN_MTC_CTRL, MT_WLAN_MTC_CTRL_MTCMOS_PWR_UP); 191 192 val = MT_WLAN_MTC_CTRL_STATE_UP | 193 MT_WLAN_MTC_CTRL_PWR_ACK | 194 MT_WLAN_MTC_CTRL_PWR_ACK_S; 195 196 mt76_poll(dev, MT_WLAN_MTC_CTRL, val, val, 1000); 197 198 mt76_clear(dev, MT_WLAN_MTC_CTRL, 0x7f << 16); 199 udelay(10); 200 201 mt76_clear(dev, MT_WLAN_MTC_CTRL, 0xf << 24); 202 udelay(10); 203 204 mt76_set(dev, MT_WLAN_MTC_CTRL, 0xf << 24); 205 mt76_clear(dev, MT_WLAN_MTC_CTRL, 0xfff); 206 207 /* Turn on AD/DA power down */ 208 mt76_clear(dev, 0x11204, BIT(3)); 209 210 /* WLAN function enable */ 211 mt76_set(dev, 0x10080, BIT(0)); 212 213 /* Release BBP software reset */ 214 mt76_clear(dev, 0x10064, BIT(18)); 215 216 mt76x2_power_on_rf(dev, 0); 217 mt76x2_power_on_rf(dev, 1); 218 } 219 220 static int mt76x2_init_hardware(struct mt76x02_dev *dev) 221 { 222 int ret; 223 224 mt76x02_dma_disable(dev); 225 mt76x2_reset_wlan(dev, true); 226 mt76x2_power_on(dev); 227 228 ret = mt76x2_eeprom_init(dev); 229 if (ret) 230 return ret; 231 232 ret = mt76x2_mac_reset(dev, true); 233 if (ret) 234 return ret; 235 236 dev->mt76.rxfilter = mt76_rr(dev, MT_RX_FILTR_CFG); 237 238 ret = mt76x02_dma_init(dev); 239 if (ret) 240 return ret; 241 242 set_bit(MT76_STATE_INITIALIZED, &dev->mphy.state); 243 mt76x02_mac_start(dev); 244 245 ret = mt76x2_mcu_init(dev); 246 if (ret) 247 return ret; 248 249 mt76x2_mac_stop(dev, false); 250 251 return 0; 252 } 253 254 void mt76x2_stop_hardware(struct mt76x02_dev *dev) 255 { 256 cancel_delayed_work_sync(&dev->cal_work); 257 cancel_delayed_work_sync(&dev->mt76.mac_work); 258 cancel_delayed_work_sync(&dev->wdt_work); 259 mt76x02_mcu_set_radio_state(dev, false); 260 mt76x2_mac_stop(dev, false); 261 } 262 263 void mt76x2_cleanup(struct mt76x02_dev *dev) 264 { 265 tasklet_disable(&dev->dfs_pd.dfs_tasklet); 266 tasklet_disable(&dev->mt76.pre_tbtt_tasklet); 267 mt76x2_stop_hardware(dev); 268 mt76x02_dma_cleanup(dev); 269 mt76x02_mcu_cleanup(dev); 270 } 271 272 int mt76x2_register_device(struct mt76x02_dev *dev) 273 { 274 int ret; 275 276 INIT_DELAYED_WORK(&dev->cal_work, mt76x2_phy_calibrate); 277 278 mt76x02_init_device(dev); 279 280 ret = mt76x2_init_hardware(dev); 281 if (ret) 282 return ret; 283 284 mt76x02_config_mac_addr_list(dev); 285 286 ret = mt76_register_device(&dev->mt76, true, mt76x02_rates, 287 ARRAY_SIZE(mt76x02_rates)); 288 if (ret) 289 goto fail; 290 291 mt76x02_init_debugfs(dev); 292 mt76x2_init_txpower(dev, &dev->mphy.sband_2g.sband); 293 mt76x2_init_txpower(dev, &dev->mphy.sband_5g.sband); 294 295 return 0; 296 297 fail: 298 mt76x2_stop_hardware(dev); 299 return ret; 300 } 301 302