| 1 |
// SPDX-License-Identifier: GPL-2.0-only |
| 2 |
/* |
| 3 |
* (c) Copyright 2002-2010, Ralink Technology, Inc. |
| 4 |
* Copyright (C) 2014 Felix Fietkau <[email protected]> |
| 5 |
* Copyright (C) 2015 Jakub Kicinski <[email protected]> |
| 6 |
* Copyright (C) 2018 Stanislaw Gruszka <[email protected]> |
| 7 |
*/ |
| 8 |
|
| 9 |
#include "mt76x0.h" |
| 10 |
#include "eeprom.h" |
| 11 |
#include "mcu.h" |
| 12 |
#include "initvals.h" |
| 13 |
#include "initvals_init.h" |
| 14 |
#include "../mt76x02_phy.h" |
| 15 |
|
| 16 |
static void |
| 17 |
mt76x0_set_wlan_state(struct mt76x02_dev *dev, u32 val, bool enable) |
| 18 |
{ |
| 19 |
u32 mask = MT_CMB_CTRL_XTAL_RDY | MT_CMB_CTRL_PLL_LD; |
| 20 |
|
| 21 |
/* Note: we don't turn off WLAN_CLK because that makes the device |
| 22 |
* not respond properly on the probe path. |
| 23 |
* In case anyone (PSM?) wants to use this function we can |
| 24 |
* bring the clock stuff back and fixup the probe path. |
| 25 |
*/ |
| 26 |
|
| 27 |
if (enable) |
| 28 |
val |= (MT_WLAN_FUN_CTRL_WLAN_EN | |
| 29 |
MT_WLAN_FUN_CTRL_WLAN_CLK_EN); |
| 30 |
else |
| 31 |
val &= ~(MT_WLAN_FUN_CTRL_WLAN_EN); |
| 32 |
|
| 33 |
mt76_wr(dev, MT_WLAN_FUN_CTRL, val); |
| 34 |
udelay(20); |
| 35 |
|
| 36 |
/* Note: vendor driver tries to disable/enable wlan here and retry |
| 37 |
* but the code which does it is so buggy it must have never |
| 38 |
* triggered, so don't bother. |
| 39 |
*/ |
| 40 |
if (enable && !mt76_poll(dev, MT_CMB_CTRL, mask, mask, 2000)) |
| 41 |
dev_err(dev->mt76.dev, "PLL and XTAL check failed\n"); |
| 42 |
} |
| 43 |
|
| 44 |
void mt76x0_chip_onoff(struct mt76x02_dev *dev, bool enable, bool reset) |
| 45 |
{ |
| 46 |
u32 val; |
| 47 |
|
| 48 |
val = mt76_rr(dev, MT_WLAN_FUN_CTRL); |
| 49 |
|
| 50 |
if (reset) { |
| 51 |
val |= MT_WLAN_FUN_CTRL_GPIO_OUT_EN; |
| 52 |
val &= ~MT_WLAN_FUN_CTRL_FRC_WL_ANT_SEL; |
| 53 |
|
| 54 |
if (val & MT_WLAN_FUN_CTRL_WLAN_EN) { |
| 55 |
val |= (MT_WLAN_FUN_CTRL_WLAN_RESET | |
| 56 |
MT_WLAN_FUN_CTRL_WLAN_RESET_RF); |
| 57 |
mt76_wr(dev, MT_WLAN_FUN_CTRL, val); |
| 58 |
udelay(20); |
| 59 |
|
| 60 |
val &= ~(MT_WLAN_FUN_CTRL_WLAN_RESET | |
| 61 |
MT_WLAN_FUN_CTRL_WLAN_RESET_RF); |
| 62 |
} |
| 63 |
} |
| 64 |
|
| 65 |
mt76_wr(dev, MT_WLAN_FUN_CTRL, val); |
| 66 |
udelay(20); |
| 67 |
|
| 68 |
mt76x0_set_wlan_state(dev, val, enable); |
| 69 |
} |
| 70 |
EXPORT_SYMBOL_GPL(mt76x0_chip_onoff); |
| 71 |
|
| 72 |
static void mt76x0_reset_csr_bbp(struct mt76x02_dev *dev) |
| 73 |
{ |
| 74 |
mt76_wr(dev, MT_MAC_SYS_CTRL, |
| 75 |
MT_MAC_SYS_CTRL_RESET_CSR | |
| 76 |
MT_MAC_SYS_CTRL_RESET_BBP); |
| 77 |
msleep(200); |
| 78 |
mt76_clear(dev, MT_MAC_SYS_CTRL, |
| 79 |
MT_MAC_SYS_CTRL_RESET_CSR | |
| 80 |
MT_MAC_SYS_CTRL_RESET_BBP); |
| 81 |
} |
| 82 |
|
| 83 |
#define RANDOM_WRITE(dev, tab) \ |
| 84 |
mt76_wr_rp(dev, MT_MCU_MEMMAP_WLAN, \ |
| 85 |
tab, ARRAY_SIZE(tab)) |
| 86 |
|
| 87 |
static int mt76x0_init_bbp(struct mt76x02_dev *dev) |
| 88 |
{ |
| 89 |
int ret, i; |
| 90 |
|
| 91 |
ret = mt76x0_phy_wait_bbp_ready(dev); |
| 92 |
if (ret) |
| 93 |
return ret; |
| 94 |
|
| 95 |
RANDOM_WRITE(dev, mt76x0_bbp_init_tab); |
| 96 |
|
| 97 |
for (i = 0; i < ARRAY_SIZE(mt76x0_bbp_switch_tab); i++) { |
| 98 |
const struct mt76x0_bbp_switch_item *item = &mt76x0_bbp_switch_tab[i]; |
| 99 |
const struct mt76_reg_pair *pair = &item->reg_pair; |
| 100 |
|
| 101 |
if (((RF_G_BAND | RF_BW_20) & item->bw_band) == (RF_G_BAND | RF_BW_20)) |
| 102 |
mt76_wr(dev, pair->reg, pair->value); |
| 103 |
} |
| 104 |
|
| 105 |
RANDOM_WRITE(dev, mt76x0_dcoc_tab); |
| 106 |
|
| 107 |
return 0; |
| 108 |
} |
| 109 |
|
| 110 |
static void mt76x0_init_mac_registers(struct mt76x02_dev *dev) |
| 111 |
{ |
| 112 |
RANDOM_WRITE(dev, common_mac_reg_table); |
| 113 |
|
| 114 |
/* Enable PBF and MAC clock SYS_CTRL[11:10] = 0x3 */ |
| 115 |
RANDOM_WRITE(dev, mt76x0_mac_reg_table); |
| 116 |
|
| 117 |
/* Release BBP and MAC reset MAC_SYS_CTRL[1:0] = 0x0 */ |
| 118 |
mt76_clear(dev, MT_MAC_SYS_CTRL, 0x3); |
| 119 |
|
| 120 |
/* Set 0x141C[15:12]=0xF */ |
| 121 |
mt76_set(dev, MT_EXT_CCA_CFG, 0xf000); |
| 122 |
|
| 123 |
mt76_clear(dev, MT_FCE_L2_STUFF, MT_FCE_L2_STUFF_WR_MPDU_LEN_EN); |
| 124 |
|
| 125 |
/* |
| 126 |
* tx_ring 9 is for mgmt frame |
| 127 |
* tx_ring 8 is for in-band command frame. |
| 128 |
* WMM_RG0_TXQMA: this register setting is for FCE to |
| 129 |
* define the rule of tx_ring 9 |
| 130 |
* WMM_RG1_TXQMA: this register setting is for FCE to |
| 131 |
* define the rule of tx_ring 8 |
| 132 |
*/ |
| 133 |
mt76_rmw(dev, MT_WMM_CTRL, 0x3ff, 0x201); |
| 134 |
} |
| 135 |
|
| 136 |
void mt76x0_mac_stop(struct mt76x02_dev *dev) |
| 137 |
{ |
| 138 |
int i = 200, ok = 0; |
| 139 |
|
| 140 |
mt76_clear(dev, MT_TXOP_CTRL_CFG, MT_TXOP_ED_CCA_EN); |
| 141 |
|
| 142 |
/* Page count on TxQ */ |
| 143 |
while (i-- && ((mt76_rr(dev, 0x0438) & 0xffffffff) || |
| 144 |
(mt76_rr(dev, 0x0a30) & 0x000000ff) || |
| 145 |
(mt76_rr(dev, 0x0a34) & 0x00ff00ff))) |
| 146 |
msleep(10); |
| 147 |
|
| 148 |
if (!mt76_poll(dev, MT_MAC_STATUS, MT_MAC_STATUS_TX, 0, 1000)) |
| 149 |
dev_warn(dev->mt76.dev, "Warning: MAC TX did not stop!\n"); |
| 150 |
|
| 151 |
mt76_clear(dev, MT_MAC_SYS_CTRL, MT_MAC_SYS_CTRL_ENABLE_RX | |
| 152 |
MT_MAC_SYS_CTRL_ENABLE_TX); |
| 153 |
|
| 154 |
/* Page count on RxQ */ |
| 155 |
for (i = 0; i < 200; i++) { |
| 156 |
if (!(mt76_rr(dev, MT_RXQ_STA) & 0x00ff0000) && |
| 157 |
!mt76_rr(dev, 0x0a30) && |
| 158 |
!mt76_rr(dev, 0x0a34)) { |
| 159 |
if (ok++ > 5) |
| 160 |
break; |
| 161 |
continue; |
| 162 |
} |
| 163 |
msleep(1); |
| 164 |
} |
| 165 |
|
| 166 |
if (!mt76_poll(dev, MT_MAC_STATUS, MT_MAC_STATUS_RX, 0, 1000)) |
| 167 |
dev_warn(dev->mt76.dev, "Warning: MAC RX did not stop!\n"); |
| 168 |
} |
| 169 |
EXPORT_SYMBOL_GPL(mt76x0_mac_stop); |
| 170 |
|
| 171 |
int mt76x0_init_hardware(struct mt76x02_dev *dev) |
| 172 |
{ |
| 173 |
int ret, i, k; |
| 174 |
|
| 175 |
if (!mt76x02_wait_for_wpdma(&dev->mt76, 1000)) |
| 176 |
return -EIO; |
| 177 |
|
| 178 |
/* Wait for ASIC ready after FW load. */ |
| 179 |
if (!mt76x02_wait_for_mac(&dev->mt76)) |
| 180 |
return -ETIMEDOUT; |
| 181 |
|
| 182 |
mt76x0_reset_csr_bbp(dev); |
| 183 |
ret = mt76x02_mcu_function_select(dev, Q_SELECT, 1); |
| 184 |
if (ret) |
| 185 |
return ret; |
| 186 |
|
| 187 |
mt76x0_init_mac_registers(dev); |
| 188 |
|
| 189 |
if (!mt76x02_wait_for_txrx_idle(&dev->mt76)) |
| 190 |
return -EIO; |
| 191 |
|
| 192 |
ret = mt76x0_init_bbp(dev); |
| 193 |
if (ret) |
| 194 |
return ret; |
| 195 |
|
| 196 |
dev->mt76.rxfilter = mt76_rr(dev, MT_RX_FILTR_CFG); |
| 197 |
|
| 198 |
for (i = 0; i < 16; i++) |
| 199 |
for (k = 0; k < 4; k++) |
| 200 |
mt76x02_mac_shared_key_setup(dev, i, k, NULL); |
| 201 |
|
| 202 |
for (i = 0; i < 256; i++) |
| 203 |
mt76x02_mac_wcid_setup(dev, i, 0, NULL); |
| 204 |
|
| 205 |
ret = mt76x0_eeprom_init(dev); |
| 206 |
if (ret) |
| 207 |
return ret; |
| 208 |
|
| 209 |
mt76x0_phy_init(dev); |
| 210 |
|
| 211 |
return 0; |
| 212 |
} |
| 213 |
EXPORT_SYMBOL_GPL(mt76x0_init_hardware); |
| 214 |
|
| 215 |
static void |
| 216 |
mt76x0_init_txpower(struct mt76x02_dev *dev, |
| 217 |
struct ieee80211_supported_band *sband) |
| 218 |
{ |
| 219 |
struct ieee80211_channel *chan; |
| 220 |
struct mt76x02_rate_power t; |
| 221 |
s8 tp; |
| 222 |
int i; |
| 223 |
|
| 224 |
for (i = 0; i < sband->n_channels; i++) { |
| 225 |
chan = &sband->channels[i]; |
| 226 |
|
| 227 |
mt76x0_get_tx_power_per_rate(dev, chan, &t); |
| 228 |
mt76x0_get_power_info(dev, chan, &tp); |
| 229 |
|
| 230 |
chan->orig_mpwr = (mt76x02_get_max_rate_power(&t) + tp) / 2; |
| 231 |
chan->max_power = min_t(int, chan->max_reg_power, |
| 232 |
chan->orig_mpwr); |
| 233 |
} |
| 234 |
} |
| 235 |
|
| 236 |
int mt76x0_register_device(struct mt76x02_dev *dev) |
| 237 |
{ |
| 238 |
int ret; |
| 239 |
|
| 240 |
ret = mt76x02_init_device(dev); |
| 241 |
if (ret) |
| 242 |
return ret; |
| 243 |
|
| 244 |
mt76x02_config_mac_addr_list(dev); |
| 245 |
|
| 246 |
ret = mt76_register_device(&dev->mt76, true, mt76x02_rates, |
| 247 |
ARRAY_SIZE(mt76x02_rates)); |
| 248 |
if (ret) |
| 249 |
return ret; |
| 250 |
|
| 251 |
if (dev->mphy.cap.has_5ghz) { |
| 252 |
struct ieee80211_supported_band *sband; |
| 253 |
|
| 254 |
sband = &dev->mphy.sband_5g.sband; |
| 255 |
sband->vht_cap.cap &= ~IEEE80211_VHT_CAP_RXLDPC; |
| 256 |
mt76x0_init_txpower(dev, sband); |
| 257 |
} |
| 258 |
|
| 259 |
if (dev->mphy.cap.has_2ghz) |
| 260 |
mt76x0_init_txpower(dev, &dev->mphy.sband_2g.sband); |
| 261 |
|
| 262 |
mt76x02_init_debugfs(dev); |
| 263 |
|
| 264 |
return 0; |
| 265 |
} |
| 266 |
EXPORT_SYMBOL_GPL(mt76x0_register_device); |