gpio: rcar: Fix runtime PM imbalance on error
[linux/fpc-iii.git] / drivers / net / wireless / ath / ath9k / ar9003_rtt.c
blobe4d11fa7fe8ce8d6d9a8191928cde773210dec2a
1 /*
2 * Copyright (c) 2010-2011 Atheros Communications Inc.
4 * Permission to use, copy, modify, and/or distribute this software for any
5 * purpose with or without fee is hereby granted, provided that the above
6 * copyright notice and this permission notice appear in all copies.
8 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
11 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
13 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
14 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
17 #include "hw.h"
18 #include "hw-ops.h"
19 #include "ar9003_phy.h"
20 #include "ar9003_rtt.h"
22 #define RTT_RESTORE_TIMEOUT 1000
23 #define RTT_ACCESS_TIMEOUT 100
24 #define RTT_BAD_VALUE 0x0bad0bad
27 * RTT (Radio Retention Table) hardware implementation information
29 * There is an internal table (i.e. the rtt) for each chain (or bank).
30 * Each table contains 6 entries and each entry is corresponding to
31 * a specific calibration parameter as depicted below.
32 * 0~2 - DC offset DAC calibration: loop, low, high (offsetI/Q_...)
33 * 3 - Filter cal (filterfc)
34 * 4 - RX gain settings
35 * 5 - Peak detector offset calibration (agc_caldac)
38 void ar9003_hw_rtt_enable(struct ath_hw *ah)
40 REG_WRITE(ah, AR_PHY_RTT_CTRL, 1);
43 void ar9003_hw_rtt_disable(struct ath_hw *ah)
45 REG_WRITE(ah, AR_PHY_RTT_CTRL, 0);
48 void ar9003_hw_rtt_set_mask(struct ath_hw *ah, u32 rtt_mask)
50 REG_RMW_FIELD(ah, AR_PHY_RTT_CTRL,
51 AR_PHY_RTT_CTRL_RESTORE_MASK, rtt_mask);
54 bool ar9003_hw_rtt_force_restore(struct ath_hw *ah)
56 if (!ath9k_hw_wait(ah, AR_PHY_RTT_CTRL,
57 AR_PHY_RTT_CTRL_FORCE_RADIO_RESTORE,
58 0, RTT_RESTORE_TIMEOUT))
59 return false;
61 REG_RMW_FIELD(ah, AR_PHY_RTT_CTRL,
62 AR_PHY_RTT_CTRL_FORCE_RADIO_RESTORE, 1);
64 if (!ath9k_hw_wait(ah, AR_PHY_RTT_CTRL,
65 AR_PHY_RTT_CTRL_FORCE_RADIO_RESTORE,
66 0, RTT_RESTORE_TIMEOUT))
67 return false;
69 return true;
72 static void ar9003_hw_rtt_load_hist_entry(struct ath_hw *ah, u8 chain,
73 u32 index, u32 data28)
75 u32 val;
77 val = SM(data28, AR_PHY_RTT_SW_RTT_TABLE_DATA);
78 REG_WRITE(ah, AR_PHY_RTT_TABLE_SW_INTF_1_B(chain), val);
80 val = SM(0, AR_PHY_RTT_SW_RTT_TABLE_ACCESS) |
81 SM(1, AR_PHY_RTT_SW_RTT_TABLE_WRITE) |
82 SM(index, AR_PHY_RTT_SW_RTT_TABLE_ADDR);
83 REG_WRITE(ah, AR_PHY_RTT_TABLE_SW_INTF_B(chain), val);
84 udelay(1);
86 val |= SM(1, AR_PHY_RTT_SW_RTT_TABLE_ACCESS);
87 REG_WRITE(ah, AR_PHY_RTT_TABLE_SW_INTF_B(chain), val);
88 udelay(1);
90 if (!ath9k_hw_wait(ah, AR_PHY_RTT_TABLE_SW_INTF_B(chain),
91 AR_PHY_RTT_SW_RTT_TABLE_ACCESS, 0,
92 RTT_ACCESS_TIMEOUT))
93 return;
95 val &= ~SM(1, AR_PHY_RTT_SW_RTT_TABLE_WRITE);
96 REG_WRITE(ah, AR_PHY_RTT_TABLE_SW_INTF_B(chain), val);
97 udelay(1);
99 ath9k_hw_wait(ah, AR_PHY_RTT_TABLE_SW_INTF_B(chain),
100 AR_PHY_RTT_SW_RTT_TABLE_ACCESS, 0,
101 RTT_ACCESS_TIMEOUT);
104 void ar9003_hw_rtt_load_hist(struct ath_hw *ah)
106 int chain, i;
108 for (chain = 0; chain < AR9300_MAX_CHAINS; chain++) {
109 if (!(ah->caps.rx_chainmask & (1 << chain)))
110 continue;
111 for (i = 0; i < MAX_RTT_TABLE_ENTRY; i++) {
112 ar9003_hw_rtt_load_hist_entry(ah, chain, i,
113 ah->caldata->rtt_table[chain][i]);
114 ath_dbg(ath9k_hw_common(ah), CALIBRATE,
115 "Load RTT value at idx %d, chain %d: 0x%x\n",
116 i, chain, ah->caldata->rtt_table[chain][i]);
121 static void ar9003_hw_patch_rtt(struct ath_hw *ah, int index, int chain)
123 int agc, caldac;
125 if (!test_bit(SW_PKDET_DONE, &ah->caldata->cal_flags))
126 return;
128 if ((index != 5) || (chain >= 2))
129 return;
131 agc = REG_READ_FIELD(ah, AR_PHY_65NM_RXRF_AGC(chain),
132 AR_PHY_65NM_RXRF_AGC_AGC_OVERRIDE);
133 if (!agc)
134 return;
136 caldac = ah->caldata->caldac[chain];
137 ah->caldata->rtt_table[chain][index] &= 0xFFFF05FF;
138 caldac = (caldac & 0x20) | ((caldac & 0x1F) << 7);
139 ah->caldata->rtt_table[chain][index] |= (caldac << 4);
142 static int ar9003_hw_rtt_fill_hist_entry(struct ath_hw *ah, u8 chain, u32 index)
144 u32 val;
146 val = SM(0, AR_PHY_RTT_SW_RTT_TABLE_ACCESS) |
147 SM(0, AR_PHY_RTT_SW_RTT_TABLE_WRITE) |
148 SM(index, AR_PHY_RTT_SW_RTT_TABLE_ADDR);
150 REG_WRITE(ah, AR_PHY_RTT_TABLE_SW_INTF_B(chain), val);
151 udelay(1);
153 val |= SM(1, AR_PHY_RTT_SW_RTT_TABLE_ACCESS);
154 REG_WRITE(ah, AR_PHY_RTT_TABLE_SW_INTF_B(chain), val);
155 udelay(1);
157 if (!ath9k_hw_wait(ah, AR_PHY_RTT_TABLE_SW_INTF_B(chain),
158 AR_PHY_RTT_SW_RTT_TABLE_ACCESS, 0,
159 RTT_ACCESS_TIMEOUT))
160 return RTT_BAD_VALUE;
162 val = MS(REG_READ(ah, AR_PHY_RTT_TABLE_SW_INTF_1_B(chain)),
163 AR_PHY_RTT_SW_RTT_TABLE_DATA);
166 return val;
169 void ar9003_hw_rtt_fill_hist(struct ath_hw *ah)
171 int chain, i;
173 for (chain = 0; chain < AR9300_MAX_CHAINS; chain++) {
174 if (!(ah->caps.rx_chainmask & (1 << chain)))
175 continue;
176 for (i = 0; i < MAX_RTT_TABLE_ENTRY; i++) {
177 ah->caldata->rtt_table[chain][i] =
178 ar9003_hw_rtt_fill_hist_entry(ah, chain, i);
180 ar9003_hw_patch_rtt(ah, i, chain);
182 ath_dbg(ath9k_hw_common(ah), CALIBRATE,
183 "RTT value at idx %d, chain %d is: 0x%x\n",
184 i, chain, ah->caldata->rtt_table[chain][i]);
188 set_bit(RTT_DONE, &ah->caldata->cal_flags);
191 void ar9003_hw_rtt_clear_hist(struct ath_hw *ah)
193 int chain, i;
195 for (chain = 0; chain < AR9300_MAX_CHAINS; chain++) {
196 if (!(ah->caps.rx_chainmask & (1 << chain)))
197 continue;
198 for (i = 0; i < MAX_RTT_TABLE_ENTRY; i++)
199 ar9003_hw_rtt_load_hist_entry(ah, chain, i, 0);
202 if (ah->caldata)
203 clear_bit(RTT_DONE, &ah->caldata->cal_flags);
206 bool ar9003_hw_rtt_restore(struct ath_hw *ah, struct ath9k_channel *chan)
208 bool restore;
210 if (!ah->caldata)
211 return false;
213 if (test_bit(SW_PKDET_DONE, &ah->caldata->cal_flags)) {
214 if (IS_CHAN_2GHZ(chan)){
215 REG_RMW_FIELD(ah, AR_PHY_65NM_RXRF_AGC(0),
216 AR_PHY_65NM_RXRF_AGC_AGC2G_CALDAC_OVR,
217 ah->caldata->caldac[0]);
218 REG_RMW_FIELD(ah, AR_PHY_65NM_RXRF_AGC(1),
219 AR_PHY_65NM_RXRF_AGC_AGC2G_CALDAC_OVR,
220 ah->caldata->caldac[1]);
221 } else {
222 REG_RMW_FIELD(ah, AR_PHY_65NM_RXRF_AGC(0),
223 AR_PHY_65NM_RXRF_AGC_AGC5G_CALDAC_OVR,
224 ah->caldata->caldac[0]);
225 REG_RMW_FIELD(ah, AR_PHY_65NM_RXRF_AGC(1),
226 AR_PHY_65NM_RXRF_AGC_AGC5G_CALDAC_OVR,
227 ah->caldata->caldac[1]);
229 REG_RMW_FIELD(ah, AR_PHY_65NM_RXRF_AGC(1),
230 AR_PHY_65NM_RXRF_AGC_AGC_OVERRIDE, 0x1);
231 REG_RMW_FIELD(ah, AR_PHY_65NM_RXRF_AGC(0),
232 AR_PHY_65NM_RXRF_AGC_AGC_OVERRIDE, 0x1);
235 if (!test_bit(RTT_DONE, &ah->caldata->cal_flags))
236 return false;
238 ar9003_hw_rtt_enable(ah);
240 if (test_bit(SW_PKDET_DONE, &ah->caldata->cal_flags))
241 ar9003_hw_rtt_set_mask(ah, 0x30);
242 else
243 ar9003_hw_rtt_set_mask(ah, 0x10);
245 if (!ath9k_hw_rfbus_req(ah)) {
246 ath_err(ath9k_hw_common(ah), "Could not stop baseband\n");
247 restore = false;
248 goto fail;
251 ar9003_hw_rtt_load_hist(ah);
252 restore = ar9003_hw_rtt_force_restore(ah);
254 fail:
255 ath9k_hw_rfbus_done(ah);
256 ar9003_hw_rtt_disable(ah);
257 return restore;