blob: b9f35313c7ab5b90826439beaefc43a7cbdcc91d [file] [log] [blame]
Jerry Chuang8fc85982009-11-03 07:17:11 -02001#include "r8192U.h"
2#include "r8192U_hw.h"
3#include "r819xU_phy.h"
4#include "r819xU_phyreg.h"
5#include "r8190_rtl8256.h"
6#include "r8192U_dm.h"
7#include "r819xU_firmware_img.h"
8
Jerry Chuang8fc85982009-11-03 07:17:11 -02009#include "dot11d.h"
Xenia Ragiadakou391c72a2013-06-15 07:29:01 +030010#include <linux/bitops.h>
11
Jerry Chuang8fc85982009-11-03 07:17:11 -020012static u32 RF_CHANNEL_TABLE_ZEBRA[] = {
13 0,
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +030014 0x085c, /* 2412 1 */
15 0x08dc, /* 2417 2 */
16 0x095c, /* 2422 3 */
17 0x09dc, /* 2427 4 */
18 0x0a5c, /* 2432 5 */
19 0x0adc, /* 2437 6 */
20 0x0b5c, /* 2442 7 */
21 0x0bdc, /* 2447 8 */
22 0x0c5c, /* 2452 9 */
23 0x0cdc, /* 2457 10 */
24 0x0d5c, /* 2462 11 */
25 0x0ddc, /* 2467 12 */
26 0x0e5c, /* 2472 13 */
27 0x0f72, /* 2484 */
Jerry Chuang8fc85982009-11-03 07:17:11 -020028};
29
30
31#define rtl819XPHY_REG_1T2RArray Rtl8192UsbPHY_REG_1T2RArray
32#define rtl819XMACPHY_Array_PG Rtl8192UsbMACPHY_Array_PG
33#define rtl819XMACPHY_Array Rtl8192UsbMACPHY_Array
34#define rtl819XRadioA_Array Rtl8192UsbRadioA_Array
35#define rtl819XRadioB_Array Rtl8192UsbRadioB_Array
36#define rtl819XRadioC_Array Rtl8192UsbRadioC_Array
37#define rtl819XRadioD_Array Rtl8192UsbRadioD_Array
38#define rtl819XAGCTAB_Array Rtl8192UsbAGCTAB_Array
39
40/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +030041 * function: This function reads BB parameters from header file we generate,
42 * and does register read/write
43 * input: u32 bitmask //taget bit pos in the addr to be modified
44 * output: none
45 * return: u32 return the shift bit position of the mask
46 ******************************************************************************/
Ana Reyc92f4732014-03-14 18:59:58 +010047static u32 rtl8192_CalculateBitShift(u32 bitmask)
Jerry Chuang8fc85982009-11-03 07:17:11 -020048{
49 u32 i;
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +030050
Xenia Ragiadakou9f66ddb2013-06-18 05:29:40 +030051 i = ffs(bitmask) - 1;
Jerry Chuang8fc85982009-11-03 07:17:11 -020052 return i;
53}
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +030054
Jerry Chuang8fc85982009-11-03 07:17:11 -020055/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +030056 * function: This function checks different RF type to execute legal judgement.
57 * If RF Path is illegal, we will return false.
58 * input: net_device *dev
59 * u32 eRFPath
60 * output: none
61 * return: 0(illegal, false), 1(legal, true)
62 *****************************************************************************/
Xenia Ragiadakou88d8fe22013-05-11 17:22:22 +030063u8 rtl8192_phy_CheckIsLegalRFPath(struct net_device *dev, u32 eRFPath)
Jerry Chuang8fc85982009-11-03 07:17:11 -020064{
65 u8 ret = 1;
66 struct r8192_priv *priv = ieee80211_priv(dev);
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +030067
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +030068 if (priv->rf_type == RF_2T4R) {
Jerry Chuang8fc85982009-11-03 07:17:11 -020069 ret = 0;
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +030070 } else if (priv->rf_type == RF_1T2R) {
Jerry Chuang8fc85982009-11-03 07:17:11 -020071 if (eRFPath == RF90_PATH_A || eRFPath == RF90_PATH_B)
72 ret = 1;
73 else if (eRFPath == RF90_PATH_C || eRFPath == RF90_PATH_D)
74 ret = 0;
75 }
76 return ret;
77}
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +030078
Jerry Chuang8fc85982009-11-03 07:17:11 -020079/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +030080 * function: This function sets specific bits to BB register
81 * input: net_device *dev
82 * u32 reg_addr //target addr to be modified
83 * u32 bitmask //taget bit pos to be modified
84 * u32 data //value to be write
85 * output: none
86 * return: none
87 * notice:
88 ******************************************************************************/
Xenia Ragiadakou79931632013-06-18 05:29:41 +030089void rtl8192_setBBreg(struct net_device *dev, u32 reg_addr, u32 bitmask,
90 u32 data)
Jerry Chuang8fc85982009-11-03 07:17:11 -020091{
92
Xenia Ragiadakou79931632013-06-18 05:29:41 +030093 u32 reg, bitshift;
Jerry Chuang8fc85982009-11-03 07:17:11 -020094
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +030095 if (bitmask != bMaskDWord) {
Xenia Ragiadakou79931632013-06-18 05:29:41 +030096 read_nic_dword(dev, reg_addr, &reg);
97 bitshift = rtl8192_CalculateBitShift(bitmask);
Xenia Ragiadakou9f66ddb2013-06-18 05:29:40 +030098 reg &= ~bitmask;
Xenia Ragiadakou79931632013-06-18 05:29:41 +030099 reg |= data << bitshift;
100 write_nic_dword(dev, reg_addr, reg);
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300101 } else {
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300102 write_nic_dword(dev, reg_addr, data);
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300103 }
Jerry Chuang8fc85982009-11-03 07:17:11 -0200104 return;
105}
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +0300106
Jerry Chuang8fc85982009-11-03 07:17:11 -0200107/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300108 * function: This function reads specific bits from BB register
109 * input: net_device *dev
110 * u32 reg_addr //target addr to be readback
111 * u32 bitmask //taget bit pos to be readback
112 * output: none
113 * return: u32 data //the readback register value
114 * notice:
115 ******************************************************************************/
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300116u32 rtl8192_QueryBBReg(struct net_device *dev, u32 reg_addr, u32 bitmask)
Jerry Chuang8fc85982009-11-03 07:17:11 -0200117{
Xenia Ragiadakouc4b5eb82013-06-19 04:58:05 +0300118 u32 reg, bitshift;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200119
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300120 read_nic_dword(dev, reg_addr, &reg);
121 bitshift = rtl8192_CalculateBitShift(bitmask);
Jerry Chuang8fc85982009-11-03 07:17:11 -0200122
Xenia Ragiadakouc4b5eb82013-06-19 04:58:05 +0300123 return (reg & bitmask) >> bitshift;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200124}
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +0300125
Xenia Ragiadakou442543d2013-06-15 07:29:08 +0300126static u32 phy_FwRFSerialRead(struct net_device *dev, RF90_RADIO_PATH_E eRFPath,
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300127 u32 offset);
Jerry Chuang8fc85982009-11-03 07:17:11 -0200128
Xenia Ragiadakou442543d2013-06-15 07:29:08 +0300129static void phy_FwRFSerialWrite(struct net_device *dev,
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300130 RF90_RADIO_PATH_E eRFPath, u32 offset,
131 u32 data);
Jerry Chuang8fc85982009-11-03 07:17:11 -0200132
133/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300134 * function: This function reads register from RF chip
135 * input: net_device *dev
136 * RF90_RADIO_PATH_E eRFPath //radio path of A/B/C/D
137 * u32 offset //target address to be read
138 * output: none
139 * return: u32 readback value
140 * notice: There are three types of serial operations:
141 * (1) Software serial write.
142 * (2)Hardware LSSI-Low Speed Serial Interface.
143 * (3)Hardware HSSI-High speed serial write.
144 * Driver here need to implement (1) and (2)
145 * ---need more spec for this information.
146 ******************************************************************************/
Ana Reyc92f4732014-03-14 18:59:58 +0100147static u32 rtl8192_phy_RFSerialRead(struct net_device *dev,
148 RF90_RADIO_PATH_E eRFPath, u32 offset)
Jerry Chuang8fc85982009-11-03 07:17:11 -0200149{
150 struct r8192_priv *priv = ieee80211_priv(dev);
151 u32 ret = 0;
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300152 u32 new_offset = 0;
Xenia Ragiadakou88d8fe22013-05-11 17:22:22 +0300153 BB_REGISTER_DEFINITION_T *pPhyReg = &priv->PHYRegDef[eRFPath];
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +0300154
Jerry Chuang8fc85982009-11-03 07:17:11 -0200155 rtl8192_setBBreg(dev, pPhyReg->rfLSSIReadBack, bLSSIReadBackData, 0);
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300156 /* Make sure RF register offset is correct */
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300157 offset &= 0x3f;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200158
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300159 /* Switch page for 8256 RF IC */
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300160 if (priv->rf_chip == RF_8256) {
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300161 if (offset >= 31) {
Jerry Chuang8fc85982009-11-03 07:17:11 -0200162 priv->RfReg0Value[eRFPath] |= 0x140;
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300163 /* Switch to Reg_Mode2 for Reg 31-45 */
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300164 rtl8192_setBBreg(dev, pPhyReg->rf3wireOffset,
165 bMaskDWord,
166 priv->RfReg0Value[eRFPath]<<16);
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300167 /* Modify offset */
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300168 new_offset = offset - 30;
169 } else if (offset >= 16) {
Jerry Chuang8fc85982009-11-03 07:17:11 -0200170 priv->RfReg0Value[eRFPath] |= 0x100;
171 priv->RfReg0Value[eRFPath] &= (~0x40);
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300172 /* Switch to Reg_Mode1 for Reg16-30 */
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300173 rtl8192_setBBreg(dev, pPhyReg->rf3wireOffset,
174 bMaskDWord,
175 priv->RfReg0Value[eRFPath]<<16);
Jerry Chuang8fc85982009-11-03 07:17:11 -0200176
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300177 new_offset = offset - 15;
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300178 } else {
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300179 new_offset = offset;
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300180 }
181 } else {
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300182 RT_TRACE((COMP_PHY|COMP_ERR),
183 "check RF type here, need to be 8256\n");
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300184 new_offset = offset;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200185 }
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300186 /* Put desired read addr to LSSI control Register */
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300187 rtl8192_setBBreg(dev, pPhyReg->rfHSSIPara2, bLSSIReadAddress,
188 new_offset);
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300189 /* Issue a posedge trigger */
Jerry Chuang8fc85982009-11-03 07:17:11 -0200190 rtl8192_setBBreg(dev, pPhyReg->rfHSSIPara2, bLSSIReadEdge, 0x0);
191 rtl8192_setBBreg(dev, pPhyReg->rfHSSIPara2, bLSSIReadEdge, 0x1);
192
193
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300194 /* TODO: we should not delay such a long time. Ask for help from SD3 */
Xenia Ragiadakou26f35612013-06-23 06:15:18 +0300195 usleep_range(1000, 1000);
Jerry Chuang8fc85982009-11-03 07:17:11 -0200196
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300197 ret = rtl8192_QueryBBReg(dev, pPhyReg->rfLSSIReadBack,
198 bLSSIReadBackData);
Jerry Chuang8fc85982009-11-03 07:17:11 -0200199
200
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300201 /* Switch back to Reg_Mode0 */
Xenia Ragiadakou1111b872013-06-15 07:29:04 +0300202 if (priv->rf_chip == RF_8256) {
Jerry Chuang8fc85982009-11-03 07:17:11 -0200203 priv->RfReg0Value[eRFPath] &= 0xebf;
204
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300205 rtl8192_setBBreg(dev, pPhyReg->rf3wireOffset, bMaskDWord,
206 priv->RfReg0Value[eRFPath] << 16);
Jerry Chuang8fc85982009-11-03 07:17:11 -0200207 }
208
209 return ret;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200210}
211
212/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300213 * function: This function writes data to RF register
214 * input: net_device *dev
215 * RF90_RADIO_PATH_E eRFPath //radio path of A/B/C/D
216 * u32 offset //target address to be written
217 * u32 data //the new register data to be written
218 * output: none
219 * return: none
220 * notice: For RF8256 only.
221 * ===========================================================================
222 * Reg Mode RegCTL[1] RegCTL[0] Note
Jerry Chuang8fc85982009-11-03 07:17:11 -0200223 * (Reg00[12]) (Reg00[10])
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300224 * ===========================================================================
225 * Reg_Mode0 0 x Reg 0 ~ 15(0x0 ~ 0xf)
226 * ---------------------------------------------------------------------------
227 * Reg_Mode1 1 0 Reg 16 ~ 30(0x1 ~ 0xf)
228 * ---------------------------------------------------------------------------
Jerry Chuang8fc85982009-11-03 07:17:11 -0200229 * Reg_Mode2 1 1 Reg 31 ~ 45(0x1 ~ 0xf)
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300230 * ---------------------------------------------------------------------------
231 *****************************************************************************/
Ana Reyc92f4732014-03-14 18:59:58 +0100232static void rtl8192_phy_RFSerialWrite(struct net_device *dev,
233 RF90_RADIO_PATH_E eRFPath, u32 offset,
234 u32 data)
Jerry Chuang8fc85982009-11-03 07:17:11 -0200235{
236 struct r8192_priv *priv = ieee80211_priv(dev);
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300237 u32 DataAndAddr = 0, new_offset = 0;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200238 BB_REGISTER_DEFINITION_T *pPhyReg = &priv->PHYRegDef[eRFPath];
239
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300240 offset &= 0x3f;
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300241 if (priv->rf_chip == RF_8256) {
Jerry Chuang8fc85982009-11-03 07:17:11 -0200242
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300243 if (offset >= 31) {
Jerry Chuang8fc85982009-11-03 07:17:11 -0200244 priv->RfReg0Value[eRFPath] |= 0x140;
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300245 rtl8192_setBBreg(dev, pPhyReg->rf3wireOffset,
246 bMaskDWord,
247 priv->RfReg0Value[eRFPath] << 16);
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300248 new_offset = offset - 30;
249 } else if (offset >= 16) {
Jerry Chuang8fc85982009-11-03 07:17:11 -0200250 priv->RfReg0Value[eRFPath] |= 0x100;
251 priv->RfReg0Value[eRFPath] &= (~0x40);
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300252 rtl8192_setBBreg(dev, pPhyReg->rf3wireOffset,
253 bMaskDWord,
254 priv->RfReg0Value[eRFPath]<<16);
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300255 new_offset = offset - 15;
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300256 } else {
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300257 new_offset = offset;
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300258 }
259 } else {
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300260 RT_TRACE((COMP_PHY|COMP_ERR),
261 "check RF type here, need to be 8256\n");
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300262 new_offset = offset;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200263 }
264
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300265 /* Put write addr in [5:0] and write data in [31:16] */
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300266 DataAndAddr = (data<<16) | (new_offset&0x3f);
Jerry Chuang8fc85982009-11-03 07:17:11 -0200267
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300268 /* Write operation */
Jerry Chuang8fc85982009-11-03 07:17:11 -0200269 rtl8192_setBBreg(dev, pPhyReg->rf3wireOffset, bMaskDWord, DataAndAddr);
270
271
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300272 if (offset == 0x0)
273 priv->RfReg0Value[eRFPath] = data;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200274
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300275 /* Switch back to Reg_Mode0 */
Xenia Ragiadakou1111b872013-06-15 07:29:04 +0300276 if (priv->rf_chip == RF_8256) {
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300277 if (offset != 0) {
Jerry Chuang8fc85982009-11-03 07:17:11 -0200278 priv->RfReg0Value[eRFPath] &= 0xebf;
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300279 rtl8192_setBBreg(dev, pPhyReg->rf3wireOffset,
280 bMaskDWord,
281 priv->RfReg0Value[eRFPath] << 16);
Jerry Chuang8fc85982009-11-03 07:17:11 -0200282 }
283 }
Jerry Chuang8fc85982009-11-03 07:17:11 -0200284 return;
285}
286
287/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300288 * function: This function set specific bits to RF register
289 * input: net_device dev
290 * RF90_RADIO_PATH_E eRFPath //radio path of A/B/C/D
291 * u32 reg_addr //target addr to be modified
292 * u32 bitmask //taget bit pos to be modified
293 * u32 data //value to be written
294 * output: none
295 * return: none
296 * notice:
297 *****************************************************************************/
Xenia Ragiadakou442543d2013-06-15 07:29:08 +0300298void rtl8192_phy_SetRFReg(struct net_device *dev, RF90_RADIO_PATH_E eRFPath,
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300299 u32 reg_addr, u32 bitmask, u32 data)
Jerry Chuang8fc85982009-11-03 07:17:11 -0200300{
301 struct r8192_priv *priv = ieee80211_priv(dev);
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300302 u32 reg, bitshift;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200303
304 if (!rtl8192_phy_CheckIsLegalRFPath(dev, eRFPath))
305 return;
306
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300307 if (priv->Rf_Mode == RF_OP_By_FW) {
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300308 if (bitmask != bMask12Bits) {
309 /* RF data is 12 bits only */
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300310 reg = phy_FwRFSerialRead(dev, eRFPath, reg_addr);
311 bitshift = rtl8192_CalculateBitShift(bitmask);
Xenia Ragiadakou9f66ddb2013-06-18 05:29:40 +0300312 reg &= ~bitmask;
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300313 reg |= data << bitshift;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200314
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300315 phy_FwRFSerialWrite(dev, eRFPath, reg_addr, reg);
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300316 } else {
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300317 phy_FwRFSerialWrite(dev, eRFPath, reg_addr, data);
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300318 }
Jerry Chuang8fc85982009-11-03 07:17:11 -0200319
320 udelay(200);
321
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300322 } else {
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300323 if (bitmask != bMask12Bits) {
324 /* RF data is 12 bits only */
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300325 reg = rtl8192_phy_RFSerialRead(dev, eRFPath, reg_addr);
326 bitshift = rtl8192_CalculateBitShift(bitmask);
Xenia Ragiadakou9f66ddb2013-06-18 05:29:40 +0300327 reg &= ~bitmask;
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300328 reg |= data << bitshift;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200329
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300330 rtl8192_phy_RFSerialWrite(dev, eRFPath, reg_addr, reg);
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300331 } else {
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300332 rtl8192_phy_RFSerialWrite(dev, eRFPath, reg_addr, data);
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300333 }
Jerry Chuang8fc85982009-11-03 07:17:11 -0200334 }
335 return;
336}
337
338/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300339 * function: This function reads specific bits from RF register
340 * input: net_device *dev
341 * u32 reg_addr //target addr to be readback
342 * u32 bitmask //taget bit pos to be readback
343 * output: none
344 * return: u32 data //the readback register value
345 * notice:
346 *****************************************************************************/
Xenia Ragiadakou442543d2013-06-15 07:29:08 +0300347u32 rtl8192_phy_QueryRFReg(struct net_device *dev, RF90_RADIO_PATH_E eRFPath,
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300348 u32 reg_addr, u32 bitmask)
Jerry Chuang8fc85982009-11-03 07:17:11 -0200349{
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300350 u32 reg, bitshift;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200351 struct r8192_priv *priv = ieee80211_priv(dev);
352
353
354 if (!rtl8192_phy_CheckIsLegalRFPath(dev, eRFPath))
355 return 0;
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300356 if (priv->Rf_Mode == RF_OP_By_FW) {
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300357 reg = phy_FwRFSerialRead(dev, eRFPath, reg_addr);
358 bitshift = rtl8192_CalculateBitShift(bitmask);
359 reg = (reg & bitmask) >> bitshift;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200360 udelay(200);
Xenia Ragiadakou07ecbbf2013-06-18 05:29:39 +0300361 return reg;
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300362 } else {
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300363 reg = rtl8192_phy_RFSerialRead(dev, eRFPath, reg_addr);
364 bitshift = rtl8192_CalculateBitShift(bitmask);
365 reg = (reg & bitmask) >> bitshift;
Xenia Ragiadakou07ecbbf2013-06-18 05:29:39 +0300366 return reg;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200367 }
368}
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +0300369
Jerry Chuang8fc85982009-11-03 07:17:11 -0200370/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300371 * function: We support firmware to execute RF-R/W.
372 * input: net_device *dev
373 * RF90_RADIO_PATH_E eRFPath
374 * u32 offset
375 * output: none
376 * return: u32
377 * notice:
378 ****************************************************************************/
Xenia Ragiadakou442543d2013-06-15 07:29:08 +0300379static u32 phy_FwRFSerialRead(struct net_device *dev, RF90_RADIO_PATH_E eRFPath,
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300380 u32 offset)
Jerry Chuang8fc85982009-11-03 07:17:11 -0200381{
Xenia Ragiadakou07ecbbf2013-06-18 05:29:39 +0300382 u32 reg = 0;
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300383 u32 data = 0;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200384 u8 time = 0;
Xenia Ragiadakoub3d42bf2013-06-06 16:40:51 +0300385 u32 tmp;
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +0300386
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300387 /* Firmware RF Write control.
388 * We can not execute the scheme in the initial step.
389 * Otherwise, RF-R/W will waste much time.
390 * This is only for site survey. */
391 /* 1. Read operation need not insert data. bit 0-11 */
392 /* 2. Write RF register address. bit 12-19 */
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300393 data |= ((offset&0xFF)<<12);
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300394 /* 3. Write RF path. bit 20-21 */
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300395 data |= ((eRFPath&0x3)<<20);
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300396 /* 4. Set RF read indicator. bit 22=0 */
397 /* 5. Trigger Fw to operate the command. bit 31 */
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300398 data |= 0x80000000;
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300399 /* 6. We can not execute read operation if bit 31 is 1. */
Xenia Ragiadakoub3d42bf2013-06-06 16:40:51 +0300400 read_nic_dword(dev, QPNR, &tmp);
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300401 while (tmp & 0x80000000) {
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300402 /* If FW can not finish RF-R/W for more than ?? times.
403 We must reset FW. */
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300404 if (time++ < 100) {
Jerry Chuang8fc85982009-11-03 07:17:11 -0200405 udelay(10);
Xenia Ragiadakoub3d42bf2013-06-06 16:40:51 +0300406 read_nic_dword(dev, QPNR, &tmp);
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300407 } else {
Jerry Chuang8fc85982009-11-03 07:17:11 -0200408 break;
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300409 }
Jerry Chuang8fc85982009-11-03 07:17:11 -0200410 }
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300411 /* 7. Execute read operation. */
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300412 write_nic_dword(dev, QPNR, data);
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300413 /* 8. Check if firmware send back RF content. */
Xenia Ragiadakoub3d42bf2013-06-06 16:40:51 +0300414 read_nic_dword(dev, QPNR, &tmp);
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300415 while (tmp & 0x80000000) {
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300416 /* If FW can not finish RF-R/W for more than ?? times.
417 We must reset FW. */
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300418 if (time++ < 100) {
Jerry Chuang8fc85982009-11-03 07:17:11 -0200419 udelay(10);
Xenia Ragiadakoub3d42bf2013-06-06 16:40:51 +0300420 read_nic_dword(dev, QPNR, &tmp);
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300421 } else {
Xenia Ragiadakou4c8dd922013-06-15 07:29:03 +0300422 return 0;
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300423 }
Jerry Chuang8fc85982009-11-03 07:17:11 -0200424 }
Xenia Ragiadakou07ecbbf2013-06-18 05:29:39 +0300425 read_nic_dword(dev, RF_DATA, &reg);
Jerry Chuang8fc85982009-11-03 07:17:11 -0200426
Xenia Ragiadakou07ecbbf2013-06-18 05:29:39 +0300427 return reg;
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300428}
Jerry Chuang8fc85982009-11-03 07:17:11 -0200429
430/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300431 * function: We support firmware to execute RF-R/W.
432 * input: net_device *dev
433 * RF90_RADIO_PATH_E eRFPath
434 * u32 offset
435 * u32 data
436 * output: none
437 * return: none
438 * notice:
439 ****************************************************************************/
Xenia Ragiadakou442543d2013-06-15 07:29:08 +0300440static void phy_FwRFSerialWrite(struct net_device *dev,
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300441 RF90_RADIO_PATH_E eRFPath, u32 offset, u32 data)
Jerry Chuang8fc85982009-11-03 07:17:11 -0200442{
443 u8 time = 0;
Xenia Ragiadakoub3d42bf2013-06-06 16:40:51 +0300444 u32 tmp;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200445
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300446 /* Firmware RF Write control.
447 * We can not execute the scheme in the initial step.
448 * Otherwise, RF-R/W will waste much time.
449 * This is only for site survey. */
Jerry Chuang8fc85982009-11-03 07:17:11 -0200450
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300451 /* 1. Set driver write bit and 12 bit data. bit 0-11 */
452 /* 2. Write RF register address. bit 12-19 */
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300453 data |= ((offset&0xFF)<<12);
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300454 /* 3. Write RF path. bit 20-21 */
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300455 data |= ((eRFPath&0x3)<<20);
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300456 /* 4. Set RF write indicator. bit 22=1 */
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300457 data |= 0x400000;
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300458 /* 5. Trigger Fw to operate the command. bit 31=1 */
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300459 data |= 0x80000000;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200460
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300461 /* 6. Write operation. We can not write if bit 31 is 1. */
Xenia Ragiadakoub3d42bf2013-06-06 16:40:51 +0300462 read_nic_dword(dev, QPNR, &tmp);
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300463 while (tmp & 0x80000000) {
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300464 /* If FW can not finish RF-R/W for more than ?? times.
465 We must reset FW. */
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300466 if (time++ < 100) {
Jerry Chuang8fc85982009-11-03 07:17:11 -0200467 udelay(10);
Xenia Ragiadakoub3d42bf2013-06-06 16:40:51 +0300468 read_nic_dword(dev, QPNR, &tmp);
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300469 } else {
Jerry Chuang8fc85982009-11-03 07:17:11 -0200470 break;
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300471 }
Jerry Chuang8fc85982009-11-03 07:17:11 -0200472 }
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300473 /* 7. No matter check bit. We always force the write.
474 Because FW will not accept the command. */
Xenia Ragiadakou79931632013-06-18 05:29:41 +0300475 write_nic_dword(dev, QPNR, data);
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300476 /* According to test, we must delay 20us to wait firmware
Jerry Chuang8fc85982009-11-03 07:17:11 -0200477 to finish RF write operation. */
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300478 /* We support delay in firmware side now. */
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300479}
Jerry Chuang8fc85982009-11-03 07:17:11 -0200480
Jerry Chuang8fc85982009-11-03 07:17:11 -0200481/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300482 * function: This function reads BB parameters from header file we generate,
483 * and do register read/write
484 * input: net_device *dev
485 * output: none
486 * return: none
487 * notice: BB parameters may change all the time, so please make
488 * sure it has been synced with the newest.
489 *****************************************************************************/
Xenia Ragiadakou88d8fe22013-05-11 17:22:22 +0300490void rtl8192_phy_configmac(struct net_device *dev)
Jerry Chuang8fc85982009-11-03 07:17:11 -0200491{
492 u32 dwArrayLen = 0, i;
Xenia Ragiadakou88d8fe22013-05-11 17:22:22 +0300493 u32 *pdwArray = NULL;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200494 struct r8192_priv *priv = ieee80211_priv(dev);
495
Xenia Ragiadakou1111b872013-06-15 07:29:04 +0300496 if (priv->btxpowerdata_readfromEEPORM) {
Jerry Chuang8fc85982009-11-03 07:17:11 -0200497 RT_TRACE(COMP_PHY, "Rtl819XMACPHY_Array_PG\n");
498 dwArrayLen = MACPHY_Array_PGLength;
499 pdwArray = rtl819XMACPHY_Array_PG;
500
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300501 } else {
Jerry Chuang8fc85982009-11-03 07:17:11 -0200502 RT_TRACE(COMP_PHY, "Rtl819XMACPHY_Array\n");
503 dwArrayLen = MACPHY_ArrayLength;
504 pdwArray = rtl819XMACPHY_Array;
505 }
Xenia Ragiadakou9d8e79e2013-06-18 05:29:38 +0300506 for (i = 0; i < dwArrayLen; i = i+3) {
Xenia Ragiadakou1111b872013-06-15 07:29:04 +0300507 if (pdwArray[i] == 0x318) {
Jerry Chuang8fc85982009-11-03 07:17:11 -0200508 pdwArray[i+2] = 0x00000800;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200509 }
510
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300511 RT_TRACE(COMP_DBG,
512 "Rtl8190MACPHY_Array[0]=%x Rtl8190MACPHY_Array[1]=%x Rtl8190MACPHY_Array[2]=%x\n",
513 pdwArray[i], pdwArray[i+1], pdwArray[i+2]);
514 rtl8192_setBBreg(dev, pdwArray[i], pdwArray[i+1],
515 pdwArray[i+2]);
Jerry Chuang8fc85982009-11-03 07:17:11 -0200516 }
517 return;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200518}
519
520/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300521 * function: This function does dirty work
522 * input: net_device *dev
523 * u8 ConfigType
524 * output: none
525 * return: none
526 * notice: BB parameters may change all the time, so please make
527 * sure it has been synced with the newest.
528 *****************************************************************************/
Xenia Ragiadakou88d8fe22013-05-11 17:22:22 +0300529void rtl8192_phyConfigBB(struct net_device *dev, u8 ConfigType)
Jerry Chuang8fc85982009-11-03 07:17:11 -0200530{
531 u32 i;
532
533#ifdef TO_DO_LIST
534 u32 *rtl8192PhyRegArrayTable = NULL, *rtl8192AgcTabArrayTable = NULL;
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +0300535
Xenia Ragiadakou1111b872013-06-15 07:29:04 +0300536 if (Adapter->bInHctTest) {
Jerry Chuang8fc85982009-11-03 07:17:11 -0200537 PHY_REGArrayLen = PHY_REGArrayLengthDTM;
538 AGCTAB_ArrayLen = AGCTAB_ArrayLengthDTM;
539 Rtl8190PHY_REGArray_Table = Rtl819XPHY_REGArrayDTM;
540 Rtl8190AGCTAB_Array_Table = Rtl819XAGCTAB_ArrayDTM;
541 }
542#endif
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300543 if (ConfigType == BaseBand_Config_PHY_REG) {
Xenia Ragiadakou9d8e79e2013-06-18 05:29:38 +0300544 for (i = 0; i < PHY_REG_1T2RArrayLength; i += 2) {
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300545 rtl8192_setBBreg(dev, rtl819XPHY_REG_1T2RArray[i],
546 bMaskDWord,
547 rtl819XPHY_REG_1T2RArray[i+1]);
548 RT_TRACE(COMP_DBG,
549 "i: %x, Rtl819xUsbPHY_REGArray[0]=%x Rtl819xUsbPHY_REGArray[1]=%x\n",
550 i, rtl819XPHY_REG_1T2RArray[i],
551 rtl819XPHY_REG_1T2RArray[i+1]);
Jerry Chuang8fc85982009-11-03 07:17:11 -0200552 }
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300553 } else if (ConfigType == BaseBand_Config_AGC_TAB) {
Xenia Ragiadakou9d8e79e2013-06-18 05:29:38 +0300554 for (i = 0; i < AGCTAB_ArrayLength; i += 2) {
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300555 rtl8192_setBBreg(dev, rtl819XAGCTAB_Array[i],
556 bMaskDWord, rtl819XAGCTAB_Array[i+1]);
557 RT_TRACE(COMP_DBG,
558 "i: %x, rtl819XAGCTAB_Array[0]=%x rtl819XAGCTAB_Array[1]=%x\n",
559 i, rtl819XAGCTAB_Array[i],
560 rtl819XAGCTAB_Array[i+1]);
Jerry Chuang8fc85982009-11-03 07:17:11 -0200561 }
562 }
563 return;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200564}
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +0300565
Jerry Chuang8fc85982009-11-03 07:17:11 -0200566/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300567 * function: This function initializes Register definition offset for
568 * Radio Path A/B/C/D
569 * input: net_device *dev
570 * output: none
571 * return: none
572 * notice: Initialization value here is constant and it should never
573 * be changed
574 *****************************************************************************/
Ana Reyc92f4732014-03-14 18:59:58 +0100575static void rtl8192_InitBBRFRegDef(struct net_device *dev)
Jerry Chuang8fc85982009-11-03 07:17:11 -0200576{
577 struct r8192_priv *priv = ieee80211_priv(dev);
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +0300578
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300579 /* RF Interface Software Control */
580 /* 16 LSBs if read 32-bit from 0x870 */
581 priv->PHYRegDef[RF90_PATH_A].rfintfs = rFPGA0_XAB_RFInterfaceSW;
582 /* 16 MSBs if read 32-bit from 0x870 (16-bit for 0x872) */
583 priv->PHYRegDef[RF90_PATH_B].rfintfs = rFPGA0_XAB_RFInterfaceSW;
584 /* 16 LSBs if read 32-bit from 0x874 */
585 priv->PHYRegDef[RF90_PATH_C].rfintfs = rFPGA0_XCD_RFInterfaceSW;
586 /* 16 MSBs if read 32-bit from 0x874 (16-bit for 0x876) */
587 priv->PHYRegDef[RF90_PATH_D].rfintfs = rFPGA0_XCD_RFInterfaceSW;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200588
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300589 /* RF Interface Readback Value */
590 /* 16 LSBs if read 32-bit from 0x8E0 */
591 priv->PHYRegDef[RF90_PATH_A].rfintfi = rFPGA0_XAB_RFInterfaceRB;
592 /* 16 MSBs if read 32-bit from 0x8E0 (16-bit for 0x8E2) */
593 priv->PHYRegDef[RF90_PATH_B].rfintfi = rFPGA0_XAB_RFInterfaceRB;
594 /* 16 LSBs if read 32-bit from 0x8E4 */
595 priv->PHYRegDef[RF90_PATH_C].rfintfi = rFPGA0_XCD_RFInterfaceRB;
596 /* 16 MSBs if read 32-bit from 0x8E4 (16-bit for 0x8E6) */
597 priv->PHYRegDef[RF90_PATH_D].rfintfi = rFPGA0_XCD_RFInterfaceRB;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200598
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300599 /* RF Interface Output (and Enable) */
600 /* 16 LSBs if read 32-bit from 0x860 */
601 priv->PHYRegDef[RF90_PATH_A].rfintfo = rFPGA0_XA_RFInterfaceOE;
602 /* 16 LSBs if read 32-bit from 0x864 */
603 priv->PHYRegDef[RF90_PATH_B].rfintfo = rFPGA0_XB_RFInterfaceOE;
604 /* 16 LSBs if read 32-bit from 0x868 */
605 priv->PHYRegDef[RF90_PATH_C].rfintfo = rFPGA0_XC_RFInterfaceOE;
606 /* 16 LSBs if read 32-bit from 0x86C */
607 priv->PHYRegDef[RF90_PATH_D].rfintfo = rFPGA0_XD_RFInterfaceOE;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200608
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300609 /* RF Interface (Output and) Enable */
610 /* 16 MSBs if read 32-bit from 0x860 (16-bit for 0x862) */
611 priv->PHYRegDef[RF90_PATH_A].rfintfe = rFPGA0_XA_RFInterfaceOE;
612 /* 16 MSBs if read 32-bit from 0x864 (16-bit for 0x866) */
613 priv->PHYRegDef[RF90_PATH_B].rfintfe = rFPGA0_XB_RFInterfaceOE;
614 /* 16 MSBs if read 32-bit from 0x86A (16-bit for 0x86A) */
615 priv->PHYRegDef[RF90_PATH_C].rfintfe = rFPGA0_XC_RFInterfaceOE;
616 /* 16 MSBs if read 32-bit from 0x86C (16-bit for 0x86E) */
617 priv->PHYRegDef[RF90_PATH_D].rfintfe = rFPGA0_XD_RFInterfaceOE;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200618
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300619 /* Addr of LSSI. Write RF register by driver */
620 priv->PHYRegDef[RF90_PATH_A].rf3wireOffset = rFPGA0_XA_LSSIParameter;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200621 priv->PHYRegDef[RF90_PATH_B].rf3wireOffset = rFPGA0_XB_LSSIParameter;
622 priv->PHYRegDef[RF90_PATH_C].rf3wireOffset = rFPGA0_XC_LSSIParameter;
623 priv->PHYRegDef[RF90_PATH_D].rf3wireOffset = rFPGA0_XD_LSSIParameter;
624
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300625 /* RF parameter */
626 /* BB Band Select */
627 priv->PHYRegDef[RF90_PATH_A].rfLSSI_Select = rFPGA0_XAB_RFParameter;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200628 priv->PHYRegDef[RF90_PATH_B].rfLSSI_Select = rFPGA0_XAB_RFParameter;
629 priv->PHYRegDef[RF90_PATH_C].rfLSSI_Select = rFPGA0_XCD_RFParameter;
630 priv->PHYRegDef[RF90_PATH_D].rfLSSI_Select = rFPGA0_XCD_RFParameter;
631
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300632 /* Tx AGC Gain Stage (same for all path. Should we remove this?) */
633 priv->PHYRegDef[RF90_PATH_A].rfTxGainStage = rFPGA0_TxGainStage;
634 priv->PHYRegDef[RF90_PATH_B].rfTxGainStage = rFPGA0_TxGainStage;
635 priv->PHYRegDef[RF90_PATH_C].rfTxGainStage = rFPGA0_TxGainStage;
636 priv->PHYRegDef[RF90_PATH_D].rfTxGainStage = rFPGA0_TxGainStage;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200637
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300638 /* Tranceiver A~D HSSI Parameter-1 */
639 /* wire control parameter1 */
640 priv->PHYRegDef[RF90_PATH_A].rfHSSIPara1 = rFPGA0_XA_HSSIParameter1;
641 priv->PHYRegDef[RF90_PATH_B].rfHSSIPara1 = rFPGA0_XB_HSSIParameter1;
642 priv->PHYRegDef[RF90_PATH_C].rfHSSIPara1 = rFPGA0_XC_HSSIParameter1;
643 priv->PHYRegDef[RF90_PATH_D].rfHSSIPara1 = rFPGA0_XD_HSSIParameter1;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200644
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300645 /* Tranceiver A~D HSSI Parameter-2 */
646 /* wire control parameter2 */
647 priv->PHYRegDef[RF90_PATH_A].rfHSSIPara2 = rFPGA0_XA_HSSIParameter2;
648 priv->PHYRegDef[RF90_PATH_B].rfHSSIPara2 = rFPGA0_XB_HSSIParameter2;
649 priv->PHYRegDef[RF90_PATH_C].rfHSSIPara2 = rFPGA0_XC_HSSIParameter2;
650 priv->PHYRegDef[RF90_PATH_D].rfHSSIPara2 = rFPGA0_XD_HSSIParameter2;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200651
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300652 /* RF Switch Control */
653 /* TR/Ant switch control */
654 priv->PHYRegDef[RF90_PATH_A].rfSwitchControl = rFPGA0_XAB_SwitchControl;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200655 priv->PHYRegDef[RF90_PATH_B].rfSwitchControl = rFPGA0_XAB_SwitchControl;
656 priv->PHYRegDef[RF90_PATH_C].rfSwitchControl = rFPGA0_XCD_SwitchControl;
657 priv->PHYRegDef[RF90_PATH_D].rfSwitchControl = rFPGA0_XCD_SwitchControl;
658
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300659 /* AGC control 1 */
Jerry Chuang8fc85982009-11-03 07:17:11 -0200660 priv->PHYRegDef[RF90_PATH_A].rfAGCControl1 = rOFDM0_XAAGCCore1;
661 priv->PHYRegDef[RF90_PATH_B].rfAGCControl1 = rOFDM0_XBAGCCore1;
662 priv->PHYRegDef[RF90_PATH_C].rfAGCControl1 = rOFDM0_XCAGCCore1;
663 priv->PHYRegDef[RF90_PATH_D].rfAGCControl1 = rOFDM0_XDAGCCore1;
664
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300665 /* AGC control 2 */
Jerry Chuang8fc85982009-11-03 07:17:11 -0200666 priv->PHYRegDef[RF90_PATH_A].rfAGCControl2 = rOFDM0_XAAGCCore2;
667 priv->PHYRegDef[RF90_PATH_B].rfAGCControl2 = rOFDM0_XBAGCCore2;
668 priv->PHYRegDef[RF90_PATH_C].rfAGCControl2 = rOFDM0_XCAGCCore2;
669 priv->PHYRegDef[RF90_PATH_D].rfAGCControl2 = rOFDM0_XDAGCCore2;
670
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300671 /* RX AFE control 1 */
Jerry Chuang8fc85982009-11-03 07:17:11 -0200672 priv->PHYRegDef[RF90_PATH_A].rfRxIQImbalance = rOFDM0_XARxIQImbalance;
673 priv->PHYRegDef[RF90_PATH_B].rfRxIQImbalance = rOFDM0_XBRxIQImbalance;
674 priv->PHYRegDef[RF90_PATH_C].rfRxIQImbalance = rOFDM0_XCRxIQImbalance;
675 priv->PHYRegDef[RF90_PATH_D].rfRxIQImbalance = rOFDM0_XDRxIQImbalance;
676
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300677 /* RX AFE control 1 */
Jerry Chuang8fc85982009-11-03 07:17:11 -0200678 priv->PHYRegDef[RF90_PATH_A].rfRxAFE = rOFDM0_XARxAFE;
679 priv->PHYRegDef[RF90_PATH_B].rfRxAFE = rOFDM0_XBRxAFE;
680 priv->PHYRegDef[RF90_PATH_C].rfRxAFE = rOFDM0_XCRxAFE;
681 priv->PHYRegDef[RF90_PATH_D].rfRxAFE = rOFDM0_XDRxAFE;
682
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300683 /* Tx AFE control 1 */
Jerry Chuang8fc85982009-11-03 07:17:11 -0200684 priv->PHYRegDef[RF90_PATH_A].rfTxIQImbalance = rOFDM0_XATxIQImbalance;
685 priv->PHYRegDef[RF90_PATH_B].rfTxIQImbalance = rOFDM0_XBTxIQImbalance;
686 priv->PHYRegDef[RF90_PATH_C].rfTxIQImbalance = rOFDM0_XCTxIQImbalance;
687 priv->PHYRegDef[RF90_PATH_D].rfTxIQImbalance = rOFDM0_XDTxIQImbalance;
688
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300689 /* Tx AFE control 2 */
Jerry Chuang8fc85982009-11-03 07:17:11 -0200690 priv->PHYRegDef[RF90_PATH_A].rfTxAFE = rOFDM0_XATxAFE;
691 priv->PHYRegDef[RF90_PATH_B].rfTxAFE = rOFDM0_XBTxAFE;
692 priv->PHYRegDef[RF90_PATH_C].rfTxAFE = rOFDM0_XCTxAFE;
693 priv->PHYRegDef[RF90_PATH_D].rfTxAFE = rOFDM0_XDTxAFE;
694
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300695 /* Tranceiver LSSI Readback */
Jerry Chuang8fc85982009-11-03 07:17:11 -0200696 priv->PHYRegDef[RF90_PATH_A].rfLSSIReadBack = rFPGA0_XA_LSSIReadBack;
697 priv->PHYRegDef[RF90_PATH_B].rfLSSIReadBack = rFPGA0_XB_LSSIReadBack;
698 priv->PHYRegDef[RF90_PATH_C].rfLSSIReadBack = rFPGA0_XC_LSSIReadBack;
699 priv->PHYRegDef[RF90_PATH_D].rfLSSIReadBack = rFPGA0_XD_LSSIReadBack;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200700}
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +0300701
Jerry Chuang8fc85982009-11-03 07:17:11 -0200702/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300703 * function: This function is to write register and then readback to make
704 * sure whether BB and RF is OK
705 * input: net_device *dev
706 * HW90_BLOCK_E CheckBlock
707 * RF90_RADIO_PATH_E eRFPath //only used when checkblock is
708 * //HW90_BLOCK_RF
709 * output: none
710 * return: return whether BB and RF is ok (0:OK, 1:Fail)
711 * notice: This function may be removed in the ASIC
712 ******************************************************************************/
Xenia Ragiadakou442543d2013-06-15 07:29:08 +0300713u8 rtl8192_phy_checkBBAndRF(struct net_device *dev, HW90_BLOCK_E CheckBlock,
714 RF90_RADIO_PATH_E eRFPath)
Jerry Chuang8fc85982009-11-03 07:17:11 -0200715{
Jerry Chuang8fc85982009-11-03 07:17:11 -0200716 u8 ret = 0;
Xenia Ragiadakoua60d4d62013-06-23 06:15:17 +0300717 u32 i, CheckTimes = 4, reg = 0;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200718 u32 WriteAddr[4];
719 u32 WriteData[] = {0xfffff027, 0xaa55a02f, 0x00000027, 0x55aa502f};
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +0300720
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300721 /* Initialize register address offset to be checked */
Jerry Chuang8fc85982009-11-03 07:17:11 -0200722 WriteAddr[HW90_BLOCK_MAC] = 0x100;
723 WriteAddr[HW90_BLOCK_PHY0] = 0x900;
724 WriteAddr[HW90_BLOCK_PHY1] = 0x800;
725 WriteAddr[HW90_BLOCK_RF] = 0x3;
Xenia Ragiadakou08a4cde2013-06-23 06:15:16 +0300726 RT_TRACE(COMP_PHY, "%s(), CheckBlock: %d\n", __func__, CheckBlock);
Xenia Ragiadakou111857c2013-06-18 05:29:37 +0300727 for (i = 0; i < CheckTimes; i++) {
Jerry Chuang8fc85982009-11-03 07:17:11 -0200728
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300729 /* Write data to register and readback */
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300730 switch (CheckBlock) {
Jerry Chuang8fc85982009-11-03 07:17:11 -0200731 case HW90_BLOCK_MAC:
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300732 RT_TRACE(COMP_ERR,
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +0300733 "PHY_CheckBBRFOK(): Never Write 0x100 here!\n");
Jerry Chuang8fc85982009-11-03 07:17:11 -0200734 break;
735
736 case HW90_BLOCK_PHY0:
737 case HW90_BLOCK_PHY1:
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300738 write_nic_dword(dev, WriteAddr[CheckBlock],
739 WriteData[i]);
Xenia Ragiadakoua60d4d62013-06-23 06:15:17 +0300740 read_nic_dword(dev, WriteAddr[CheckBlock], &reg);
Jerry Chuang8fc85982009-11-03 07:17:11 -0200741 break;
742
743 case HW90_BLOCK_RF:
744 WriteData[i] &= 0xfff;
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300745 rtl8192_phy_SetRFReg(dev, eRFPath,
746 WriteAddr[HW90_BLOCK_RF],
747 bMask12Bits, WriteData[i]);
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300748 /* TODO: we should not delay for such a long time.
749 Ask SD3 */
Xenia Ragiadakou26f35612013-06-23 06:15:18 +0300750 usleep_range(1000, 1000);
Xenia Ragiadakoua60d4d62013-06-23 06:15:17 +0300751 reg = rtl8192_phy_QueryRFReg(dev, eRFPath,
752 WriteAddr[HW90_BLOCK_RF],
753 bMask12Bits);
Xenia Ragiadakou26f35612013-06-23 06:15:18 +0300754 usleep_range(1000, 1000);
Jerry Chuang8fc85982009-11-03 07:17:11 -0200755 break;
756
757 default:
758 ret = 1;
759 break;
760 }
761
762
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300763 /* Check whether readback data is correct */
Xenia Ragiadakoua60d4d62013-06-23 06:15:17 +0300764 if (reg != WriteData[i]) {
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300765 RT_TRACE((COMP_PHY|COMP_ERR),
Xenia Ragiadakoua60d4d62013-06-23 06:15:17 +0300766 "error reg: %x, WriteData: %x\n",
767 reg, WriteData[i]);
Jerry Chuang8fc85982009-11-03 07:17:11 -0200768 ret = 1;
769 break;
770 }
771 }
772
773 return ret;
774}
775
Jerry Chuang8fc85982009-11-03 07:17:11 -0200776/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300777 * function: This function initializes BB&RF
778 * input: net_device *dev
779 * output: none
780 * return: none
781 * notice: Initialization value may change all the time, so please make
782 * sure it has been synced with the newest.
783 ******************************************************************************/
Ana Reyc92f4732014-03-14 18:59:58 +0100784static void rtl8192_BB_Config_ParaFile(struct net_device *dev)
Jerry Chuang8fc85982009-11-03 07:17:11 -0200785{
786 struct r8192_priv *priv = ieee80211_priv(dev);
Xenia Ragiadakoua60d4d62013-06-23 06:15:17 +0300787 u8 reg_u8 = 0, eCheckItem = 0, status = 0;
Xenia Ragiadakou07ecbbf2013-06-18 05:29:39 +0300788 u32 reg_u32 = 0;
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +0300789
Jerry Chuang8fc85982009-11-03 07:17:11 -0200790 /**************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300791 * <1> Initialize BaseBand
792 *************************************/
Jerry Chuang8fc85982009-11-03 07:17:11 -0200793
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300794 /* --set BB Global Reset-- */
Xenia Ragiadakou07ecbbf2013-06-18 05:29:39 +0300795 read_nic_byte(dev, BB_GLOBAL_RESET, &reg_u8);
Xenia Ragiadakou83e6d9e2013-06-19 04:58:06 +0300796 write_nic_byte(dev, BB_GLOBAL_RESET, (reg_u8|BB_GLOBAL_RESET_BIT));
Jerry Chuang8fc85982009-11-03 07:17:11 -0200797 mdelay(50);
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300798 /* ---set BB reset Active--- */
Xenia Ragiadakou07ecbbf2013-06-18 05:29:39 +0300799 read_nic_dword(dev, CPU_GEN, &reg_u32);
800 write_nic_dword(dev, CPU_GEN, (reg_u32&(~CPU_GEN_BB_RST)));
Jerry Chuang8fc85982009-11-03 07:17:11 -0200801
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300802 /* ----Ckeck FPGAPHY0 and PHY1 board is OK---- */
803 /* TODO: this function should be removed on ASIC */
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300804 for (eCheckItem = (HW90_BLOCK_E)HW90_BLOCK_PHY0;
805 eCheckItem <= HW90_BLOCK_PHY1; eCheckItem++) {
806 /* don't care RF path */
Xenia Ragiadakoua60d4d62013-06-23 06:15:17 +0300807 status = rtl8192_phy_checkBBAndRF(dev, (HW90_BLOCK_E)eCheckItem,
808 (RF90_RADIO_PATH_E)0);
809 if (status != 0) {
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300810 RT_TRACE((COMP_ERR | COMP_PHY),
811 "PHY_RF8256_Config(): Check PHY%d Fail!!\n",
812 eCheckItem-1);
Xenia Ragiadakou111857c2013-06-18 05:29:37 +0300813 return;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200814 }
815 }
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300816 /* ---- Set CCK and OFDM Block "OFF"---- */
Jerry Chuang8fc85982009-11-03 07:17:11 -0200817 rtl8192_setBBreg(dev, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0x0);
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300818 /* ----BB Register Initilazation---- */
819 /* ==m==>Set PHY REG From Header<==m== */
Jerry Chuang8fc85982009-11-03 07:17:11 -0200820 rtl8192_phyConfigBB(dev, BaseBand_Config_PHY_REG);
821
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300822 /* ----Set BB reset de-Active---- */
Xenia Ragiadakou07ecbbf2013-06-18 05:29:39 +0300823 read_nic_dword(dev, CPU_GEN, &reg_u32);
824 write_nic_dword(dev, CPU_GEN, (reg_u32|CPU_GEN_BB_RST));
Jerry Chuang8fc85982009-11-03 07:17:11 -0200825
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300826 /* ----BB AGC table Initialization---- */
827 /* ==m==>Set PHY REG From Header<==m== */
Jerry Chuang8fc85982009-11-03 07:17:11 -0200828 rtl8192_phyConfigBB(dev, BaseBand_Config_AGC_TAB);
829
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300830 /* ----Enable XSTAL ---- */
Jerry Chuang8fc85982009-11-03 07:17:11 -0200831 write_nic_byte_E(dev, 0x5e, 0x00);
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300832 if (priv->card_8192_version == (u8)VERSION_819xU_A) {
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300833 /* Antenna gain offset from B/C/D to A */
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300834 reg_u32 = (priv->AntennaTxPwDiff[1]<<4 |
835 priv->AntennaTxPwDiff[0]);
836 rtl8192_setBBreg(dev, rFPGA0_TxGainStage, (bXBTxAGC|bXCTxAGC),
837 reg_u32);
Jerry Chuang8fc85982009-11-03 07:17:11 -0200838
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300839 /* XSTALLCap */
Xenia Ragiadakou07ecbbf2013-06-18 05:29:39 +0300840 reg_u32 = priv->CrystalCap & 0xf;
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300841 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter1, bXtalCap,
842 reg_u32);
Jerry Chuang8fc85982009-11-03 07:17:11 -0200843 }
844
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300845 /* Check if the CCK HighPower is turned ON.
846 This is used to calculate PWDB. */
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300847 priv->bCckHighPower = (u8)rtl8192_QueryBBReg(dev,
848 rFPGA0_XA_HSSIParameter2,
849 0x200);
Jerry Chuang8fc85982009-11-03 07:17:11 -0200850 return;
851}
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +0300852
Jerry Chuang8fc85982009-11-03 07:17:11 -0200853/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300854 * function: This function initializes BB&RF
855 * input: net_device *dev
856 * output: none
857 * return: none
858 * notice: Initialization value may change all the time, so please make
859 * sure it has been synced with the newest.
860 *****************************************************************************/
Xenia Ragiadakou88d8fe22013-05-11 17:22:22 +0300861void rtl8192_BBConfig(struct net_device *dev)
Jerry Chuang8fc85982009-11-03 07:17:11 -0200862{
863 rtl8192_InitBBRFRegDef(dev);
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300864 /* config BB&RF. As hardCode based initialization has not been well
865 * implemented, so use file first.
866 * FIXME: should implement it for hardcode? */
Jerry Chuang8fc85982009-11-03 07:17:11 -0200867 rtl8192_BB_Config_ParaFile(dev);
868 return;
869}
870
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +0300871
Jerry Chuang8fc85982009-11-03 07:17:11 -0200872/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300873 * function: This function obtains the initialization value of Tx power Level
874 * offset
875 * input: net_device *dev
876 * output: none
877 * return: none
878 *****************************************************************************/
Xenia Ragiadakou88d8fe22013-05-11 17:22:22 +0300879void rtl8192_phy_getTxPower(struct net_device *dev)
Jerry Chuang8fc85982009-11-03 07:17:11 -0200880{
881 struct r8192_priv *priv = ieee80211_priv(dev);
Xenia Ragiadakoub3d42bf2013-06-06 16:40:51 +0300882 u8 tmp;
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +0300883
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300884 read_nic_dword(dev, rTxAGC_Rate18_06,
885 &priv->MCSTxPowerLevelOriginalOffset[0]);
886 read_nic_dword(dev, rTxAGC_Rate54_24,
887 &priv->MCSTxPowerLevelOriginalOffset[1]);
888 read_nic_dword(dev, rTxAGC_Mcs03_Mcs00,
889 &priv->MCSTxPowerLevelOriginalOffset[2]);
890 read_nic_dword(dev, rTxAGC_Mcs07_Mcs04,
891 &priv->MCSTxPowerLevelOriginalOffset[3]);
892 read_nic_dword(dev, rTxAGC_Mcs11_Mcs08,
893 &priv->MCSTxPowerLevelOriginalOffset[4]);
894 read_nic_dword(dev, rTxAGC_Mcs15_Mcs12,
895 &priv->MCSTxPowerLevelOriginalOffset[5]);
Jerry Chuang8fc85982009-11-03 07:17:11 -0200896
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300897 /* Read rx initial gain */
Xenia Ragiadakoub3d42bf2013-06-06 16:40:51 +0300898 read_nic_byte(dev, rOFDM0_XAAGCCore1, &priv->DefaultInitialGain[0]);
899 read_nic_byte(dev, rOFDM0_XBAGCCore1, &priv->DefaultInitialGain[1]);
900 read_nic_byte(dev, rOFDM0_XCAGCCore1, &priv->DefaultInitialGain[2]);
901 read_nic_byte(dev, rOFDM0_XDAGCCore1, &priv->DefaultInitialGain[3]);
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300902 RT_TRACE(COMP_INIT,
903 "Default initial gain (c50=0x%x, c58=0x%x, c60=0x%x, c68=0x%x)\n",
904 priv->DefaultInitialGain[0], priv->DefaultInitialGain[1],
905 priv->DefaultInitialGain[2], priv->DefaultInitialGain[3]);
Jerry Chuang8fc85982009-11-03 07:17:11 -0200906
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300907 /* Read framesync */
Xenia Ragiadakoub3d42bf2013-06-06 16:40:51 +0300908 read_nic_byte(dev, rOFDM0_RxDetector3, &priv->framesync);
909 read_nic_byte(dev, rOFDM0_RxDetector2, &tmp);
910 priv->framesyncC34 = tmp;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200911 RT_TRACE(COMP_INIT, "Default framesync (0x%x) = 0x%x \n",
912 rOFDM0_RxDetector3, priv->framesync);
913
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300914 /* Read SIFS (save the value read fome MACPHY_REG.txt) */
Xenia Ragiadakoub3d42bf2013-06-06 16:40:51 +0300915 read_nic_word(dev, SIFS, &priv->SifsTime);
Jerry Chuang8fc85982009-11-03 07:17:11 -0200916
917 return;
918}
919
920/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300921 * function: This function sets the initialization value of Tx power Level
922 * offset
923 * input: net_device *dev
924 * u8 channel
925 * output: none
926 * return: none
927 ******************************************************************************/
Xenia Ragiadakou88d8fe22013-05-11 17:22:22 +0300928void rtl8192_phy_setTxPower(struct net_device *dev, u8 channel)
Jerry Chuang8fc85982009-11-03 07:17:11 -0200929{
930 struct r8192_priv *priv = ieee80211_priv(dev);
931 u8 powerlevel = priv->TxPowerLevelCCK[channel-1];
932 u8 powerlevelOFDM24G = priv->TxPowerLevelOFDM24G[channel-1];
933
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300934 switch (priv->rf_chip) {
Jerry Chuang8fc85982009-11-03 07:17:11 -0200935 case RF_8256:
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300936 /* need further implement */
937 PHY_SetRF8256CCKTxPower(dev, powerlevel);
Jerry Chuang8fc85982009-11-03 07:17:11 -0200938 PHY_SetRF8256OFDMTxPower(dev, powerlevelOFDM24G);
939 break;
940 default:
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +0300941 RT_TRACE((COMP_PHY|COMP_ERR),
942 "error RF chipID(8225 or 8258) in function %s()\n",
Xenia Ragiadakou08a4cde2013-06-23 06:15:16 +0300943 __func__);
Jerry Chuang8fc85982009-11-03 07:17:11 -0200944 break;
945 }
946 return;
947}
948
949/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300950 * function: This function checks Rf chip to do RF config
951 * input: net_device *dev
952 * output: none
953 * return: only 8256 is supported
954 ******************************************************************************/
Xenia Ragiadakou88d8fe22013-05-11 17:22:22 +0300955void rtl8192_phy_RFConfig(struct net_device *dev)
Jerry Chuang8fc85982009-11-03 07:17:11 -0200956{
957 struct r8192_priv *priv = ieee80211_priv(dev);
958
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300959 switch (priv->rf_chip) {
Jerry Chuang8fc85982009-11-03 07:17:11 -0200960 case RF_8256:
961 PHY_RF8256_Config(dev);
962 break;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200963 default:
964 RT_TRACE(COMP_ERR, "error chip id\n");
965 break;
966 }
967 return;
968}
969
970/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300971 * function: This function updates Initial gain
972 * input: net_device *dev
973 * output: none
974 * return: As Windows has not implemented this, wait for complement
975 ******************************************************************************/
Xenia Ragiadakou88d8fe22013-05-11 17:22:22 +0300976void rtl8192_phy_updateInitGain(struct net_device *dev)
Jerry Chuang8fc85982009-11-03 07:17:11 -0200977{
978 return;
979}
980
981/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +0300982 * function: This function read RF parameters from general head file,
983 * and do RF 3-wire
984 * input: net_device *dev
985 * RF90_RADIO_PATH_E eRFPath
986 * output: none
987 * return: return code show if RF configuration is successful(0:pass, 1:fail)
988 * notice: Delay may be required for RF configuration
989 *****************************************************************************/
Xenia Ragiadakou442543d2013-06-15 07:29:08 +0300990u8 rtl8192_phy_ConfigRFWithHeaderFile(struct net_device *dev,
991 RF90_RADIO_PATH_E eRFPath)
Jerry Chuang8fc85982009-11-03 07:17:11 -0200992{
993
994 int i;
Jerry Chuang8fc85982009-11-03 07:17:11 -0200995 u8 ret = 0;
996
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +0300997 switch (eRFPath) {
Sebastian Hahn24fbe872012-12-05 21:40:22 +0100998 case RF90_PATH_A:
Xenia Ragiadakou9d8e79e2013-06-18 05:29:38 +0300999 for (i = 0; i < RadioA_ArrayLength; i = i+2) {
Jerry Chuang8fc85982009-11-03 07:17:11 -02001000
Xenia Ragiadakou1111b872013-06-15 07:29:04 +03001001 if (rtl819XRadioA_Array[i] == 0xfe) {
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001002 mdelay(100);
1003 continue;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001004 }
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001005 rtl8192_phy_SetRFReg(dev, eRFPath,
1006 rtl819XRadioA_Array[i],
1007 bMask12Bits,
1008 rtl819XRadioA_Array[i+1]);
Sebastian Hahn24fbe872012-12-05 21:40:22 +01001009 mdelay(1);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001010
Sebastian Hahn24fbe872012-12-05 21:40:22 +01001011 }
1012 break;
1013 case RF90_PATH_B:
Xenia Ragiadakou9d8e79e2013-06-18 05:29:38 +03001014 for (i = 0; i < RadioB_ArrayLength; i = i+2) {
Jerry Chuang8fc85982009-11-03 07:17:11 -02001015
Xenia Ragiadakou1111b872013-06-15 07:29:04 +03001016 if (rtl819XRadioB_Array[i] == 0xfe) {
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001017 mdelay(100);
1018 continue;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001019 }
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001020 rtl8192_phy_SetRFReg(dev, eRFPath,
1021 rtl819XRadioB_Array[i],
1022 bMask12Bits,
1023 rtl819XRadioB_Array[i+1]);
Sebastian Hahn24fbe872012-12-05 21:40:22 +01001024 mdelay(1);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001025
Sebastian Hahn24fbe872012-12-05 21:40:22 +01001026 }
1027 break;
1028 case RF90_PATH_C:
Xenia Ragiadakou9d8e79e2013-06-18 05:29:38 +03001029 for (i = 0; i < RadioC_ArrayLength; i = i+2) {
Jerry Chuang8fc85982009-11-03 07:17:11 -02001030
Xenia Ragiadakou1111b872013-06-15 07:29:04 +03001031 if (rtl819XRadioC_Array[i] == 0xfe) {
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001032 mdelay(100);
1033 continue;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001034 }
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001035 rtl8192_phy_SetRFReg(dev, eRFPath,
1036 rtl819XRadioC_Array[i],
1037 bMask12Bits,
1038 rtl819XRadioC_Array[i+1]);
Sebastian Hahn24fbe872012-12-05 21:40:22 +01001039 mdelay(1);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001040
Sebastian Hahn24fbe872012-12-05 21:40:22 +01001041 }
1042 break;
1043 case RF90_PATH_D:
Xenia Ragiadakou9d8e79e2013-06-18 05:29:38 +03001044 for (i = 0; i < RadioD_ArrayLength; i = i+2) {
Jerry Chuang8fc85982009-11-03 07:17:11 -02001045
Xenia Ragiadakou1111b872013-06-15 07:29:04 +03001046 if (rtl819XRadioD_Array[i] == 0xfe) {
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001047 mdelay(100);
1048 continue;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001049 }
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001050 rtl8192_phy_SetRFReg(dev, eRFPath,
1051 rtl819XRadioD_Array[i],
1052 bMask12Bits,
1053 rtl819XRadioD_Array[i+1]);
Sebastian Hahn24fbe872012-12-05 21:40:22 +01001054 mdelay(1);
1055
1056 }
1057 break;
1058 default:
1059 break;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001060 }
1061
Joe Perches859171c2010-11-14 19:04:48 -08001062 return ret;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001063
1064}
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +03001065
Jerry Chuang8fc85982009-11-03 07:17:11 -02001066/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +03001067 * function: This function sets Tx Power of the channel
1068 * input: net_device *dev
1069 * u8 channel
1070 * output: none
1071 * return: none
1072 * notice:
1073 ******************************************************************************/
Ana Reyc92f4732014-03-14 18:59:58 +01001074static void rtl8192_SetTxPowerLevel(struct net_device *dev, u8 channel)
Jerry Chuang8fc85982009-11-03 07:17:11 -02001075{
1076 struct r8192_priv *priv = ieee80211_priv(dev);
1077 u8 powerlevel = priv->TxPowerLevelCCK[channel-1];
1078 u8 powerlevelOFDM24G = priv->TxPowerLevelOFDM24G[channel-1];
1079
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +03001080 switch (priv->rf_chip) {
Jerry Chuang8fc85982009-11-03 07:17:11 -02001081 case RF_8225:
1082#ifdef TO_DO_LIST
1083 PHY_SetRF8225CckTxPower(Adapter, powerlevel);
1084 PHY_SetRF8225OfdmTxPower(Adapter, powerlevelOFDM24G);
1085#endif
1086 break;
1087
1088 case RF_8256:
1089 PHY_SetRF8256CCKTxPower(dev, powerlevel);
1090 PHY_SetRF8256OFDMTxPower(dev, powerlevelOFDM24G);
1091 break;
1092
1093 case RF_8258:
1094 break;
1095 default:
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001096 RT_TRACE(COMP_ERR, "unknown rf chip ID in %s()\n", __func__);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001097 break;
1098 }
1099 return;
1100}
1101
1102/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +03001103 * function: This function sets RF state on or off
1104 * input: net_device *dev
1105 * RT_RF_POWER_STATE eRFPowerState //Power State to set
1106 * output: none
1107 * return: none
1108 * notice:
1109 *****************************************************************************/
Xenia Ragiadakou442543d2013-06-15 07:29:08 +03001110bool rtl8192_SetRFPowerState(struct net_device *dev,
1111 RT_RF_POWER_STATE eRFPowerState)
Jerry Chuang8fc85982009-11-03 07:17:11 -02001112{
1113 bool bResult = true;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001114 struct r8192_priv *priv = ieee80211_priv(dev);
1115
Xenia Ragiadakou1111b872013-06-15 07:29:04 +03001116 if (eRFPowerState == priv->ieee80211->eRFPowerState)
Jerry Chuang8fc85982009-11-03 07:17:11 -02001117 return false;
1118
Xenia Ragiadakou1111b872013-06-15 07:29:04 +03001119 if (priv->SetRFPowerStateInProgress == true)
Jerry Chuang8fc85982009-11-03 07:17:11 -02001120 return false;
1121
1122 priv->SetRFPowerStateInProgress = true;
1123
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +03001124 switch (priv->rf_chip) {
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001125 case RF_8256:
Xenia Ragiadakouceb56592013-06-15 07:29:07 +03001126 switch (eRFPowerState) {
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001127 case eRfOn:
1128 /* RF-A, RF-B */
1129 /* enable RF-Chip A/B - 0x860[4] */
1130 rtl8192_setBBreg(dev, rFPGA0_XA_RFInterfaceOE, BIT4,
1131 0x1);
1132 /* analog to digital on - 0x88c[9:8] */
1133 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter4, 0x300,
1134 0x3);
1135 /* digital to analog on - 0x880[4:3] */
1136 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter1, 0x18,
1137 0x3);
1138 /* rx antenna on - 0xc04[1:0] */
1139 rtl8192_setBBreg(dev, rOFDM0_TRxPathEnable, 0x3, 0x3);
1140 /* rx antenna on - 0xd04[1:0] */
1141 rtl8192_setBBreg(dev, rOFDM1_TRxPathEnable, 0x3, 0x3);
1142 /* analog to digital part2 on - 0x880[6:5] */
1143 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter1, 0x60,
1144 0x3);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001145
Jerry Chuang8fc85982009-11-03 07:17:11 -02001146 break;
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001147
1148 case eRfSleep:
1149
1150 break;
1151
1152 case eRfOff:
1153 /* RF-A, RF-B */
1154 /* disable RF-Chip A/B - 0x860[4] */
1155 rtl8192_setBBreg(dev, rFPGA0_XA_RFInterfaceOE, BIT4,
1156 0x0);
1157 /* analog to digital off, for power save */
1158 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter4, 0xf00,
1159 0x0); /* 0x88c[11:8] */
1160 /* digital to analog off, for power save - 0x880[4:3] */
1161 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter1, 0x18,
1162 0x0);
1163 /* rx antenna off - 0xc04[3:0] */
1164 rtl8192_setBBreg(dev, rOFDM0_TRxPathEnable, 0xf, 0x0);
1165 /* rx antenna off - 0xd04[3:0] */
1166 rtl8192_setBBreg(dev, rOFDM1_TRxPathEnable, 0xf, 0x0);
1167 /* analog to digital part2 off, for power save */
1168 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter1, 0x60,
1169 0x0); /* 0x880[6:5] */
1170
1171 break;
1172
Jerry Chuang8fc85982009-11-03 07:17:11 -02001173 default:
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001174 bResult = false;
1175 RT_TRACE(COMP_ERR, "%s(): unknown state to set: 0x%X\n",
1176 __func__, eRFPowerState);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001177 break;
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001178 }
1179 break;
1180 default:
1181 RT_TRACE(COMP_ERR, "Not support rf_chip(%x)\n", priv->rf_chip);
1182 break;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001183 }
1184#ifdef TO_DO_LIST
Xenia Ragiadakou1111b872013-06-15 07:29:04 +03001185 if (bResult) {
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +03001186 /* Update current RF state variable. */
Jerry Chuang8fc85982009-11-03 07:17:11 -02001187 pHalData->eRFPowerState = eRFPowerState;
Xenia Ragiadakouceb56592013-06-15 07:29:07 +03001188 switch (pHalData->RFChipID) {
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001189 case RF_8256:
1190 switch (pHalData->eRFPowerState) {
1191 case eRfOff:
1192 /* If Rf off reason is from IPS,
1193 LED should blink with no link */
1194 if (pMgntInfo->RfOffReason == RF_CHANGE_BY_IPS)
1195 Adapter->HalFunc.LedControlHandler(Adapter, LED_CTL_NO_LINK);
1196 else
1197 /* Turn off LED if RF is not ON. */
1198 Adapter->HalFunc.LedControlHandler(Adapter, LED_CTL_POWER_OFF);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001199 break;
1200
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001201 case eRfOn:
1202 /* Turn on RF we are still linked, which might
1203 happen when we quickly turn off and on HW RF.
1204 */
1205 if (pMgntInfo->bMediaConnect == TRUE)
1206 Adapter->HalFunc.LedControlHandler(Adapter, LED_CTL_LINK);
1207 else
1208 /* Turn off LED if RF is not ON. */
1209 Adapter->HalFunc.LedControlHandler(Adapter, LED_CTL_NO_LINK);
1210 break;
1211
1212 default:
1213 break;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001214 }
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001215 break;
1216
1217 default:
1218 RT_TRACE(COMP_RF, DBG_LOUD, "%s(): Unknown RF type\n",
1219 __func__);
1220 break;
1221 }
Jerry Chuang8fc85982009-11-03 07:17:11 -02001222
1223 }
1224#endif
1225 priv->SetRFPowerStateInProgress = false;
1226
1227 return bResult;
1228}
1229
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +03001230/******************************************************************************
1231 * function: This function sets command table variable (struct SwChnlCmd).
1232 * input: SwChnlCmd *CmdTable //table to be set
1233 * u32 CmdTableIdx //variable index in table to be set
1234 * u32 CmdTableSz //table size
1235 * SwChnlCmdID CmdID //command ID to set
1236 * u32 Para1
1237 * u32 Para2
1238 * u32 msDelay
1239 * output:
1240 * return: true if finished, false otherwise
1241 * notice:
1242 ******************************************************************************/
Ana Reyc92f4732014-03-14 18:59:58 +01001243static u8 rtl8192_phy_SetSwChnlCmdArray(SwChnlCmd *CmdTable, u32 CmdTableIdx,
1244 u32 CmdTableSz, SwChnlCmdID CmdID,
1245 u32 Para1, u32 Para2, u32 msDelay)
Jerry Chuang8fc85982009-11-03 07:17:11 -02001246{
Xenia Ragiadakou88d8fe22013-05-11 17:22:22 +03001247 SwChnlCmd *pCmd;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001248
Xenia Ragiadakou1111b872013-06-15 07:29:04 +03001249 if (CmdTable == NULL) {
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001250 RT_TRACE(COMP_ERR, "%s(): CmdTable cannot be NULL\n", __func__);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001251 return false;
1252 }
Xenia Ragiadakou1111b872013-06-15 07:29:04 +03001253 if (CmdTableIdx >= CmdTableSz) {
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001254 RT_TRACE(COMP_ERR, "%s(): Access invalid index, please check size of the table, CmdTableIdx:%d, CmdTableSz:%d\n",
1255 __func__, CmdTableIdx, CmdTableSz);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001256 return false;
1257 }
1258
1259 pCmd = CmdTable + CmdTableIdx;
1260 pCmd->CmdID = CmdID;
1261 pCmd->Para1 = Para1;
1262 pCmd->Para2 = Para2;
1263 pCmd->msDelay = msDelay;
1264
1265 return true;
1266}
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +03001267
Jerry Chuang8fc85982009-11-03 07:17:11 -02001268/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +03001269 * function: This function sets channel step by step
1270 * input: net_device *dev
1271 * u8 channel
1272 * u8 *stage //3 stages
1273 * u8 *step
1274 * u32 *delay //whether need to delay
1275 * output: store new stage, step and delay for next step
1276 * (combine with function above)
1277 * return: true if finished, false otherwise
1278 * notice: Wait for simpler function to replace it
1279 *****************************************************************************/
Ana Reyc92f4732014-03-14 18:59:58 +01001280static u8 rtl8192_phy_SwChnlStepByStep(struct net_device *dev, u8 channel,
1281 u8 *stage, u8 *step, u32 *delay)
Jerry Chuang8fc85982009-11-03 07:17:11 -02001282{
1283 struct r8192_priv *priv = ieee80211_priv(dev);
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001284 SwChnlCmd PreCommonCmd[MAX_PRECMD_CNT];
1285 u32 PreCommonCmdCnt;
1286 SwChnlCmd PostCommonCmd[MAX_POSTCMD_CNT];
1287 u32 PostCommonCmdCnt;
1288 SwChnlCmd RfDependCmd[MAX_RFDEPENDCMD_CNT];
1289 u32 RfDependCmdCnt;
1290 SwChnlCmd *CurrentCmd = NULL;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001291 u8 eRFPath;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001292
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001293 RT_TRACE(COMP_CH, "%s() stage: %d, step: %d, channel: %d\n",
Xenia Ragiadakou08a4cde2013-06-23 06:15:16 +03001294 __func__, *stage, *step, channel);
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +03001295 if (!IsLegalChannel(priv->ieee80211, channel)) {
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001296 RT_TRACE(COMP_ERR, "set to illegal channel: %d\n", channel);
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +03001297 /* return true to tell upper caller function this channel
1298 setting is finished! Or it will in while loop. */
1299 return true;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001300 }
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001301 /* FIXME: need to check whether channel is legal or not here */
Jerry Chuang8fc85982009-11-03 07:17:11 -02001302
1303
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001304 /* <1> Fill up pre common command. */
1305 PreCommonCmdCnt = 0;
1306 rtl8192_phy_SetSwChnlCmdArray(PreCommonCmd, PreCommonCmdCnt++,
1307 MAX_PRECMD_CNT, CmdID_SetTxPowerLevel,
1308 0, 0, 0);
1309 rtl8192_phy_SetSwChnlCmdArray(PreCommonCmd, PreCommonCmdCnt++,
1310 MAX_PRECMD_CNT, CmdID_End, 0, 0, 0);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001311
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001312 /* <2> Fill up post common command. */
1313 PostCommonCmdCnt = 0;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001314
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001315 rtl8192_phy_SetSwChnlCmdArray(PostCommonCmd, PostCommonCmdCnt++,
1316 MAX_POSTCMD_CNT, CmdID_End, 0, 0, 0);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001317
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001318 /* <3> Fill up RF dependent command. */
1319 RfDependCmdCnt = 0;
1320 switch (priv->rf_chip) {
1321 case RF_8225:
1322 if (!(channel >= 1 && channel <= 14)) {
1323 RT_TRACE(COMP_ERR,
1324 "illegal channel for Zebra 8225: %d\n",
1325 channel);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001326 return true;
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001327 }
1328 rtl8192_phy_SetSwChnlCmdArray(RfDependCmd, RfDependCmdCnt++,
1329 MAX_RFDEPENDCMD_CNT,
1330 CmdID_RF_WriteReg,
1331 rZebra1_Channel,
1332 RF_CHANNEL_TABLE_ZEBRA[channel],
1333 10);
1334 rtl8192_phy_SetSwChnlCmdArray(RfDependCmd, RfDependCmdCnt++,
1335 MAX_RFDEPENDCMD_CNT,
1336 CmdID_End, 0, 0, 0);
1337 break;
1338
1339 case RF_8256:
1340 /* TEST!! This is not the table for 8256!! */
1341 if (!(channel >= 1 && channel <= 14)) {
1342 RT_TRACE(COMP_ERR,
1343 "illegal channel for Zebra 8256: %d\n",
1344 channel);
1345 return true;
1346 }
1347 rtl8192_phy_SetSwChnlCmdArray(RfDependCmd, RfDependCmdCnt++,
1348 MAX_RFDEPENDCMD_CNT,
1349 CmdID_RF_WriteReg,
1350 rZebra1_Channel, channel, 10);
1351 rtl8192_phy_SetSwChnlCmdArray(RfDependCmd, RfDependCmdCnt++,
1352 MAX_RFDEPENDCMD_CNT,
1353 CmdID_End, 0, 0, 0);
1354 break;
1355
1356 case RF_8258:
1357 break;
1358
1359 default:
1360 RT_TRACE(COMP_ERR, "Unknown RFChipID: %d\n", priv->rf_chip);
1361 return true;
1362 break;
1363 }
1364
1365
1366 do {
1367 switch (*stage) {
1368 case 0:
1369 CurrentCmd = &PreCommonCmd[*step];
1370 break;
1371 case 1:
1372 CurrentCmd = &RfDependCmd[*step];
1373 break;
1374 case 2:
1375 CurrentCmd = &PostCommonCmd[*step];
Jerry Chuang8fc85982009-11-03 07:17:11 -02001376 break;
1377 }
1378
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001379 if (CurrentCmd->CmdID == CmdID_End) {
1380 if ((*stage) == 2) {
1381 (*delay) = CurrentCmd->msDelay;
1382 return true;
1383 } else {
1384 (*stage)++;
1385 (*step) = 0;
1386 continue;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001387 }
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001388 }
Jerry Chuang8fc85982009-11-03 07:17:11 -02001389
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001390 switch (CurrentCmd->CmdID) {
1391 case CmdID_SetTxPowerLevel:
1392 if (priv->card_8192_version == (u8)VERSION_819xU_A)
1393 /* consider it later! */
1394 rtl8192_SetTxPowerLevel(dev, channel);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001395 break;
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001396 case CmdID_WritePortUlong:
1397 write_nic_dword(dev, CurrentCmd->Para1,
1398 CurrentCmd->Para2);
1399 break;
1400 case CmdID_WritePortUshort:
1401 write_nic_word(dev, CurrentCmd->Para1,
1402 (u16)CurrentCmd->Para2);
1403 break;
1404 case CmdID_WritePortUchar:
1405 write_nic_byte(dev, CurrentCmd->Para1,
1406 (u8)CurrentCmd->Para2);
1407 break;
1408 case CmdID_RF_WriteReg:
1409 for (eRFPath = 0; eRFPath < RF90_PATH_MAX; eRFPath++) {
1410 rtl8192_phy_SetRFReg(dev,
1411 (RF90_RADIO_PATH_E)eRFPath,
1412 CurrentCmd->Para1,
1413 bZebra1_ChannelNum,
1414 CurrentCmd->Para2);
1415 }
1416 break;
1417 default:
1418 break;
1419 }
1420
1421 break;
1422 } while (true);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001423
Xenia Ragiadakouec5d3192013-06-18 05:29:36 +03001424 (*delay) = CurrentCmd->msDelay;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001425 (*step)++;
1426 return false;
1427}
1428
1429/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +03001430 * function: This function does actually set channel work
1431 * input: net_device *dev
1432 * u8 channel
1433 * output: none
1434 * return: none
1435 * notice: We should not call this function directly
1436 *****************************************************************************/
Ana Reyc92f4732014-03-14 18:59:58 +01001437static void rtl8192_phy_FinishSwChnlNow(struct net_device *dev, u8 channel)
Jerry Chuang8fc85982009-11-03 07:17:11 -02001438{
1439 struct r8192_priv *priv = ieee80211_priv(dev);
1440 u32 delay = 0;
1441
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001442 while (!rtl8192_phy_SwChnlStepByStep(dev, channel, &priv->SwChnlStage,
1443 &priv->SwChnlStep, &delay)) {
Xenia Ragiadakou1111b872013-06-15 07:29:04 +03001444 if (!priv->up)
Jerry Chuang8fc85982009-11-03 07:17:11 -02001445 break;
1446 }
1447}
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +03001448
Jerry Chuang8fc85982009-11-03 07:17:11 -02001449/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +03001450 * function: Callback routine of the work item for switch channel.
1451 * input: net_device *dev
Jerry Chuang8fc85982009-11-03 07:17:11 -02001452 *
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +03001453 * output: none
1454 * return: none
1455 *****************************************************************************/
Jerry Chuang8fc85982009-11-03 07:17:11 -02001456void rtl8192_SwChnl_WorkItem(struct net_device *dev)
1457{
1458
1459 struct r8192_priv *priv = ieee80211_priv(dev);
1460
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001461 RT_TRACE(COMP_CH, "==> SwChnlCallback819xUsbWorkItem(), chan:%d\n",
1462 priv->chan);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001463
1464
Xenia Ragiadakou83e6d9e2013-06-19 04:58:06 +03001465 rtl8192_phy_FinishSwChnlNow(dev, priv->chan);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001466
1467 RT_TRACE(COMP_CH, "<== SwChnlCallback819xUsbWorkItem()\n");
1468}
1469
1470/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +03001471 * function: This function scheduled actual work item to set channel
1472 * input: net_device *dev
1473 * u8 channel //channel to set
1474 * output: none
1475 * return: return code show if workitem is scheduled (1:pass, 0:fail)
1476 * notice: Delay may be required for RF configuration
1477 ******************************************************************************/
Xenia Ragiadakou88d8fe22013-05-11 17:22:22 +03001478u8 rtl8192_phy_SwChnl(struct net_device *dev, u8 channel)
Jerry Chuang8fc85982009-11-03 07:17:11 -02001479{
1480 struct r8192_priv *priv = ieee80211_priv(dev);
Xenia Ragiadakou08a4cde2013-06-23 06:15:16 +03001481 RT_TRACE(COMP_CH, "%s(), SwChnlInProgress: %d\n", __func__,
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001482 priv->SwChnlInProgress);
Xenia Ragiadakou1111b872013-06-15 07:29:04 +03001483 if (!priv->up)
Jerry Chuang8fc85982009-11-03 07:17:11 -02001484 return false;
Xenia Ragiadakou1111b872013-06-15 07:29:04 +03001485 if (priv->SwChnlInProgress)
Jerry Chuang8fc85982009-11-03 07:17:11 -02001486 return false;
1487
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +03001488 /* -------------------------------------------- */
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +03001489 switch (priv->ieee80211->mode) {
Jerry Chuang8fc85982009-11-03 07:17:11 -02001490 case WIRELESS_MODE_A:
1491 case WIRELESS_MODE_N_5G:
Xenia Ragiadakou9d8e79e2013-06-18 05:29:38 +03001492 if (channel <= 14) {
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +03001493 RT_TRACE(COMP_ERR, "WIRELESS_MODE_A but channel<=14\n");
Jerry Chuang8fc85982009-11-03 07:17:11 -02001494 return false;
1495 }
1496 break;
1497 case WIRELESS_MODE_B:
Xenia Ragiadakou9d8e79e2013-06-18 05:29:38 +03001498 if (channel > 14) {
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +03001499 RT_TRACE(COMP_ERR, "WIRELESS_MODE_B but channel>14\n");
Jerry Chuang8fc85982009-11-03 07:17:11 -02001500 return false;
1501 }
1502 break;
1503 case WIRELESS_MODE_G:
1504 case WIRELESS_MODE_N_24G:
Xenia Ragiadakou9d8e79e2013-06-18 05:29:38 +03001505 if (channel > 14) {
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +03001506 RT_TRACE(COMP_ERR, "WIRELESS_MODE_G but channel>14\n");
Jerry Chuang8fc85982009-11-03 07:17:11 -02001507 return false;
1508 }
1509 break;
1510 }
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +03001511 /* -------------------------------------------- */
Jerry Chuang8fc85982009-11-03 07:17:11 -02001512
1513 priv->SwChnlInProgress = true;
Xenia Ragiadakou1111b872013-06-15 07:29:04 +03001514 if (channel == 0)
Jerry Chuang8fc85982009-11-03 07:17:11 -02001515 channel = 1;
1516
Xenia Ragiadakouec5d3192013-06-18 05:29:36 +03001517 priv->chan = channel;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001518
Xenia Ragiadakouec5d3192013-06-18 05:29:36 +03001519 priv->SwChnlStage = 0;
1520 priv->SwChnlStep = 0;
Xenia Ragiadakoud75340e2013-06-15 07:29:06 +03001521 if (priv->up)
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001522 rtl8192_SwChnl_WorkItem(dev);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001523
1524 priv->SwChnlInProgress = false;
1525 return true;
1526}
1527
Jerry Chuang8fc85982009-11-03 07:17:11 -02001528/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +03001529 * function: Callback routine of the work item for set bandwidth mode.
1530 * input: net_device *dev
1531 * output: none
1532 * return: none
1533 * notice: I doubt whether SetBWModeInProgress flag is necessary as we can
1534 * test whether current work in the queue or not.//do I?
1535 *****************************************************************************/
Jerry Chuang8fc85982009-11-03 07:17:11 -02001536void rtl8192_SetBWModeWorkItem(struct net_device *dev)
1537{
1538
1539 struct r8192_priv *priv = ieee80211_priv(dev);
1540 u8 regBwOpMode;
1541
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001542 RT_TRACE(COMP_SWBW, "%s() Switch to %s bandwidth\n", __func__,
Xenia Ragiadakou4a8d1132013-06-09 14:38:43 +03001543 priv->CurrentChannelBW == HT_CHANNEL_WIDTH_20?"20MHz":"40MHz");
Jerry Chuang8fc85982009-11-03 07:17:11 -02001544
1545
Xenia Ragiadakou1111b872013-06-15 07:29:04 +03001546 if (priv->rf_chip == RF_PSEUDO_11N) {
Xenia Ragiadakouec5d3192013-06-18 05:29:36 +03001547 priv->SetBWModeInProgress = false;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001548 return;
1549 }
1550
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +03001551 /* <1> Set MAC register */
Xenia Ragiadakoub3d42bf2013-06-06 16:40:51 +03001552 read_nic_byte(dev, BW_OPMODE, &regBwOpMode);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001553
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +03001554 switch (priv->CurrentChannelBW) {
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001555 case HT_CHANNEL_WIDTH_20:
1556 regBwOpMode |= BW_OPMODE_20MHZ;
1557 /* We have not verify whether this register works */
1558 write_nic_byte(dev, BW_OPMODE, regBwOpMode);
1559 break;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001560
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001561 case HT_CHANNEL_WIDTH_20_40:
1562 regBwOpMode &= ~BW_OPMODE_20MHZ;
1563 /* We have not verify whether this register works */
1564 write_nic_byte(dev, BW_OPMODE, regBwOpMode);
1565 break;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001566
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001567 default:
1568 RT_TRACE(COMP_ERR,
1569 "SetChannelBandwidth819xUsb(): unknown Bandwidth: %#X\n",
1570 priv->CurrentChannelBW);
1571 break;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001572 }
1573
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +03001574 /* <2> Set PHY related register */
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +03001575 switch (priv->CurrentChannelBW) {
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001576 case HT_CHANNEL_WIDTH_20:
1577 rtl8192_setBBreg(dev, rFPGA0_RFMOD, bRFMOD, 0x0);
1578 rtl8192_setBBreg(dev, rFPGA1_RFMOD, bRFMOD, 0x0);
1579 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter1,
1580 0x00100000, 1);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001581
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001582 /* Correct the tx power for CCK rate in 20M. */
1583 priv->cck_present_attentuation =
1584 priv->cck_present_attentuation_20Mdefault +
1585 priv->cck_present_attentuation_difference;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001586
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001587 if (priv->cck_present_attentuation > 22)
1588 priv->cck_present_attentuation = 22;
1589 if (priv->cck_present_attentuation < 0)
1590 priv->cck_present_attentuation = 0;
1591 RT_TRACE(COMP_INIT,
1592 "20M, pHalData->CCKPresentAttentuation = %d\n",
1593 priv->cck_present_attentuation);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001594
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001595 if (priv->chan == 14 && !priv->bcck_in_ch14) {
1596 priv->bcck_in_ch14 = TRUE;
1597 dm_cck_txpower_adjust(dev, priv->bcck_in_ch14);
1598 } else if (priv->chan != 14 && priv->bcck_in_ch14) {
1599 priv->bcck_in_ch14 = FALSE;
1600 dm_cck_txpower_adjust(dev, priv->bcck_in_ch14);
1601 } else {
1602 dm_cck_txpower_adjust(dev, priv->bcck_in_ch14);
1603 }
Jerry Chuang8fc85982009-11-03 07:17:11 -02001604
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001605 break;
1606 case HT_CHANNEL_WIDTH_20_40:
1607 rtl8192_setBBreg(dev, rFPGA0_RFMOD, bRFMOD, 0x1);
1608 rtl8192_setBBreg(dev, rFPGA1_RFMOD, bRFMOD, 0x1);
1609 rtl8192_setBBreg(dev, rCCK0_System, bCCKSideBand,
1610 priv->nCur40MhzPrimeSC>>1);
1611 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter1, 0x00100000, 0);
1612 rtl8192_setBBreg(dev, rOFDM1_LSTF, 0xC00,
1613 priv->nCur40MhzPrimeSC);
1614 priv->cck_present_attentuation =
1615 priv->cck_present_attentuation_40Mdefault +
1616 priv->cck_present_attentuation_difference;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001617
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001618 if (priv->cck_present_attentuation > 22)
1619 priv->cck_present_attentuation = 22;
1620 if (priv->cck_present_attentuation < 0)
1621 priv->cck_present_attentuation = 0;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001622
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001623 RT_TRACE(COMP_INIT,
1624 "40M, pHalData->CCKPresentAttentuation = %d\n",
1625 priv->cck_present_attentuation);
1626 if (priv->chan == 14 && !priv->bcck_in_ch14) {
1627 priv->bcck_in_ch14 = true;
1628 dm_cck_txpower_adjust(dev, priv->bcck_in_ch14);
1629 } else if (priv->chan != 14 && priv->bcck_in_ch14) {
1630 priv->bcck_in_ch14 = false;
1631 dm_cck_txpower_adjust(dev, priv->bcck_in_ch14);
1632 } else {
1633 dm_cck_txpower_adjust(dev, priv->bcck_in_ch14);
1634 }
Jerry Chuang8fc85982009-11-03 07:17:11 -02001635
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001636 break;
1637 default:
1638 RT_TRACE(COMP_ERR,
1639 "SetChannelBandwidth819xUsb(): unknown Bandwidth: %#X\n",
1640 priv->CurrentChannelBW);
1641 break;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001642
1643 }
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +03001644 /* Skip over setting of J-mode in BB register here.
1645 Default value is "None J mode". */
Jerry Chuang8fc85982009-11-03 07:17:11 -02001646
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +03001647 /* <3> Set RF related register */
Xenia Ragiadakouceb56592013-06-15 07:29:07 +03001648 switch (priv->rf_chip) {
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001649 case RF_8225:
Jerry Chuang8fc85982009-11-03 07:17:11 -02001650#ifdef TO_DO_LIST
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001651 PHY_SetRF8225Bandwidth(Adapter, pHalData->CurrentChannelBW);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001652#endif
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001653 break;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001654
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001655 case RF_8256:
1656 PHY_SetRF8256Bandwidth(dev, priv->CurrentChannelBW);
1657 break;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001658
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001659 case RF_8258:
1660 break;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001661
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001662 case RF_PSEUDO_11N:
1663 break;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001664
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001665 default:
1666 RT_TRACE(COMP_ERR, "Unknown RFChipID: %d\n", priv->rf_chip);
1667 break;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001668 }
Xenia Ragiadakouec5d3192013-06-18 05:29:36 +03001669 priv->SetBWModeInProgress = false;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001670
Xenia Ragiadakou0081fcc2013-06-25 02:28:57 +03001671 RT_TRACE(COMP_SWBW, "<==SetBWMode819xUsb(), %d\n",
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001672 atomic_read(&priv->ieee80211->atm_swbw));
Jerry Chuang8fc85982009-11-03 07:17:11 -02001673}
1674
1675/******************************************************************************
Xenia Ragiadakou5f2392b2013-06-19 04:58:07 +03001676 * function: This function schedules bandwidth switch work.
1677 * input: struct net_deviceq *dev
1678 * HT_CHANNEL_WIDTH bandwidth //20M or 40M
1679 * HT_EXTCHNL_OFFSET offset //Upper, Lower, or Don't care
1680 * output: none
1681 * return: none
1682 * notice: I doubt whether SetBWModeInProgress flag is necessary as we can
1683 * test whether current work in the queue or not.//do I?
1684 *****************************************************************************/
Xenia Ragiadakou79931632013-06-18 05:29:41 +03001685void rtl8192_SetBWMode(struct net_device *dev, HT_CHANNEL_WIDTH bandwidth,
1686 HT_EXTCHNL_OFFSET offset)
Jerry Chuang8fc85982009-11-03 07:17:11 -02001687{
1688 struct r8192_priv *priv = ieee80211_priv(dev);
1689
Xenia Ragiadakou1111b872013-06-15 07:29:04 +03001690 if (priv->SetBWModeInProgress)
Jerry Chuang8fc85982009-11-03 07:17:11 -02001691 return;
Xenia Ragiadakouec5d3192013-06-18 05:29:36 +03001692 priv->SetBWModeInProgress = true;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001693
Xenia Ragiadakou79931632013-06-18 05:29:41 +03001694 priv->CurrentChannelBW = bandwidth;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001695
Xenia Ragiadakou79931632013-06-18 05:29:41 +03001696 if (offset == HT_EXTCHNL_OFFSET_LOWER)
Jerry Chuang8fc85982009-11-03 07:17:11 -02001697 priv->nCur40MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_UPPER;
Xenia Ragiadakou79931632013-06-18 05:29:41 +03001698 else if (offset == HT_EXTCHNL_OFFSET_UPPER)
Jerry Chuang8fc85982009-11-03 07:17:11 -02001699 priv->nCur40MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_LOWER;
1700 else
1701 priv->nCur40MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_DONT_CARE;
1702
Jerry Chuang8fc85982009-11-03 07:17:11 -02001703 rtl8192_SetBWModeWorkItem(dev);
1704
1705}
1706
1707void InitialGain819xUsb(struct net_device *dev, u8 Operation)
1708{
1709 struct r8192_priv *priv = ieee80211_priv(dev);
1710
1711 priv->InitialGainOperateType = Operation;
1712
Xenia Ragiadakou1111b872013-06-15 07:29:04 +03001713 if (priv->up)
Xenia Ragiadakou83e6d9e2013-06-19 04:58:06 +03001714 queue_delayed_work(priv->priv_wq, &priv->initialgain_operate_wq, 0);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001715}
1716
Teodora Balutaa115ee42013-10-16 23:53:32 +03001717void InitialGainOperateWorkItemCallBack(struct work_struct *work)
Jerry Chuang8fc85982009-11-03 07:17:11 -02001718{
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001719 struct delayed_work *dwork = container_of(work, struct delayed_work,
1720 work);
1721 struct r8192_priv *priv = container_of(dwork, struct r8192_priv,
1722 initialgain_operate_wq);
1723 struct net_device *dev = priv->ieee80211->dev;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001724#define SCAN_RX_INITIAL_GAIN 0x17
1725#define POWER_DETECTION_TH 0x08
Xenia Ragiadakou9f66ddb2013-06-18 05:29:40 +03001726 u32 bitmask;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001727 u8 initial_gain;
1728 u8 Operation;
1729
1730 Operation = priv->InitialGainOperateType;
1731
Xenia Ragiadakou4a6094c2013-06-15 07:29:02 +03001732 switch (Operation) {
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001733 case IG_Backup:
1734 RT_TRACE(COMP_SCAN, "IG_Backup, backup the initial gain.\n");
1735 initial_gain = SCAN_RX_INITIAL_GAIN;
1736 bitmask = bMaskByte0;
1737 if (dm_digtable.dig_algorithm == DIG_ALGO_BY_FALSE_ALARM)
1738 /* FW DIG OFF */
1739 rtl8192_setBBreg(dev, UFWP, bMaskByte1, 0x8);
1740 priv->initgain_backup.xaagccore1 =
1741 (u8)rtl8192_QueryBBReg(dev, rOFDM0_XAAGCCore1, bitmask);
1742 priv->initgain_backup.xbagccore1 =
1743 (u8)rtl8192_QueryBBReg(dev, rOFDM0_XBAGCCore1, bitmask);
1744 priv->initgain_backup.xcagccore1 =
1745 (u8)rtl8192_QueryBBReg(dev, rOFDM0_XCAGCCore1, bitmask);
1746 priv->initgain_backup.xdagccore1 =
1747 (u8)rtl8192_QueryBBReg(dev, rOFDM0_XDAGCCore1, bitmask);
1748 bitmask = bMaskByte2;
1749 priv->initgain_backup.cca =
1750 (u8)rtl8192_QueryBBReg(dev, rCCK0_CCA, bitmask);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001751
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001752 RT_TRACE(COMP_SCAN, "Scan InitialGainBackup 0xc50 is %x\n",
1753 priv->initgain_backup.xaagccore1);
1754 RT_TRACE(COMP_SCAN, "Scan InitialGainBackup 0xc58 is %x\n",
1755 priv->initgain_backup.xbagccore1);
1756 RT_TRACE(COMP_SCAN, "Scan InitialGainBackup 0xc60 is %x\n",
1757 priv->initgain_backup.xcagccore1);
1758 RT_TRACE(COMP_SCAN, "Scan InitialGainBackup 0xc68 is %x\n",
1759 priv->initgain_backup.xdagccore1);
1760 RT_TRACE(COMP_SCAN, "Scan InitialGainBackup 0xa0a is %x\n",
1761 priv->initgain_backup.cca);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001762
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001763 RT_TRACE(COMP_SCAN, "Write scan initial gain = 0x%x \n",
1764 initial_gain);
1765 write_nic_byte(dev, rOFDM0_XAAGCCore1, initial_gain);
1766 write_nic_byte(dev, rOFDM0_XBAGCCore1, initial_gain);
1767 write_nic_byte(dev, rOFDM0_XCAGCCore1, initial_gain);
1768 write_nic_byte(dev, rOFDM0_XDAGCCore1, initial_gain);
1769 RT_TRACE(COMP_SCAN, "Write scan 0xa0a = 0x%x \n",
1770 POWER_DETECTION_TH);
1771 write_nic_byte(dev, 0xa0a, POWER_DETECTION_TH);
1772 break;
1773 case IG_Restore:
1774 RT_TRACE(COMP_SCAN, "IG_Restore, restore the initial gain.\n");
1775 bitmask = 0x7f; /* Bit0 ~ Bit6 */
1776 if (dm_digtable.dig_algorithm == DIG_ALGO_BY_FALSE_ALARM)
1777 /* FW DIG OFF */
1778 rtl8192_setBBreg(dev, UFWP, bMaskByte1, 0x8);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001779
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001780 rtl8192_setBBreg(dev, rOFDM0_XAAGCCore1, bitmask,
1781 (u32)priv->initgain_backup.xaagccore1);
1782 rtl8192_setBBreg(dev, rOFDM0_XBAGCCore1, bitmask,
1783 (u32)priv->initgain_backup.xbagccore1);
1784 rtl8192_setBBreg(dev, rOFDM0_XCAGCCore1, bitmask,
1785 (u32)priv->initgain_backup.xcagccore1);
1786 rtl8192_setBBreg(dev, rOFDM0_XDAGCCore1, bitmask,
1787 (u32)priv->initgain_backup.xdagccore1);
1788 bitmask = bMaskByte2;
1789 rtl8192_setBBreg(dev, rCCK0_CCA, bitmask,
1790 (u32)priv->initgain_backup.cca);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001791
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001792 RT_TRACE(COMP_SCAN, "Scan BBInitialGainRestore 0xc50 is %x\n",
1793 priv->initgain_backup.xaagccore1);
1794 RT_TRACE(COMP_SCAN, "Scan BBInitialGainRestore 0xc58 is %x\n",
1795 priv->initgain_backup.xbagccore1);
1796 RT_TRACE(COMP_SCAN, "Scan BBInitialGainRestore 0xc60 is %x\n",
1797 priv->initgain_backup.xcagccore1);
1798 RT_TRACE(COMP_SCAN, "Scan BBInitialGainRestore 0xc68 is %x\n",
1799 priv->initgain_backup.xdagccore1);
1800 RT_TRACE(COMP_SCAN, "Scan BBInitialGainRestore 0xa0a is %x\n",
1801 priv->initgain_backup.cca);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001802
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001803 rtl8192_phy_setTxPower(dev, priv->ieee80211->current_network.channel);
Jerry Chuang8fc85982009-11-03 07:17:11 -02001804
Xenia Ragiadakou1db5aa02013-06-23 06:15:15 +03001805 if (dm_digtable.dig_algorithm == DIG_ALGO_BY_FALSE_ALARM)
1806 /* FW DIG ON */
1807 rtl8192_setBBreg(dev, UFWP, bMaskByte1, 0x1);
1808 break;
1809 default:
1810 RT_TRACE(COMP_SCAN, "Unknown IG Operation. \n");
1811 break;
Jerry Chuang8fc85982009-11-03 07:17:11 -02001812 }
1813}