ath9k_hw: Add support to reuse Carrier leak calibration

This patch adds support to reuse Carrier leak calibration
during fast channel change for AR9480 chips.

Signed-off-by: Rajkumar Manoharan <rmanohar@qca.qualcomm.com>
Signed-off-by: John W. Linville <linville@tuxdriver.com>

3 files changed, 50 insertions, 3 deletions

diff --git a/drivers/net/wireless/ath/ath9k/ar9003_calib.c b/drivers/net/wireless/ath/ath9k/ar9003_calib.c
index 6d685664f916..5f406382677e 100644
--- a/drivers/net/wireless/ath/ath9k/ar9003_calib.c
+++ b/drivers/net/wireless/ath/ath9k/ar9003_calib.c
@@ -905,8 +905,23 @@ static bool ar9003_hw_init_cal(struct ath_hw *ah,
 {
         struct ath_common *common = ath9k_hw_common(ah);
         struct ath9k_hw_cal_data *caldata = ah->caldata;
-        bool txiqcal_done = false;
-        bool is_reusable = true;
+        bool txiqcal_done = false, txclcal_done = false;
+        bool is_reusable = true, txclcal_enabled;
+        u32 cl_idx[AR9300_MAX_CHAINS] = { AR_PHY_CL_TAB_0,
+                                          AR_PHY_CL_TAB_1,
+                                          AR_PHY_CL_TAB_2 };
+
+        txclcal_enabled = !!(REG_READ(ah, AR_PHY_CL_CAL_CTL) &
+                                      AR_PHY_CL_CAL_ENABLE);
+
+        if (txclcal_enabled) {
+                if (caldata && caldata->done_txclcal_once)
+                        REG_CLR_BIT(ah, AR_PHY_CL_CAL_CTL,
+                                    AR_PHY_CL_CAL_ENABLE);
+                else
+                        REG_SET_BIT(ah, AR_PHY_CL_CAL_CTL,
+                                    AR_PHY_CL_CAL_ENABLE);
+        }
 
         /* Do Tx IQ Calibration */
         REG_RMW_FIELD(ah, AR_PHY_TX_IQCAL_CONTROL_1,
@@ -950,6 +965,33 @@ static bool ar9003_hw_init_cal(struct ath_hw *ah,
         else if (caldata && caldata->done_txiqcal_once)
                 ar9003_hw_tx_iq_cal_reload(ah);
 
+#define CL_TAB_ENTRY(reg_base)  (reg_base + (4 * j))
+        if (caldata && txclcal_enabled) {
+                int i, j;
+                txclcal_done = !!(REG_READ(ah, AR_PHY_AGC_CONTROL) &
+                                           AR_PHY_AGC_CONTROL_CLC_SUCCESS);
+                if (caldata->done_txclcal_once) {
+                        for (i = 0; i < AR9300_MAX_CHAINS; i++) {
+                                if (!(ah->txchainmask & (1 << i)))
+                                        continue;
+                                for (j = 0; j < MAX_CL_TAB_ENTRY; j++)
+                                        REG_WRITE(ah, CL_TAB_ENTRY(cl_idx[i]),
+                                                  caldata->tx_clcal[i][j]);
+                        }
+                } else if (is_reusable && txclcal_done) {
+                        for (i = 0; i < AR9300_MAX_CHAINS; i++) {
+                                if (!(ah->txchainmask & (1 << i)))
+                                        continue;
+                                for (j = 0; j < MAX_CL_TAB_ENTRY; j++)
+                                        caldata->tx_clcal[i][j] =
+                                                REG_READ(ah,
+                                                  CL_TAB_ENTRY(cl_idx[i]));
+                        }
+                        caldata->done_txclcal_once = true;
+                }
+        }
+#undef CL_TAB_ENTRY
+
         ath9k_hw_loadnf(ah, chan);
         ath9k_hw_start_nfcal(ah, true);
 
diff --git a/drivers/net/wireless/ath/ath9k/hw.c b/drivers/net/wireless/ath/ath9k/hw.c
index e51d93d33d5f..0aa05841b263 100644
--- a/drivers/net/wireless/ath/ath9k/hw.c
+++ b/drivers/net/wireless/ath/ath9k/hw.c
@@ -1707,8 +1707,10 @@ int ath9k_hw_reset(struct ath_hw *ah, struct ath9k_channel *chan,
 
         ath9k_hw_init_bb(ah, chan);
 
-        if (caldata)
+        if (caldata) {
                 caldata->done_txiqcal_once = false;
+                caldata->done_txclcal_once = false;
+        }
         if (!ath9k_hw_init_cal(ah, chan))
                 return -EIO;
 
diff --git a/drivers/net/wireless/ath/ath9k/hw.h b/drivers/net/wireless/ath/ath9k/hw.h
index e5c458d22c82..446f4d309bec 100644
--- a/drivers/net/wireless/ath/ath9k/hw.h
+++ b/drivers/net/wireless/ath/ath9k/hw.h
@@ -338,6 +338,7 @@ enum ath9k_int {
          CHANNEL_HT40MINUS)
 
 #define MAX_IQCAL_MEASUREMENT   8
+#define MAX_CL_TAB_ENTRY        16
 
 struct ath9k_hw_cal_data {
         u16 channel;
@@ -349,10 +350,12 @@ struct ath9k_hw_cal_data {
         bool nfcal_pending;
         bool nfcal_interference;
         bool done_txiqcal_once;
+        bool done_txclcal_once;
         u16 small_signal_gain[AR9300_MAX_CHAINS];
         u32 pa_table[AR9300_MAX_CHAINS][PAPRD_TABLE_SZ];
         u32 num_measures[AR9300_MAX_CHAINS];
         int tx_corr_coeff[MAX_IQCAL_MEASUREMENT][AR9300_MAX_CHAINS];
+        u32 tx_clcal[AR9300_MAX_CHAINS][MAX_CL_TAB_ENTRY];
         struct ath9k_nfcal_hist nfCalHist[NUM_NF_READINGS];
 };