4606a26c0c
ED/CCA needs to be disable before stopping the MAC to avoid hangs from tx being blocked. It must only be enabled again after the MAC has been started again. In many places this wasn't done properly, so fix this by always clearing the relevant ED/CCA bits in mt76x2_mac_stop and set it up again after channel change or calibration is done Signed-off-by: Felix Fietkau <nbd@nbd.name>
317 lines
8.3 KiB
C
317 lines
8.3 KiB
C
/*
|
|
* Copyright (C) 2016 Felix Fietkau <nbd@nbd.name>
|
|
*
|
|
* Permission to use, copy, modify, and/or distribute this software for any
|
|
* purpose with or without fee is hereby granted, provided that the above
|
|
* copyright notice and this permission notice appear in all copies.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
|
|
* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
|
|
* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
|
|
* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
|
|
* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
|
|
* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
|
|
* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
|
|
*/
|
|
|
|
#include <linux/delay.h>
|
|
#include "mt76x2.h"
|
|
#include "mcu.h"
|
|
#include "eeprom.h"
|
|
#include "../mt76x02_phy.h"
|
|
|
|
static bool
|
|
mt76x2_phy_tssi_init_cal(struct mt76x02_dev *dev)
|
|
{
|
|
struct ieee80211_channel *chan = dev->mt76.chandef.chan;
|
|
u32 flag = 0;
|
|
|
|
if (!mt76x2_tssi_enabled(dev))
|
|
return false;
|
|
|
|
if (mt76x2_channel_silent(dev))
|
|
return false;
|
|
|
|
if (chan->band == NL80211_BAND_5GHZ)
|
|
flag |= BIT(0);
|
|
|
|
if (mt76x02_ext_pa_enabled(dev, chan->band))
|
|
flag |= BIT(8);
|
|
|
|
mt76x02_mcu_calibrate(dev, MCU_CAL_TSSI, flag);
|
|
dev->cal.tssi_cal_done = true;
|
|
return true;
|
|
}
|
|
|
|
static void
|
|
mt76x2_phy_channel_calibrate(struct mt76x02_dev *dev, bool mac_stopped)
|
|
{
|
|
struct ieee80211_channel *chan = dev->mt76.chandef.chan;
|
|
bool is_5ghz = chan->band == NL80211_BAND_5GHZ;
|
|
|
|
if (dev->cal.channel_cal_done)
|
|
return;
|
|
|
|
if (mt76x2_channel_silent(dev))
|
|
return;
|
|
|
|
if (!dev->cal.tssi_cal_done)
|
|
mt76x2_phy_tssi_init_cal(dev);
|
|
|
|
if (!mac_stopped)
|
|
mt76x2_mac_stop(dev, false);
|
|
|
|
if (is_5ghz)
|
|
mt76x02_mcu_calibrate(dev, MCU_CAL_LC, 0);
|
|
|
|
mt76x02_mcu_calibrate(dev, MCU_CAL_TX_LOFT, is_5ghz);
|
|
mt76x02_mcu_calibrate(dev, MCU_CAL_TXIQ, is_5ghz);
|
|
mt76x02_mcu_calibrate(dev, MCU_CAL_RXIQC_FI, is_5ghz);
|
|
mt76x02_mcu_calibrate(dev, MCU_CAL_TEMP_SENSOR, 0);
|
|
mt76x02_mcu_calibrate(dev, MCU_CAL_TX_SHAPING, 0);
|
|
|
|
if (!mac_stopped)
|
|
mt76x2_mac_resume(dev);
|
|
|
|
mt76x2_apply_gain_adj(dev);
|
|
mt76x02_edcca_init(dev, true);
|
|
|
|
dev->cal.channel_cal_done = true;
|
|
}
|
|
|
|
void mt76x2_phy_set_antenna(struct mt76x02_dev *dev)
|
|
{
|
|
u32 val;
|
|
|
|
val = mt76_rr(dev, MT_BBP(AGC, 0));
|
|
val &= ~(BIT(4) | BIT(1));
|
|
switch (dev->mt76.antenna_mask) {
|
|
case 1:
|
|
/* disable mac DAC control */
|
|
mt76_clear(dev, MT_BBP(IBI, 9), BIT(11));
|
|
mt76_clear(dev, MT_BBP(TXBE, 5), 3);
|
|
mt76_rmw_field(dev, MT_TX_PIN_CFG, MT_TX_PIN_CFG_TXANT, 0x3);
|
|
mt76_rmw_field(dev, MT_BBP(CORE, 32), GENMASK(21, 20), 2);
|
|
/* disable DAC 1 */
|
|
mt76_rmw_field(dev, MT_BBP(CORE, 33), GENMASK(12, 9), 4);
|
|
|
|
val &= ~(BIT(3) | BIT(0));
|
|
break;
|
|
case 2:
|
|
/* disable mac DAC control */
|
|
mt76_clear(dev, MT_BBP(IBI, 9), BIT(11));
|
|
mt76_rmw_field(dev, MT_BBP(TXBE, 5), 3, 1);
|
|
mt76_rmw_field(dev, MT_TX_PIN_CFG, MT_TX_PIN_CFG_TXANT, 0xc);
|
|
mt76_rmw_field(dev, MT_BBP(CORE, 32), GENMASK(21, 20), 1);
|
|
/* disable DAC 0 */
|
|
mt76_rmw_field(dev, MT_BBP(CORE, 33), GENMASK(12, 9), 1);
|
|
|
|
val &= ~BIT(3);
|
|
val |= BIT(0);
|
|
break;
|
|
case 3:
|
|
default:
|
|
/* enable mac DAC control */
|
|
mt76_set(dev, MT_BBP(IBI, 9), BIT(11));
|
|
mt76_set(dev, MT_BBP(TXBE, 5), 3);
|
|
mt76_rmw_field(dev, MT_TX_PIN_CFG, MT_TX_PIN_CFG_TXANT, 0xf);
|
|
mt76_clear(dev, MT_BBP(CORE, 32), GENMASK(21, 20));
|
|
mt76_clear(dev, MT_BBP(CORE, 33), GENMASK(12, 9));
|
|
|
|
val &= ~BIT(0);
|
|
val |= BIT(3);
|
|
break;
|
|
}
|
|
mt76_wr(dev, MT_BBP(AGC, 0), val);
|
|
}
|
|
|
|
int mt76x2_phy_set_channel(struct mt76x02_dev *dev,
|
|
struct cfg80211_chan_def *chandef)
|
|
{
|
|
struct ieee80211_channel *chan = chandef->chan;
|
|
bool scan = test_bit(MT76_SCANNING, &dev->mt76.state);
|
|
enum nl80211_band band = chan->band;
|
|
u8 channel;
|
|
|
|
u32 ext_cca_chan[4] = {
|
|
[0] = FIELD_PREP(MT_EXT_CCA_CFG_CCA0, 0) |
|
|
FIELD_PREP(MT_EXT_CCA_CFG_CCA1, 1) |
|
|
FIELD_PREP(MT_EXT_CCA_CFG_CCA2, 2) |
|
|
FIELD_PREP(MT_EXT_CCA_CFG_CCA3, 3) |
|
|
FIELD_PREP(MT_EXT_CCA_CFG_CCA_MASK, BIT(0)),
|
|
[1] = FIELD_PREP(MT_EXT_CCA_CFG_CCA0, 1) |
|
|
FIELD_PREP(MT_EXT_CCA_CFG_CCA1, 0) |
|
|
FIELD_PREP(MT_EXT_CCA_CFG_CCA2, 2) |
|
|
FIELD_PREP(MT_EXT_CCA_CFG_CCA3, 3) |
|
|
FIELD_PREP(MT_EXT_CCA_CFG_CCA_MASK, BIT(1)),
|
|
[2] = FIELD_PREP(MT_EXT_CCA_CFG_CCA0, 2) |
|
|
FIELD_PREP(MT_EXT_CCA_CFG_CCA1, 3) |
|
|
FIELD_PREP(MT_EXT_CCA_CFG_CCA2, 1) |
|
|
FIELD_PREP(MT_EXT_CCA_CFG_CCA3, 0) |
|
|
FIELD_PREP(MT_EXT_CCA_CFG_CCA_MASK, BIT(2)),
|
|
[3] = FIELD_PREP(MT_EXT_CCA_CFG_CCA0, 3) |
|
|
FIELD_PREP(MT_EXT_CCA_CFG_CCA1, 2) |
|
|
FIELD_PREP(MT_EXT_CCA_CFG_CCA2, 1) |
|
|
FIELD_PREP(MT_EXT_CCA_CFG_CCA3, 0) |
|
|
FIELD_PREP(MT_EXT_CCA_CFG_CCA_MASK, BIT(3)),
|
|
};
|
|
int ch_group_index;
|
|
u8 bw, bw_index;
|
|
int freq, freq1;
|
|
int ret;
|
|
|
|
dev->cal.channel_cal_done = false;
|
|
freq = chandef->chan->center_freq;
|
|
freq1 = chandef->center_freq1;
|
|
channel = chan->hw_value;
|
|
|
|
switch (chandef->width) {
|
|
case NL80211_CHAN_WIDTH_40:
|
|
bw = 1;
|
|
if (freq1 > freq) {
|
|
bw_index = 1;
|
|
ch_group_index = 0;
|
|
} else {
|
|
bw_index = 3;
|
|
ch_group_index = 1;
|
|
}
|
|
channel += 2 - ch_group_index * 4;
|
|
break;
|
|
case NL80211_CHAN_WIDTH_80:
|
|
ch_group_index = (freq - freq1 + 30) / 20;
|
|
if (WARN_ON(ch_group_index < 0 || ch_group_index > 3))
|
|
ch_group_index = 0;
|
|
bw = 2;
|
|
bw_index = ch_group_index;
|
|
channel += 6 - ch_group_index * 4;
|
|
break;
|
|
default:
|
|
bw = 0;
|
|
bw_index = 0;
|
|
ch_group_index = 0;
|
|
break;
|
|
}
|
|
|
|
mt76x2_read_rx_gain(dev);
|
|
mt76x2_phy_set_txpower_regs(dev, band);
|
|
mt76x2_configure_tx_delay(dev, band, bw);
|
|
mt76x2_phy_set_txpower(dev);
|
|
|
|
mt76x02_phy_set_band(dev, chan->band, ch_group_index & 1);
|
|
mt76x02_phy_set_bw(dev, chandef->width, ch_group_index);
|
|
|
|
mt76_rmw(dev, MT_EXT_CCA_CFG,
|
|
(MT_EXT_CCA_CFG_CCA0 |
|
|
MT_EXT_CCA_CFG_CCA1 |
|
|
MT_EXT_CCA_CFG_CCA2 |
|
|
MT_EXT_CCA_CFG_CCA3 |
|
|
MT_EXT_CCA_CFG_CCA_MASK),
|
|
ext_cca_chan[ch_group_index]);
|
|
|
|
ret = mt76x2_mcu_set_channel(dev, channel, bw, bw_index, scan);
|
|
if (ret)
|
|
return ret;
|
|
|
|
mt76x2_mcu_init_gain(dev, channel, dev->cal.rx.mcu_gain, true);
|
|
|
|
mt76x2_phy_set_antenna(dev);
|
|
|
|
/* Enable LDPC Rx */
|
|
if (mt76xx_rev(dev) >= MT76XX_REV_E3)
|
|
mt76_set(dev, MT_BBP(RXO, 13), BIT(10));
|
|
|
|
if (!dev->cal.init_cal_done) {
|
|
u8 val = mt76x02_eeprom_get(dev, MT_EE_BT_RCAL_RESULT);
|
|
|
|
if (val != 0xff)
|
|
mt76x02_mcu_calibrate(dev, MCU_CAL_R, 0);
|
|
}
|
|
|
|
mt76x02_mcu_calibrate(dev, MCU_CAL_RXDCOC, channel);
|
|
|
|
/* Rx LPF calibration */
|
|
if (!dev->cal.init_cal_done)
|
|
mt76x02_mcu_calibrate(dev, MCU_CAL_RC, 0);
|
|
|
|
dev->cal.init_cal_done = true;
|
|
|
|
mt76_wr(dev, MT_BBP(AGC, 61), 0xFF64A4E2);
|
|
mt76_wr(dev, MT_BBP(AGC, 7), 0x08081010);
|
|
mt76_wr(dev, MT_BBP(AGC, 11), 0x00000404);
|
|
mt76_wr(dev, MT_BBP(AGC, 2), 0x00007070);
|
|
mt76_wr(dev, MT_TXOP_CTRL_CFG, 0x04101B3F);
|
|
|
|
if (scan)
|
|
return 0;
|
|
|
|
mt76x2_phy_channel_calibrate(dev, true);
|
|
mt76x02_init_agc_gain(dev);
|
|
|
|
/* init default values for temp compensation */
|
|
if (mt76x2_tssi_enabled(dev)) {
|
|
mt76_rmw_field(dev, MT_TX_ALC_CFG_1, MT_TX_ALC_CFG_1_TEMP_COMP,
|
|
0x38);
|
|
mt76_rmw_field(dev, MT_TX_ALC_CFG_2, MT_TX_ALC_CFG_2_TEMP_COMP,
|
|
0x38);
|
|
}
|
|
|
|
ieee80211_queue_delayed_work(mt76_hw(dev), &dev->cal_work,
|
|
MT_CALIBRATE_INTERVAL);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void
|
|
mt76x2_phy_temp_compensate(struct mt76x02_dev *dev)
|
|
{
|
|
struct mt76x2_temp_comp t;
|
|
int temp, db_diff;
|
|
|
|
if (mt76x2_get_temp_comp(dev, &t))
|
|
return;
|
|
|
|
temp = mt76_get_field(dev, MT_TEMP_SENSOR, MT_TEMP_SENSOR_VAL);
|
|
temp -= t.temp_25_ref;
|
|
temp = (temp * 1789) / 1000 + 25;
|
|
dev->cal.temp = temp;
|
|
|
|
if (temp > 25)
|
|
db_diff = (temp - 25) / t.high_slope;
|
|
else
|
|
db_diff = (25 - temp) / t.low_slope;
|
|
|
|
db_diff = min(db_diff, t.upper_bound);
|
|
db_diff = max(db_diff, t.lower_bound);
|
|
|
|
mt76_rmw_field(dev, MT_TX_ALC_CFG_1, MT_TX_ALC_CFG_1_TEMP_COMP,
|
|
db_diff * 2);
|
|
mt76_rmw_field(dev, MT_TX_ALC_CFG_2, MT_TX_ALC_CFG_2_TEMP_COMP,
|
|
db_diff * 2);
|
|
}
|
|
|
|
void mt76x2_phy_calibrate(struct work_struct *work)
|
|
{
|
|
struct mt76x02_dev *dev;
|
|
|
|
dev = container_of(work, struct mt76x02_dev, cal_work.work);
|
|
mt76x2_phy_channel_calibrate(dev, false);
|
|
mt76x2_phy_tssi_compensate(dev);
|
|
mt76x2_phy_temp_compensate(dev);
|
|
mt76x2_phy_update_channel_gain(dev);
|
|
ieee80211_queue_delayed_work(mt76_hw(dev), &dev->cal_work,
|
|
MT_CALIBRATE_INTERVAL);
|
|
}
|
|
|
|
int mt76x2_phy_start(struct mt76x02_dev *dev)
|
|
{
|
|
int ret;
|
|
|
|
ret = mt76x02_mcu_set_radio_state(dev, true);
|
|
if (ret)
|
|
return ret;
|
|
|
|
mt76x2_mcu_load_cr(dev, MT_RF_BBP_CR, 0, 0);
|
|
|
|
return ret;
|
|
}
|