mirror of
https://github.com/hanwckf/immortalwrt-mt798x.git
synced 2025-01-10 19:12:33 +08:00
91c84e87c2
To do not brake HW restart we should keep initialization vectors data.
I assumed that on start the data is already initialized to zeros, but
that not true on some scenarios and we should clear it. So add
additional flag to check if we are under HW restart and clear IV's
data if we are not.
Patch fixes AP mode regression.
Patch pending on linux-wireless and imported from patchwork.
Fixes: 0b2c42ced21a ("mac80211: Update to version 5.2-rc7")
Signed-off-by: Daniel Golle <daniel@makrotopia.org>
90 lines
3.3 KiB
Diff
90 lines
3.3 KiB
Diff
--- a/drivers/net/wireless/ralink/rt2x00/rt2800lib.c
|
|
+++ b/drivers/net/wireless/ralink/rt2x00/rt2800lib.c
|
|
@@ -8426,6 +8426,58 @@ static void rt2800_init_rfcsr_5592(struc
|
|
rt2800_led_open_drain_enable(rt2x00dev);
|
|
}
|
|
|
|
+void rt2800_rf_self_txdc_cal(struct rt2x00_dev *rt2x00dev)
|
|
+{
|
|
+ u8 rfb5r1_org, rfb7r1_org, rfvalue;
|
|
+ u32 mac0518, mac051c, mac0528, mac052c;
|
|
+ u8 i;
|
|
+
|
|
+ rt2x00_info(rt2x00dev, "RF Tx self calibration start\n");
|
|
+ mac0518 = rt2800_register_read(rt2x00dev, RF_CONTROL0);
|
|
+ mac051c = rt2800_register_read(rt2x00dev, RF_BYPASS0);
|
|
+ mac0528 = rt2800_register_read(rt2x00dev, RF_CONTROL2);
|
|
+ mac052c = rt2800_register_read(rt2x00dev, RF_BYPASS2);
|
|
+
|
|
+ rt2800_register_write(rt2x00dev, RF_BYPASS0, 0x0);
|
|
+ rt2800_register_write(rt2x00dev, RF_BYPASS2, 0x0);
|
|
+
|
|
+ rt2800_register_write(rt2x00dev, RF_CONTROL0, 0xC);
|
|
+ rt2800_register_write(rt2x00dev, RF_BYPASS0, 0x3306);
|
|
+ rt2800_register_write(rt2x00dev, RF_CONTROL2, 0x3330);
|
|
+ rt2800_register_write(rt2x00dev, RF_BYPASS2, 0xfffff);
|
|
+ rfb5r1_org = rt2800_rfcsr_read_bank(rt2x00dev, 5, 1);
|
|
+ rfb7r1_org = rt2800_rfcsr_read_bank(rt2x00dev, 7, 1);
|
|
+
|
|
+ rt2800_rfcsr_write_bank(rt2x00dev, 5, 1, 0x4);
|
|
+ for (i = 0; i < 100; i = i + 1) {
|
|
+ udelay(50);
|
|
+ rfvalue = rt2800_rfcsr_read_bank(rt2x00dev, 5, 1);
|
|
+ if((rfvalue & 0x04) != 0x4)
|
|
+ break;
|
|
+ }
|
|
+ rt2800_rfcsr_write_bank(rt2x00dev, 5, 1, rfb5r1_org);
|
|
+
|
|
+ rt2800_rfcsr_write_bank(rt2x00dev, 7, 1, 0x4);
|
|
+ for (i = 0; i < 100; i = i + 1) {
|
|
+ udelay(50);
|
|
+ rfvalue = rt2800_rfcsr_read_bank(rt2x00dev, 7, 1);
|
|
+ if((rfvalue & 0x04) != 0x4)
|
|
+ break;
|
|
+ }
|
|
+ rt2800_rfcsr_write_bank(rt2x00dev, 7, 1, rfb7r1_org);
|
|
+
|
|
+ rt2800_register_write(rt2x00dev, RF_BYPASS0, 0x0);
|
|
+ rt2800_register_write(rt2x00dev, RF_BYPASS2, 0x0);
|
|
+ rt2800_register_write(rt2x00dev, RF_CONTROL0, mac0518);
|
|
+ rt2800_register_write(rt2x00dev, RF_BYPASS0, mac051c);
|
|
+ rt2800_register_write(rt2x00dev, RF_CONTROL2, mac0528);
|
|
+ rt2800_register_write(rt2x00dev, RF_BYPASS2, mac052c);
|
|
+
|
|
+ rt2x00_info(rt2x00dev, "RF Tx self calibration end\n");
|
|
+
|
|
+}
|
|
+EXPORT_SYMBOL_GPL(rt2800_rf_self_txdc_cal);
|
|
+
|
|
static void rt2800_bbp_core_soft_reset(struct rt2x00_dev *rt2x00dev,
|
|
bool set_bw, bool is_ht40)
|
|
{
|
|
@@ -9033,6 +9085,7 @@ static void rt2800_init_rfcsr_6352(struc
|
|
rt2800_rfcsr_write_dccal(rt2x00dev, 5, 0x00);
|
|
rt2800_rfcsr_write_dccal(rt2x00dev, 17, 0x7C);
|
|
|
|
+ rt2800_rf_self_txdc_cal(rt2x00dev);
|
|
rt2800_bw_filter_calibration(rt2x00dev, true);
|
|
rt2800_bw_filter_calibration(rt2x00dev, false);
|
|
}
|
|
--- a/drivers/net/wireless/ralink/rt2x00/rt2800lib.h
|
|
+++ b/drivers/net/wireless/ralink/rt2x00/rt2800lib.h
|
|
@@ -242,6 +242,7 @@ void rt2800_link_tuner(struct rt2x00_dev
|
|
const u32 count);
|
|
void rt2800_gain_calibration(struct rt2x00_dev *rt2x00dev);
|
|
void rt2800_vco_calibration(struct rt2x00_dev *rt2x00dev);
|
|
+void rt2800_rf_self_txdc_cal(struct rt2x00_dev *rt2x00dev);
|
|
|
|
int rt2800_enable_radio(struct rt2x00_dev *rt2x00dev);
|
|
void rt2800_disable_radio(struct rt2x00_dev *rt2x00dev);
|
|
--- a/drivers/net/wireless/ralink/rt2x00/rt2x00.h
|
|
+++ b/drivers/net/wireless/ralink/rt2x00/rt2x00.h
|
|
@@ -563,6 +563,7 @@ struct rt2x00lib_ops {
|
|
struct link_qual *qual, const u32 count);
|
|
void (*gain_calibration) (struct rt2x00_dev *rt2x00dev);
|
|
void (*vco_calibration) (struct rt2x00_dev *rt2x00dev);
|
|
+ void (*rf_self_txdc_cal) (struct rt2x00_dev *rt2x00dev);
|
|
|
|
/*
|
|
* Data queue handlers.
|