]> git.kernelconcepts.de Git - karo-tx-linux.git/blob - drivers/staging/rtl8188eu/hal/usb_halinit.c
c5559dfa4e92d1ea35b894cee475e6d8cb9f9cd4
[karo-tx-linux.git] / drivers / staging / rtl8188eu / hal / usb_halinit.c
1 /******************************************************************************
2  *
3  * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
4  *
5  * This program is free software; you can redistribute it and/or modify it
6  * under the terms of version 2 of the GNU General Public License as
7  * published by the Free Software Foundation.
8  *
9  * This program is distributed in the hope that it will be useful, but WITHOUT
10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11  * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
12  * more details.
13  *
14  * You should have received a copy of the GNU General Public License along with
15  * this program; if not, write to the Free Software Foundation, Inc.,
16  * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
17  *
18  *
19  ******************************************************************************/
20 #define _HCI_HAL_INIT_C_
21
22 #include <osdep_service.h>
23 #include <drv_types.h>
24 #include <rtw_efuse.h>
25 #include <fw.h>
26 #include <rtl8188e_hal.h>
27 #include <rtl8188e_led.h>
28 #include <rtw_iol.h>
29 #include <usb_hal.h>
30 #include <phy.h>
31
32 #define         HAL_BB_ENABLE           1
33
34 static void _ConfigNormalChipOutEP_8188E(struct adapter *adapt, u8 NumOutPipe)
35 {
36         struct hal_data_8188e   *haldata        = GET_HAL_DATA(adapt);
37
38         switch (NumOutPipe) {
39         case    3:
40                 haldata->OutEpQueueSel = TX_SELE_HQ | TX_SELE_LQ | TX_SELE_NQ;
41                 haldata->OutEpNumber = 3;
42                 break;
43         case    2:
44                 haldata->OutEpQueueSel = TX_SELE_HQ | TX_SELE_NQ;
45                 haldata->OutEpNumber = 2;
46                 break;
47         case    1:
48                 haldata->OutEpQueueSel = TX_SELE_HQ;
49                 haldata->OutEpNumber = 1;
50                 break;
51         default:
52                 break;
53         }
54         DBG_88E("%s OutEpQueueSel(0x%02x), OutEpNumber(%d)\n", __func__, haldata->OutEpQueueSel, haldata->OutEpNumber);
55 }
56
57 static bool HalUsbSetQueuePipeMapping8188EUsb(struct adapter *adapt, u8 NumInPipe, u8 NumOutPipe)
58 {
59         struct hal_data_8188e   *haldata        = GET_HAL_DATA(adapt);
60         bool                    result          = false;
61
62         _ConfigNormalChipOutEP_8188E(adapt, NumOutPipe);
63
64         /*  Normal chip with one IN and one OUT doesn't have interrupt IN EP. */
65         if (1 == haldata->OutEpNumber) {
66                 if (1 != NumInPipe)
67                         return result;
68         }
69
70         /*  All config other than above support one Bulk IN and one Interrupt IN. */
71
72         result = Hal_MappingOutPipe(adapt, NumOutPipe);
73
74         return result;
75 }
76
77 static void rtl8188eu_interface_configure(struct adapter *adapt)
78 {
79         struct hal_data_8188e   *haldata        = GET_HAL_DATA(adapt);
80         struct dvobj_priv       *pdvobjpriv = adapter_to_dvobj(adapt);
81
82         if (pdvobjpriv->ishighspeed)
83                 haldata->UsbBulkOutSize = USB_HIGH_SPEED_BULK_SIZE;/* 512 bytes */
84         else
85                 haldata->UsbBulkOutSize = USB_FULL_SPEED_BULK_SIZE;/* 64 bytes */
86
87         haldata->interfaceIndex = pdvobjpriv->InterfaceNumber;
88
89         haldata->UsbTxAggMode           = 1;
90         haldata->UsbTxAggDescNum        = 0x6;  /*  only 4 bits */
91
92         haldata->UsbRxAggMode           = USB_RX_AGG_DMA;/*  USB_RX_AGG_DMA; */
93         haldata->UsbRxAggBlockCount     = 8; /* unit : 512b */
94         haldata->UsbRxAggBlockTimeout   = 0x6;
95         haldata->UsbRxAggPageCount      = 48; /* uint :128 b 0x0A;      10 = MAX_RX_DMA_BUFFER_SIZE/2/haldata->UsbBulkOutSize */
96         haldata->UsbRxAggPageTimeout    = 0x4; /* 6, absolute time = 34ms/(2^6) */
97
98         HalUsbSetQueuePipeMapping8188EUsb(adapt,
99                                 pdvobjpriv->RtNumInPipes, pdvobjpriv->RtNumOutPipes);
100 }
101
102 static u32 rtl8188eu_InitPowerOn(struct adapter *adapt)
103 {
104         u16 value16;
105         /*  HW Power on sequence */
106         struct hal_data_8188e   *haldata        = GET_HAL_DATA(adapt);
107         if (haldata->bMacPwrCtrlOn)
108                 return _SUCCESS;
109
110         if (!HalPwrSeqCmdParsing(adapt, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, Rtl8188E_NIC_PWR_ON_FLOW)) {
111                 DBG_88E(KERN_ERR "%s: run power on flow fail\n", __func__);
112                 return _FAIL;
113         }
114
115         /*  Enable MAC DMA/WMAC/SCHEDULE/SEC block */
116         /*  Set CR bit10 to enable 32k calibration. Suggested by SD1 Gimmy. Added by tynli. 2011.08.31. */
117         usb_write16(adapt, REG_CR, 0x00);  /* suggseted by zhouzhou, by page, 20111230 */
118
119                 /*  Enable MAC DMA/WMAC/SCHEDULE/SEC block */
120         value16 = usb_read16(adapt, REG_CR);
121         value16 |= (HCI_TXDMA_EN | HCI_RXDMA_EN | TXDMA_EN | RXDMA_EN
122                                 | PROTOCOL_EN | SCHEDULE_EN | ENSEC | CALTMR_EN);
123         /*  for SDIO - Set CR bit10 to enable 32k calibration. Suggested by SD1 Gimmy. Added by tynli. 2011.08.31. */
124
125         usb_write16(adapt, REG_CR, value16);
126         haldata->bMacPwrCtrlOn = true;
127
128         return _SUCCESS;
129 }
130
131 /*  Shall USB interface init this? */
132 static void _InitInterrupt(struct adapter *Adapter)
133 {
134         u32 imr, imr_ex;
135         u8  usb_opt;
136         struct hal_data_8188e   *haldata = GET_HAL_DATA(Adapter);
137
138         /* HISR write one to clear */
139         usb_write32(Adapter, REG_HISR_88E, 0xFFFFFFFF);
140         /*  HIMR - */
141         imr = IMR_PSTIMEOUT_88E | IMR_TBDER_88E | IMR_CPWM_88E | IMR_CPWM2_88E;
142         usb_write32(Adapter, REG_HIMR_88E, imr);
143         haldata->IntrMask[0] = imr;
144
145         imr_ex = IMR_TXERR_88E | IMR_RXERR_88E | IMR_TXFOVW_88E | IMR_RXFOVW_88E;
146         usb_write32(Adapter, REG_HIMRE_88E, imr_ex);
147         haldata->IntrMask[1] = imr_ex;
148
149         /*  REG_USB_SPECIAL_OPTION - BIT(4) */
150         /*  0; Use interrupt endpoint to upload interrupt pkt */
151         /*  1; Use bulk endpoint to upload interrupt pkt, */
152         usb_opt = usb_read8(Adapter, REG_USB_SPECIAL_OPTION);
153
154         if (!adapter_to_dvobj(Adapter)->ishighspeed)
155                 usb_opt = usb_opt & (~INT_BULK_SEL);
156         else
157                 usb_opt = usb_opt | (INT_BULK_SEL);
158
159         usb_write8(Adapter, REG_USB_SPECIAL_OPTION, usb_opt);
160 }
161
162 static void _InitQueueReservedPage(struct adapter *Adapter)
163 {
164         struct hal_data_8188e           *haldata = GET_HAL_DATA(Adapter);
165         struct registry_priv    *pregistrypriv = &Adapter->registrypriv;
166         u32 numHQ       = 0;
167         u32 numLQ       = 0;
168         u32 numNQ       = 0;
169         u32 numPubQ;
170         u32 value32;
171         u8 value8;
172         bool bWiFiConfig = pregistrypriv->wifi_spec;
173
174         if (bWiFiConfig) {
175                 if (haldata->OutEpQueueSel & TX_SELE_HQ)
176                         numHQ =  0x29;
177
178                 if (haldata->OutEpQueueSel & TX_SELE_LQ)
179                         numLQ = 0x1C;
180
181                 /*  NOTE: This step shall be proceed before writting REG_RQPN. */
182                 if (haldata->OutEpQueueSel & TX_SELE_NQ)
183                         numNQ = 0x1C;
184                 value8 = (u8)_NPQ(numNQ);
185                 usb_write8(Adapter, REG_RQPN_NPQ, value8);
186
187                 numPubQ = 0xA8 - numHQ - numLQ - numNQ;
188
189                 /*  TX DMA */
190                 value32 = _HPQ(numHQ) | _LPQ(numLQ) | _PUBQ(numPubQ) | LD_RQPN;
191                 usb_write32(Adapter, REG_RQPN, value32);
192         } else {
193                 usb_write16(Adapter, REG_RQPN_NPQ, 0x0000);/* Just follow MP Team,??? Georgia 03/28 */
194                 usb_write16(Adapter, REG_RQPN_NPQ, 0x0d);
195                 usb_write32(Adapter, REG_RQPN, 0x808E000d);/* reserve 7 page for LPS */
196         }
197 }
198
199 static void _InitTxBufferBoundary(struct adapter *Adapter, u8 txpktbuf_bndy)
200 {
201         usb_write8(Adapter, REG_TXPKTBUF_BCNQ_BDNY, txpktbuf_bndy);
202         usb_write8(Adapter, REG_TXPKTBUF_MGQ_BDNY, txpktbuf_bndy);
203         usb_write8(Adapter, REG_TXPKTBUF_WMAC_LBK_BF_HD, txpktbuf_bndy);
204         usb_write8(Adapter, REG_TRXFF_BNDY, txpktbuf_bndy);
205         usb_write8(Adapter, REG_TDECTRL+1, txpktbuf_bndy);
206 }
207
208 static void _InitPageBoundary(struct adapter *Adapter)
209 {
210         /*  RX Page Boundary */
211         /*  */
212         u16 rxff_bndy = MAX_RX_DMA_BUFFER_SIZE_88E-1;
213
214         usb_write16(Adapter, (REG_TRXFF_BNDY + 2), rxff_bndy);
215 }
216
217 static void _InitNormalChipRegPriority(struct adapter *Adapter, u16 beQ,
218                                        u16 bkQ, u16 viQ, u16 voQ, u16 mgtQ,
219                                        u16 hiQ)
220 {
221         u16 value16     = (usb_read16(Adapter, REG_TRXDMA_CTRL) & 0x7);
222
223         value16 |= _TXDMA_BEQ_MAP(beQ)  | _TXDMA_BKQ_MAP(bkQ) |
224                    _TXDMA_VIQ_MAP(viQ)  | _TXDMA_VOQ_MAP(voQ) |
225                    _TXDMA_MGQ_MAP(mgtQ) | _TXDMA_HIQ_MAP(hiQ);
226
227         usb_write16(Adapter, REG_TRXDMA_CTRL, value16);
228 }
229
230 static void _InitNormalChipOneOutEpPriority(struct adapter *Adapter)
231 {
232         struct hal_data_8188e   *haldata        = GET_HAL_DATA(Adapter);
233
234         u16 value = 0;
235         switch (haldata->OutEpQueueSel) {
236         case TX_SELE_HQ:
237                 value = QUEUE_HIGH;
238                 break;
239         case TX_SELE_LQ:
240                 value = QUEUE_LOW;
241                 break;
242         case TX_SELE_NQ:
243                 value = QUEUE_NORMAL;
244                 break;
245         default:
246                 break;
247         }
248         _InitNormalChipRegPriority(Adapter, value, value, value, value,
249                                    value, value);
250 }
251
252 static void _InitNormalChipTwoOutEpPriority(struct adapter *Adapter)
253 {
254         struct hal_data_8188e   *haldata        = GET_HAL_DATA(Adapter);
255         struct registry_priv *pregistrypriv = &Adapter->registrypriv;
256         u16 beQ, bkQ, viQ, voQ, mgtQ, hiQ;
257         u16 valueHi = 0;
258         u16 valueLow = 0;
259
260         switch (haldata->OutEpQueueSel) {
261         case (TX_SELE_HQ | TX_SELE_LQ):
262                 valueHi = QUEUE_HIGH;
263                 valueLow = QUEUE_LOW;
264                 break;
265         case (TX_SELE_NQ | TX_SELE_LQ):
266                 valueHi = QUEUE_NORMAL;
267                 valueLow = QUEUE_LOW;
268                 break;
269         case (TX_SELE_HQ | TX_SELE_NQ):
270                 valueHi = QUEUE_HIGH;
271                 valueLow = QUEUE_NORMAL;
272                 break;
273         default:
274                 break;
275         }
276
277         if (!pregistrypriv->wifi_spec) {
278                 beQ     = valueLow;
279                 bkQ     = valueLow;
280                 viQ     = valueHi;
281                 voQ     = valueHi;
282                 mgtQ    = valueHi;
283                 hiQ     = valueHi;
284         } else {/* for WMM ,CONFIG_OUT_EP_WIFI_MODE */
285                 beQ     = valueLow;
286                 bkQ     = valueHi;
287                 viQ     = valueHi;
288                 voQ     = valueLow;
289                 mgtQ    = valueHi;
290                 hiQ     = valueHi;
291         }
292         _InitNormalChipRegPriority(Adapter, beQ, bkQ, viQ, voQ, mgtQ, hiQ);
293 }
294
295 static void _InitNormalChipThreeOutEpPriority(struct adapter *Adapter)
296 {
297         struct registry_priv *pregistrypriv = &Adapter->registrypriv;
298         u16 beQ, bkQ, viQ, voQ, mgtQ, hiQ;
299
300         if (!pregistrypriv->wifi_spec) {/*  typical setting */
301                 beQ     = QUEUE_LOW;
302                 bkQ     = QUEUE_LOW;
303                 viQ     = QUEUE_NORMAL;
304                 voQ     = QUEUE_HIGH;
305                 mgtQ    = QUEUE_HIGH;
306                 hiQ     = QUEUE_HIGH;
307         } else {/*  for WMM */
308                 beQ     = QUEUE_LOW;
309                 bkQ     = QUEUE_NORMAL;
310                 viQ     = QUEUE_NORMAL;
311                 voQ     = QUEUE_HIGH;
312                 mgtQ    = QUEUE_HIGH;
313                 hiQ     = QUEUE_HIGH;
314         }
315         _InitNormalChipRegPriority(Adapter, beQ, bkQ, viQ, voQ, mgtQ, hiQ);
316 }
317
318 static void _InitQueuePriority(struct adapter *Adapter)
319 {
320         struct hal_data_8188e   *haldata = GET_HAL_DATA(Adapter);
321
322         switch (haldata->OutEpNumber) {
323         case 1:
324                 _InitNormalChipOneOutEpPriority(Adapter);
325                 break;
326         case 2:
327                 _InitNormalChipTwoOutEpPriority(Adapter);
328                 break;
329         case 3:
330                 _InitNormalChipThreeOutEpPriority(Adapter);
331                 break;
332         default:
333                 break;
334         }
335 }
336
337 static void _InitNetworkType(struct adapter *Adapter)
338 {
339         u32 value32;
340
341         value32 = usb_read32(Adapter, REG_CR);
342         /*  TODO: use the other function to set network type */
343         value32 = (value32 & ~MASK_NETTYPE) | _NETTYPE(NT_LINK_AP);
344
345         usb_write32(Adapter, REG_CR, value32);
346 }
347
348 static void _InitTransferPageSize(struct adapter *Adapter)
349 {
350         /*  Tx page size is always 128. */
351
352         u8 value8;
353         value8 = _PSRX(PBP_128) | _PSTX(PBP_128);
354         usb_write8(Adapter, REG_PBP, value8);
355 }
356
357 static void _InitDriverInfoSize(struct adapter *Adapter, u8 drvInfoSize)
358 {
359         usb_write8(Adapter, REG_RX_DRVINFO_SZ, drvInfoSize);
360 }
361
362 static void _InitWMACSetting(struct adapter *Adapter)
363 {
364         struct hal_data_8188e   *haldata = GET_HAL_DATA(Adapter);
365
366         haldata->ReceiveConfig = RCR_AAP | RCR_APM | RCR_AM | RCR_AB |
367                                   RCR_CBSSID_DATA | RCR_CBSSID_BCN |
368                                   RCR_APP_ICV | RCR_AMF | RCR_HTC_LOC_CTRL |
369                                   RCR_APP_MIC | RCR_APP_PHYSTS;
370
371         /*  some REG_RCR will be modified later by phy_ConfigMACWithHeaderFile() */
372         usb_write32(Adapter, REG_RCR, haldata->ReceiveConfig);
373
374         /*  Accept all multicast address */
375         usb_write32(Adapter, REG_MAR, 0xFFFFFFFF);
376         usb_write32(Adapter, REG_MAR + 4, 0xFFFFFFFF);
377 }
378
379 static void _InitAdaptiveCtrl(struct adapter *Adapter)
380 {
381         u16 value16;
382         u32 value32;
383
384         /*  Response Rate Set */
385         value32 = usb_read32(Adapter, REG_RRSR);
386         value32 &= ~RATE_BITMAP_ALL;
387         value32 |= RATE_RRSR_CCK_ONLY_1M;
388         usb_write32(Adapter, REG_RRSR, value32);
389
390         /*  CF-END Threshold */
391
392         /*  SIFS (used in NAV) */
393         value16 = _SPEC_SIFS_CCK(0x10) | _SPEC_SIFS_OFDM(0x10);
394         usb_write16(Adapter, REG_SPEC_SIFS, value16);
395
396         /*  Retry Limit */
397         value16 = _LRL(0x30) | _SRL(0x30);
398         usb_write16(Adapter, REG_RL, value16);
399 }
400
401 static void _InitEDCA(struct adapter *Adapter)
402 {
403         /*  Set Spec SIFS (used in NAV) */
404         usb_write16(Adapter, REG_SPEC_SIFS, 0x100a);
405         usb_write16(Adapter, REG_MAC_SPEC_SIFS, 0x100a);
406
407         /*  Set SIFS for CCK */
408         usb_write16(Adapter, REG_SIFS_CTX, 0x100a);
409
410         /*  Set SIFS for OFDM */
411         usb_write16(Adapter, REG_SIFS_TRX, 0x100a);
412
413         /*  TXOP */
414         usb_write32(Adapter, REG_EDCA_BE_PARAM, 0x005EA42B);
415         usb_write32(Adapter, REG_EDCA_BK_PARAM, 0x0000A44F);
416         usb_write32(Adapter, REG_EDCA_VI_PARAM, 0x005EA324);
417         usb_write32(Adapter, REG_EDCA_VO_PARAM, 0x002FA226);
418 }
419
420 static void _InitRDGSetting(struct adapter *Adapter)
421 {
422         usb_write8(Adapter, REG_RD_CTRL, 0xFF);
423         usb_write16(Adapter, REG_RD_NAV_NXT, 0x200);
424         usb_write8(Adapter, REG_RD_RESP_PKT_TH, 0x05);
425 }
426
427 static void _InitRxSetting(struct adapter *Adapter)
428 {
429         usb_write32(Adapter, REG_MACID, 0x87654321);
430         usb_write32(Adapter, 0x0700, 0x87654321);
431 }
432
433 static void _InitRetryFunction(struct adapter *Adapter)
434 {
435         u8 value8;
436
437         value8 = usb_read8(Adapter, REG_FWHW_TXQ_CTRL);
438         value8 |= EN_AMPDU_RTY_NEW;
439         usb_write8(Adapter, REG_FWHW_TXQ_CTRL, value8);
440
441         /*  Set ACK timeout */
442         usb_write8(Adapter, REG_ACKTO, 0x40);
443 }
444
445 /*-----------------------------------------------------------------------------
446  * Function:    usb_AggSettingTxUpdate()
447  *
448  * Overview:    Separate TX/RX parameters update independent for TP detection and
449  *                      dynamic TX/RX aggreagtion parameters update.
450  *
451  * Input:                       struct adapter *
452  *
453  * Output/Return:       NONE
454  *
455  * Revised History:
456  *      When            Who             Remark
457  *      12/10/2010      MHC             Separate to smaller function.
458  *
459  *---------------------------------------------------------------------------*/
460 static void usb_AggSettingTxUpdate(struct adapter *Adapter)
461 {
462         struct hal_data_8188e   *haldata = GET_HAL_DATA(Adapter);
463         u32 value32;
464
465         if (Adapter->registrypriv.wifi_spec)
466                 haldata->UsbTxAggMode = false;
467
468         if (haldata->UsbTxAggMode) {
469                 value32 = usb_read32(Adapter, REG_TDECTRL);
470                 value32 = value32 & ~(BLK_DESC_NUM_MASK << BLK_DESC_NUM_SHIFT);
471                 value32 |= ((haldata->UsbTxAggDescNum & BLK_DESC_NUM_MASK) << BLK_DESC_NUM_SHIFT);
472
473                 usb_write32(Adapter, REG_TDECTRL, value32);
474         }
475 }       /*  usb_AggSettingTxUpdate */
476
477 /*-----------------------------------------------------------------------------
478  * Function:    usb_AggSettingRxUpdate()
479  *
480  * Overview:    Separate TX/RX parameters update independent for TP detection and
481  *                      dynamic TX/RX aggreagtion parameters update.
482  *
483  * Input:                       struct adapter *
484  *
485  * Output/Return:       NONE
486  *
487  * Revised History:
488  *      When            Who             Remark
489  *      12/10/2010      MHC             Separate to smaller function.
490  *
491  *---------------------------------------------------------------------------*/
492 static void
493 usb_AggSettingRxUpdate(
494                 struct adapter *Adapter
495         )
496 {
497         struct hal_data_8188e   *haldata = GET_HAL_DATA(Adapter);
498         u8 valueDMA;
499         u8 valueUSB;
500
501         valueDMA = usb_read8(Adapter, REG_TRXDMA_CTRL);
502         valueUSB = usb_read8(Adapter, REG_USB_SPECIAL_OPTION);
503
504         switch (haldata->UsbRxAggMode) {
505         case USB_RX_AGG_DMA:
506                 valueDMA |= RXDMA_AGG_EN;
507                 valueUSB &= ~USB_AGG_EN;
508                 break;
509         case USB_RX_AGG_USB:
510                 valueDMA &= ~RXDMA_AGG_EN;
511                 valueUSB |= USB_AGG_EN;
512                 break;
513         case USB_RX_AGG_MIX:
514                 valueDMA |= RXDMA_AGG_EN;
515                 valueUSB |= USB_AGG_EN;
516                 break;
517         case USB_RX_AGG_DISABLE:
518         default:
519                 valueDMA &= ~RXDMA_AGG_EN;
520                 valueUSB &= ~USB_AGG_EN;
521                 break;
522         }
523
524         usb_write8(Adapter, REG_TRXDMA_CTRL, valueDMA);
525         usb_write8(Adapter, REG_USB_SPECIAL_OPTION, valueUSB);
526
527         switch (haldata->UsbRxAggMode) {
528         case USB_RX_AGG_DMA:
529                 usb_write8(Adapter, REG_RXDMA_AGG_PG_TH, haldata->UsbRxAggPageCount);
530                 usb_write8(Adapter, REG_RXDMA_AGG_PG_TH+1, haldata->UsbRxAggPageTimeout);
531                 break;
532         case USB_RX_AGG_USB:
533                 usb_write8(Adapter, REG_USB_AGG_TH, haldata->UsbRxAggBlockCount);
534                 usb_write8(Adapter, REG_USB_AGG_TO, haldata->UsbRxAggBlockTimeout);
535                 break;
536         case USB_RX_AGG_MIX:
537                 usb_write8(Adapter, REG_RXDMA_AGG_PG_TH, haldata->UsbRxAggPageCount);
538                 usb_write8(Adapter, REG_RXDMA_AGG_PG_TH+1, (haldata->UsbRxAggPageTimeout & 0x1F));/* 0x280[12:8] */
539                 usb_write8(Adapter, REG_USB_AGG_TH, haldata->UsbRxAggBlockCount);
540                 usb_write8(Adapter, REG_USB_AGG_TO, haldata->UsbRxAggBlockTimeout);
541                 break;
542         case USB_RX_AGG_DISABLE:
543         default:
544                 /*  TODO: */
545                 break;
546         }
547
548         switch (PBP_128) {
549         case PBP_128:
550                 haldata->HwRxPageSize = 128;
551                 break;
552         case PBP_64:
553                 haldata->HwRxPageSize = 64;
554                 break;
555         case PBP_256:
556                 haldata->HwRxPageSize = 256;
557                 break;
558         case PBP_512:
559                 haldata->HwRxPageSize = 512;
560                 break;
561         case PBP_1024:
562                 haldata->HwRxPageSize = 1024;
563                 break;
564         default:
565                 break;
566         }
567 }       /*  usb_AggSettingRxUpdate */
568
569 static void InitUsbAggregationSetting(struct adapter *Adapter)
570 {
571         struct hal_data_8188e   *haldata = GET_HAL_DATA(Adapter);
572
573         /*  Tx aggregation setting */
574         usb_AggSettingTxUpdate(Adapter);
575
576         /*  Rx aggregation setting */
577         usb_AggSettingRxUpdate(Adapter);
578
579         /*  201/12/10 MH Add for USB agg mode dynamic switch. */
580         haldata->UsbRxHighSpeedMode = false;
581 }
582
583 static void _InitBeaconParameters(struct adapter *Adapter)
584 {
585         struct hal_data_8188e   *haldata = GET_HAL_DATA(Adapter);
586
587         usb_write16(Adapter, REG_BCN_CTRL, 0x1010);
588
589         /*  TODO: Remove these magic number */
590         usb_write16(Adapter, REG_TBTT_PROHIBIT, 0x6404);/*  ms */
591         usb_write8(Adapter, REG_DRVERLYINT, DRIVER_EARLY_INT_TIME);/*  5ms */
592         usb_write8(Adapter, REG_BCNDMATIM, BCN_DMA_ATIME_INT_TIME); /*  2ms */
593
594         /*  Suggested by designer timchen. Change beacon AIFS to the largest number */
595         /*  beacause test chip does not contension before sending beacon. by tynli. 2009.11.03 */
596         usb_write16(Adapter, REG_BCNTCFG, 0x660F);
597
598         haldata->RegBcnCtrlVal = usb_read8(Adapter, REG_BCN_CTRL);
599         haldata->RegTxPause = usb_read8(Adapter, REG_TXPAUSE);
600         haldata->RegFwHwTxQCtrl = usb_read8(Adapter, REG_FWHW_TXQ_CTRL+2);
601         haldata->RegReg542 = usb_read8(Adapter, REG_TBTT_PROHIBIT+2);
602         haldata->RegCR_1 = usb_read8(Adapter, REG_CR+1);
603 }
604
605 static void _BeaconFunctionEnable(struct adapter *Adapter,
606                                   bool Enable, bool Linked)
607 {
608         usb_write8(Adapter, REG_BCN_CTRL, (BIT4 | BIT3 | BIT1));
609
610         usb_write8(Adapter, REG_RD_CTRL+1, 0x6F);
611 }
612
613 /*  Set CCK and OFDM Block "ON" */
614 static void _BBTurnOnBlock(struct adapter *Adapter)
615 {
616         PHY_SetBBReg(Adapter, rFPGA0_RFMOD, bCCKEn, 0x1);
617         PHY_SetBBReg(Adapter, rFPGA0_RFMOD, bOFDMEn, 0x1);
618 }
619
620 enum {
621         Antenna_Lfet = 1,
622         Antenna_Right = 2,
623 };
624
625 static void _InitAntenna_Selection(struct adapter *Adapter)
626 {
627         struct hal_data_8188e   *haldata        = GET_HAL_DATA(Adapter);
628
629         if (haldata->AntDivCfg == 0)
630                 return;
631         DBG_88E("==>  %s ....\n", __func__);
632
633         usb_write32(Adapter, REG_LEDCFG0, usb_read32(Adapter, REG_LEDCFG0)|BIT23);
634         PHY_SetBBReg(Adapter, rFPGA0_XAB_RFParameter, BIT13, 0x01);
635
636         if (PHY_QueryBBReg(Adapter, rFPGA0_XA_RFInterfaceOE, 0x300) == Antenna_A)
637                 haldata->CurAntenna = Antenna_A;
638         else
639                 haldata->CurAntenna = Antenna_B;
640         DBG_88E("%s,Cur_ant:(%x)%s\n", __func__, haldata->CurAntenna, (haldata->CurAntenna == Antenna_A) ? "Antenna_A" : "Antenna_B");
641 }
642
643 /*-----------------------------------------------------------------------------
644  * Function:    HwSuspendModeEnable92Cu()
645  *
646  * Overview:    HW suspend mode switch.
647  *
648  * Input:               NONE
649  *
650  * Output:      NONE
651  *
652  * Return:      NONE
653  *
654  * Revised History:
655  *      When            Who             Remark
656  *      08/23/2010      MHC             HW suspend mode switch test..
657  *---------------------------------------------------------------------------*/
658 enum rt_rf_power_state RfOnOffDetect(struct adapter *adapt)
659 {
660         u8 val8;
661         enum rt_rf_power_state rfpowerstate = rf_off;
662
663         if (adapt->pwrctrlpriv.bHWPowerdown) {
664                 val8 = usb_read8(adapt, REG_HSISR);
665                 DBG_88E("pwrdown, 0x5c(BIT7)=%02x\n", val8);
666                 rfpowerstate = (val8 & BIT7) ? rf_off : rf_on;
667         } else { /*  rf on/off */
668                 usb_write8(adapt, REG_MAC_PINMUX_CFG, usb_read8(adapt, REG_MAC_PINMUX_CFG)&~(BIT3));
669                 val8 = usb_read8(adapt, REG_GPIO_IO_SEL);
670                 DBG_88E("GPIO_IN=%02x\n", val8);
671                 rfpowerstate = (val8 & BIT3) ? rf_on : rf_off;
672         }
673         return rfpowerstate;
674 }       /*  HalDetectPwrDownMode */
675
676 static u32 rtl8188eu_hal_init(struct adapter *Adapter)
677 {
678         u8 value8 = 0;
679         u16  value16;
680         u8 txpktbuf_bndy;
681         u32 status = _SUCCESS;
682         struct hal_data_8188e           *haldata = GET_HAL_DATA(Adapter);
683         struct pwrctrl_priv             *pwrctrlpriv = &Adapter->pwrctrlpriv;
684         struct registry_priv    *pregistrypriv = &Adapter->registrypriv;
685         u32 init_start_time = jiffies;
686
687         #define HAL_INIT_PROFILE_TAG(stage) do {} while (0)
688
689
690         HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_BEGIN);
691
692         if (Adapter->pwrctrlpriv.bkeepfwalive) {
693
694                 if (haldata->odmpriv.RFCalibrateInfo.bIQKInitialized) {
695                         PHY_IQCalibrate_8188E(Adapter, true);
696                 } else {
697                         PHY_IQCalibrate_8188E(Adapter, false);
698                         haldata->odmpriv.RFCalibrateInfo.bIQKInitialized = true;
699                 }
700
701                 ODM_TXPowerTrackingCheck(&haldata->odmpriv);
702                 PHY_LCCalibrate_8188E(Adapter);
703
704                 goto exit;
705         }
706
707         HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_INIT_PW_ON);
708         status = rtl8188eu_InitPowerOn(Adapter);
709         if (status == _FAIL) {
710                 RT_TRACE(_module_hci_hal_init_c_, _drv_err_, ("Failed to init power on!\n"));
711                 goto exit;
712         }
713
714         /*  Save target channel */
715         haldata->CurrentChannel = 6;/* default set to 6 */
716
717         if (pwrctrlpriv->reg_rfoff) {
718                 pwrctrlpriv->rf_pwrstate = rf_off;
719         }
720
721         /*  2010/08/09 MH We need to check if we need to turnon or off RF after detecting */
722         /*  HW GPIO pin. Before PHY_RFConfig8192C. */
723         /*  2010/08/26 MH If Efuse does not support sective suspend then disable the function. */
724
725         if (!pregistrypriv->wifi_spec) {
726                 txpktbuf_bndy = TX_PAGE_BOUNDARY_88E;
727         } else {
728                 /*  for WMM */
729                 txpktbuf_bndy = WMM_NORMAL_TX_PAGE_BOUNDARY_88E;
730         }
731
732         HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_MISC01);
733         _InitQueueReservedPage(Adapter);
734         _InitQueuePriority(Adapter);
735         _InitPageBoundary(Adapter);
736         _InitTransferPageSize(Adapter);
737
738         _InitTxBufferBoundary(Adapter, 0);
739
740         HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_DOWNLOAD_FW);
741         if (Adapter->registrypriv.mp_mode == 1) {
742                 _InitRxSetting(Adapter);
743                 Adapter->bFWReady = false;
744                 haldata->fw_ractrl = false;
745         } else {
746                 status = rtl88e_download_fw(Adapter);
747
748                 if (status) {
749                         DBG_88E("%s: Download Firmware failed!!\n", __func__);
750                         Adapter->bFWReady = false;
751                         haldata->fw_ractrl = false;
752                         return status;
753                 } else {
754                         RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("Initializeadapt8192CSdio(): Download Firmware Success!!\n"));
755                         Adapter->bFWReady = true;
756                         haldata->fw_ractrl = false;
757                 }
758         }
759         rtl8188e_InitializeFirmwareVars(Adapter);
760
761         rtl88e_phy_mac_config(Adapter);
762
763         rtl88e_phy_bb_config(Adapter);
764
765         rtl88e_phy_rf_config(Adapter);
766
767         HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_EFUSE_PATCH);
768         status = rtl8188e_iol_efuse_patch(Adapter);
769         if (status == _FAIL) {
770                 DBG_88E("%s  rtl8188e_iol_efuse_patch failed\n", __func__);
771                 goto exit;
772         }
773
774         _InitTxBufferBoundary(Adapter, txpktbuf_bndy);
775
776         HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_INIT_LLTT);
777         status =  InitLLTTable(Adapter, txpktbuf_bndy);
778         if (status == _FAIL) {
779                 RT_TRACE(_module_hci_hal_init_c_, _drv_err_, ("Failed to init LLT table\n"));
780                 goto exit;
781         }
782
783         HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_MISC02);
784         /*  Get Rx PHY status in order to report RSSI and others. */
785         _InitDriverInfoSize(Adapter, DRVINFO_SZ);
786
787         _InitInterrupt(Adapter);
788         hal_init_macaddr(Adapter);/* set mac_address */
789         _InitNetworkType(Adapter);/* set msr */
790         _InitWMACSetting(Adapter);
791         _InitAdaptiveCtrl(Adapter);
792         _InitEDCA(Adapter);
793         _InitRetryFunction(Adapter);
794         InitUsbAggregationSetting(Adapter);
795         _InitBeaconParameters(Adapter);
796         /*  Init CR MACTXEN, MACRXEN after setting RxFF boundary REG_TRXFF_BNDY to patch */
797         /*  Hw bug which Hw initials RxFF boundary size to a value which is larger than the real Rx buffer size in 88E. */
798         /*  Enable MACTXEN/MACRXEN block */
799         value16 = usb_read16(Adapter, REG_CR);
800         value16 |= (MACTXEN | MACRXEN);
801         usb_write8(Adapter, REG_CR, value16);
802
803         if (haldata->bRDGEnable)
804                 _InitRDGSetting(Adapter);
805
806         /* Enable TX Report */
807         /* Enable Tx Report Timer */
808         value8 = usb_read8(Adapter, REG_TX_RPT_CTRL);
809         usb_write8(Adapter,  REG_TX_RPT_CTRL, (value8|BIT1|BIT0));
810         /* Set MAX RPT MACID */
811         usb_write8(Adapter,  REG_TX_RPT_CTRL+1, 2);/* FOR sta mode ,0: bc/mc ,1:AP */
812         /* Tx RPT Timer. Unit: 32us */
813         usb_write16(Adapter, REG_TX_RPT_TIME, 0xCdf0);
814
815         usb_write8(Adapter, REG_EARLY_MODE_CONTROL, 0);
816
817         usb_write16(Adapter, REG_PKT_VO_VI_LIFE_TIME, 0x0400);  /*  unit: 256us. 256ms */
818         usb_write16(Adapter, REG_PKT_BE_BK_LIFE_TIME, 0x0400);  /*  unit: 256us. 256ms */
819
820         /* Keep RfRegChnlVal for later use. */
821         haldata->RfRegChnlVal[0] = PHY_QueryRFReg(Adapter, (enum rf_radio_path)0, RF_CHNLBW, bRFRegOffsetMask);
822         haldata->RfRegChnlVal[1] = PHY_QueryRFReg(Adapter, (enum rf_radio_path)1, RF_CHNLBW, bRFRegOffsetMask);
823
824 HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_TURN_ON_BLOCK);
825         _BBTurnOnBlock(Adapter);
826
827 HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_INIT_SECURITY);
828         invalidate_cam_all(Adapter);
829
830 HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_MISC11);
831         /*  2010/12/17 MH We need to set TX power according to EFUSE content at first. */
832         PHY_SetTxPowerLevel8188E(Adapter, haldata->CurrentChannel);
833
834 /*  Move by Neo for USB SS to below setp */
835 /* _RfPowerSave(Adapter); */
836
837         _InitAntenna_Selection(Adapter);
838
839         /*  */
840         /*  Disable BAR, suggested by Scott */
841         /*  2010.04.09 add by hpfan */
842         /*  */
843         usb_write32(Adapter, REG_BAR_MODE_CTRL, 0x0201ffff);
844
845         /*  HW SEQ CTRL */
846         /* set 0x0 to 0xFF by tynli. Default enable HW SEQ NUM. */
847         usb_write8(Adapter, REG_HWSEQ_CTRL, 0xFF);
848
849         if (pregistrypriv->wifi_spec)
850                 usb_write16(Adapter, REG_FAST_EDCA_CTRL, 0);
851
852         /* Nav limit , suggest by scott */
853         usb_write8(Adapter, 0x652, 0x0);
854
855 HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_INIT_HAL_DM);
856         rtl8188e_InitHalDm(Adapter);
857
858         /*  2010/08/11 MH Merge from 8192SE for Minicard init. We need to confirm current radio status */
859         /*  and then decide to enable RF or not.!!!??? For Selective suspend mode. We may not */
860         /*  call initstruct adapter. May cause some problem?? */
861         /*  Fix the bug that Hw/Sw radio off before S3/S4, the RF off action will not be executed */
862         /*  in MgntActSet_RF_State() after wake up, because the value of haldata->eRFPowerState */
863         /*  is the same as eRfOff, we should change it to eRfOn after we config RF parameters. */
864         /*  Added by tynli. 2010.03.30. */
865         pwrctrlpriv->rf_pwrstate = rf_on;
866
867         /*  enable Tx report. */
868         usb_write8(Adapter,  REG_FWHW_TXQ_CTRL+1, 0x0F);
869
870         /*  Suggested by SD1 pisa. Added by tynli. 2011.10.21. */
871         usb_write8(Adapter, REG_EARLY_MODE_CONTROL+3, 0x01);/* Pretx_en, for WEP/TKIP SEC */
872
873         /* tynli_test_tx_report. */
874         usb_write16(Adapter, REG_TX_RPT_TIME, 0x3DF0);
875
876         /* enable tx DMA to drop the redundate data of packet */
877         usb_write16(Adapter, REG_TXDMA_OFFSET_CHK, (usb_read16(Adapter, REG_TXDMA_OFFSET_CHK) | DROP_DATA_EN));
878
879 HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_IQK);
880                 /*  2010/08/26 MH Merge from 8192CE. */
881         if (pwrctrlpriv->rf_pwrstate == rf_on) {
882                 if (haldata->odmpriv.RFCalibrateInfo.bIQKInitialized) {
883                                 PHY_IQCalibrate_8188E(Adapter, true);
884                 } else {
885                         PHY_IQCalibrate_8188E(Adapter, false);
886                         haldata->odmpriv.RFCalibrateInfo.bIQKInitialized = true;
887                 }
888
889 HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_PW_TRACK);
890
891                 ODM_TXPowerTrackingCheck(&haldata->odmpriv);
892
893 HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_LCK);
894                         PHY_LCCalibrate_8188E(Adapter);
895         }
896
897 /* HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_INIT_PABIAS); */
898 /*      _InitPABias(Adapter); */
899         usb_write8(Adapter, REG_USB_HRPWM, 0);
900
901         /* ack for xmit mgmt frames. */
902         usb_write32(Adapter, REG_FWHW_TXQ_CTRL, usb_read32(Adapter, REG_FWHW_TXQ_CTRL)|BIT(12));
903
904 exit:
905 HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_END);
906
907         DBG_88E("%s in %dms\n", __func__, rtw_get_passing_time_ms(init_start_time));
908
909
910         return status;
911 }
912
913 static void CardDisableRTL8188EU(struct adapter *Adapter)
914 {
915         u8 val8;
916         struct hal_data_8188e   *haldata        = GET_HAL_DATA(Adapter);
917
918         RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("CardDisableRTL8188EU\n"));
919
920         /* Stop Tx Report Timer. 0x4EC[Bit1]=b'0 */
921         val8 = usb_read8(Adapter, REG_TX_RPT_CTRL);
922         usb_write8(Adapter, REG_TX_RPT_CTRL, val8&(~BIT1));
923
924         /*  stop rx */
925         usb_write8(Adapter, REG_CR, 0x0);
926
927         /*  Run LPS WL RFOFF flow */
928         HalPwrSeqCmdParsing(Adapter, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, Rtl8188E_NIC_LPS_ENTER_FLOW);
929
930         /*  2. 0x1F[7:0] = 0            turn off RF */
931
932         val8 = usb_read8(Adapter, REG_MCUFWDL);
933         if ((val8 & RAM_DL_SEL) && Adapter->bFWReady) { /* 8051 RAM code */
934                 /*  Reset MCU 0x2[10]=0. */
935                 val8 = usb_read8(Adapter, REG_SYS_FUNC_EN+1);
936                 val8 &= ~BIT(2);        /*  0x2[10], FEN_CPUEN */
937                 usb_write8(Adapter, REG_SYS_FUNC_EN+1, val8);
938         }
939
940         /*  reset MCU ready status */
941         usb_write8(Adapter, REG_MCUFWDL, 0);
942
943         /* YJ,add,111212 */
944         /* Disable 32k */
945         val8 = usb_read8(Adapter, REG_32K_CTRL);
946         usb_write8(Adapter, REG_32K_CTRL, val8&(~BIT0));
947
948         /*  Card disable power action flow */
949         HalPwrSeqCmdParsing(Adapter, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, Rtl8188E_NIC_DISABLE_FLOW);
950
951         /*  Reset MCU IO Wrapper */
952         val8 = usb_read8(Adapter, REG_RSV_CTRL+1);
953         usb_write8(Adapter, REG_RSV_CTRL+1, (val8&(~BIT3)));
954         val8 = usb_read8(Adapter, REG_RSV_CTRL+1);
955         usb_write8(Adapter, REG_RSV_CTRL+1, val8|BIT3);
956
957         /* YJ,test add, 111207. For Power Consumption. */
958         val8 = usb_read8(Adapter, GPIO_IN);
959         usb_write8(Adapter, GPIO_OUT, val8);
960         usb_write8(Adapter, GPIO_IO_SEL, 0xFF);/* Reg0x46 */
961
962         val8 = usb_read8(Adapter, REG_GPIO_IO_SEL);
963         usb_write8(Adapter, REG_GPIO_IO_SEL, (val8<<4));
964         val8 = usb_read8(Adapter, REG_GPIO_IO_SEL+1);
965         usb_write8(Adapter, REG_GPIO_IO_SEL+1, val8|0x0F);/* Reg0x43 */
966         usb_write32(Adapter, REG_BB_PAD_CTRL, 0x00080808);/* set LNA ,TRSW,EX_PA Pin to output mode */
967         haldata->bMacPwrCtrlOn = false;
968         Adapter->bFWReady = false;
969 }
970 static void rtl8192cu_hw_power_down(struct adapter *adapt)
971 {
972         /*  2010/-8/09 MH For power down module, we need to enable register block contrl reg at 0x1c. */
973         /*  Then enable power down control bit of register 0x04 BIT4 and BIT15 as 1. */
974
975         /*  Enable register area 0x0-0xc. */
976         usb_write8(adapt, REG_RSV_CTRL, 0x0);
977         usb_write16(adapt, REG_APS_FSMCO, 0x8812);
978 }
979
980 static u32 rtl8188eu_hal_deinit(struct adapter *Adapter)
981 {
982
983         DBG_88E("==> %s\n", __func__);
984
985         usb_write32(Adapter, REG_HIMR_88E, IMR_DISABLED_88E);
986         usb_write32(Adapter, REG_HIMRE_88E, IMR_DISABLED_88E);
987
988         DBG_88E("bkeepfwalive(%x)\n", Adapter->pwrctrlpriv.bkeepfwalive);
989         if (Adapter->pwrctrlpriv.bkeepfwalive) {
990                 if ((Adapter->pwrctrlpriv.bHWPwrPindetect) && (Adapter->pwrctrlpriv.bHWPowerdown))
991                         rtl8192cu_hw_power_down(Adapter);
992         } else {
993                 if (Adapter->hw_init_completed) {
994                         CardDisableRTL8188EU(Adapter);
995
996                         if ((Adapter->pwrctrlpriv.bHWPwrPindetect) && (Adapter->pwrctrlpriv.bHWPowerdown))
997                                 rtl8192cu_hw_power_down(Adapter);
998                 }
999         }
1000         return _SUCCESS;
1001  }
1002
1003 static unsigned int rtl8188eu_inirp_init(struct adapter *Adapter)
1004 {
1005         u8 i;
1006         struct recv_buf *precvbuf;
1007         uint    status;
1008         struct recv_priv *precvpriv = &(Adapter->recvpriv);
1009
1010         status = _SUCCESS;
1011
1012         RT_TRACE(_module_hci_hal_init_c_, _drv_info_,
1013                  ("===> usb_inirp_init\n"));
1014
1015         precvpriv->ff_hwaddr = RECV_BULK_IN_ADDR;
1016
1017         /* issue Rx irp to receive data */
1018         precvbuf = (struct recv_buf *)precvpriv->precv_buf;
1019         for (i = 0; i < NR_RECVBUFF; i++) {
1020                 if (usb_read_port(Adapter, precvpriv->ff_hwaddr, 0, (unsigned char *)precvbuf) == false) {
1021                         RT_TRACE(_module_hci_hal_init_c_, _drv_err_, ("usb_rx_init: usb_read_port error\n"));
1022                         status = _FAIL;
1023                         goto exit;
1024                 }
1025
1026                 precvbuf++;
1027                 precvpriv->free_recv_buf_queue_cnt--;
1028         }
1029
1030 exit:
1031
1032         RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("<=== usb_inirp_init\n"));
1033
1034
1035         return status;
1036 }
1037
1038 static unsigned int rtl8188eu_inirp_deinit(struct adapter *Adapter)
1039 {
1040         RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("\n ===> usb_rx_deinit\n"));
1041
1042         usb_read_port_cancel(Adapter);
1043
1044         RT_TRACE(_module_hci_hal_init_c_, _drv_info_, ("\n <=== usb_rx_deinit\n"));
1045
1046         return _SUCCESS;
1047 }
1048
1049 /*  */
1050 /*  */
1051 /*      EEPROM/EFUSE Content Parsing */
1052 /*  */
1053 /*  */
1054 static void Hal_EfuseParsePIDVID_8188EU(struct adapter *adapt, u8 *hwinfo, bool AutoLoadFail)
1055 {
1056         struct hal_data_8188e   *haldata = GET_HAL_DATA(adapt);
1057
1058         if (!AutoLoadFail) {
1059                 /*  VID, PID */
1060                 haldata->EEPROMVID = EF2BYTE(*(__le16 *)&hwinfo[EEPROM_VID_88EU]);
1061                 haldata->EEPROMPID = EF2BYTE(*(__le16 *)&hwinfo[EEPROM_PID_88EU]);
1062
1063                 /*  Customer ID, 0x00 and 0xff are reserved for Realtek. */
1064                 haldata->EEPROMCustomerID = *(u8 *)&hwinfo[EEPROM_CUSTOMERID_88E];
1065                 haldata->EEPROMSubCustomerID = EEPROM_Default_SubCustomerID;
1066         } else {
1067                 haldata->EEPROMVID                      = EEPROM_Default_VID;
1068                 haldata->EEPROMPID                      = EEPROM_Default_PID;
1069
1070                 /*  Customer ID, 0x00 and 0xff are reserved for Realtek. */
1071                 haldata->EEPROMCustomerID               = EEPROM_Default_CustomerID;
1072                 haldata->EEPROMSubCustomerID    = EEPROM_Default_SubCustomerID;
1073         }
1074
1075         DBG_88E("VID = 0x%04X, PID = 0x%04X\n", haldata->EEPROMVID, haldata->EEPROMPID);
1076         DBG_88E("Customer ID: 0x%02X, SubCustomer ID: 0x%02X\n", haldata->EEPROMCustomerID, haldata->EEPROMSubCustomerID);
1077 }
1078
1079 static void Hal_EfuseParseMACAddr_8188EU(struct adapter *adapt, u8 *hwinfo, bool AutoLoadFail)
1080 {
1081         u16 i;
1082         u8 sMacAddr[6] = {0x00, 0xE0, 0x4C, 0x81, 0x88, 0x02};
1083         struct eeprom_priv *eeprom = GET_EEPROM_EFUSE_PRIV(adapt);
1084
1085         if (AutoLoadFail) {
1086                 for (i = 0; i < 6; i++)
1087                         eeprom->mac_addr[i] = sMacAddr[i];
1088         } else {
1089                 /* Read Permanent MAC address */
1090                 memcpy(eeprom->mac_addr, &hwinfo[EEPROM_MAC_ADDR_88EU], ETH_ALEN);
1091         }
1092         RT_TRACE(_module_hci_hal_init_c_, _drv_notice_,
1093                  ("Hal_EfuseParseMACAddr_8188EU: Permanent Address = %02x-%02x-%02x-%02x-%02x-%02x\n",
1094                  eeprom->mac_addr[0], eeprom->mac_addr[1],
1095                  eeprom->mac_addr[2], eeprom->mac_addr[3],
1096                  eeprom->mac_addr[4], eeprom->mac_addr[5]));
1097 }
1098
1099 static void
1100 readAdapterInfo_8188EU(
1101                 struct adapter *adapt
1102         )
1103 {
1104         struct eeprom_priv *eeprom = GET_EEPROM_EFUSE_PRIV(adapt);
1105
1106         /* parse the eeprom/efuse content */
1107         Hal_EfuseParseIDCode88E(adapt, eeprom->efuse_eeprom_data);
1108         Hal_EfuseParsePIDVID_8188EU(adapt, eeprom->efuse_eeprom_data, eeprom->bautoload_fail_flag);
1109         Hal_EfuseParseMACAddr_8188EU(adapt, eeprom->efuse_eeprom_data, eeprom->bautoload_fail_flag);
1110
1111         Hal_ReadPowerSavingMode88E(adapt, eeprom->efuse_eeprom_data, eeprom->bautoload_fail_flag);
1112         Hal_ReadTxPowerInfo88E(adapt, eeprom->efuse_eeprom_data, eeprom->bautoload_fail_flag);
1113         Hal_EfuseParseEEPROMVer88E(adapt, eeprom->efuse_eeprom_data, eeprom->bautoload_fail_flag);
1114         rtl8188e_EfuseParseChnlPlan(adapt, eeprom->efuse_eeprom_data, eeprom->bautoload_fail_flag);
1115         Hal_EfuseParseXtal_8188E(adapt, eeprom->efuse_eeprom_data, eeprom->bautoload_fail_flag);
1116         Hal_EfuseParseCustomerID88E(adapt, eeprom->efuse_eeprom_data, eeprom->bautoload_fail_flag);
1117         Hal_ReadAntennaDiversity88E(adapt, eeprom->efuse_eeprom_data, eeprom->bautoload_fail_flag);
1118         Hal_EfuseParseBoardType88E(adapt, eeprom->efuse_eeprom_data, eeprom->bautoload_fail_flag);
1119         Hal_ReadThermalMeter_88E(adapt, eeprom->efuse_eeprom_data, eeprom->bautoload_fail_flag);
1120
1121 }
1122
1123 static void _ReadPROMContent(
1124         struct adapter *Adapter
1125         )
1126 {
1127         struct eeprom_priv *eeprom = GET_EEPROM_EFUSE_PRIV(Adapter);
1128         u8 eeValue;
1129
1130         /* check system boot selection */
1131         eeValue = usb_read8(Adapter, REG_9346CR);
1132         eeprom->EepromOrEfuse           = (eeValue & BOOT_FROM_EEPROM) ? true : false;
1133         eeprom->bautoload_fail_flag     = (eeValue & EEPROM_EN) ? false : true;
1134
1135         DBG_88E("Boot from %s, Autoload %s !\n", (eeprom->EepromOrEfuse ? "EEPROM" : "EFUSE"),
1136                 (eeprom->bautoload_fail_flag ? "Fail" : "OK"));
1137
1138         Hal_InitPGData88E(Adapter);
1139         readAdapterInfo_8188EU(Adapter);
1140 }
1141
1142 static void _ReadRFType(struct adapter *Adapter)
1143 {
1144         struct hal_data_8188e   *haldata = GET_HAL_DATA(Adapter);
1145
1146         haldata->rf_chip = RF_6052;
1147 }
1148
1149 static void _ReadAdapterInfo8188EU(struct adapter *Adapter)
1150 {
1151         u32 start = jiffies;
1152
1153         MSG_88E("====> %s\n", __func__);
1154
1155         _ReadRFType(Adapter);/* rf_chip -> _InitRFType() */
1156         _ReadPROMContent(Adapter);
1157
1158         MSG_88E("<==== %s in %d ms\n", __func__, rtw_get_passing_time_ms(start));
1159 }
1160
1161 #define GPIO_DEBUG_PORT_NUM 0
1162 static void rtl8192cu_trigger_gpio_0(struct adapter *adapt)
1163 {
1164 }
1165
1166 static void ResumeTxBeacon(struct adapter *adapt)
1167 {
1168         struct hal_data_8188e *haldata = GET_HAL_DATA(adapt);
1169
1170         /*  2010.03.01. Marked by tynli. No need to call workitem beacause we record the value */
1171         /*  which should be read from register to a global variable. */
1172
1173         usb_write8(adapt, REG_FWHW_TXQ_CTRL+2, (haldata->RegFwHwTxQCtrl) | BIT6);
1174         haldata->RegFwHwTxQCtrl |= BIT6;
1175         usb_write8(adapt, REG_TBTT_PROHIBIT+1, 0xff);
1176         haldata->RegReg542 |= BIT0;
1177         usb_write8(adapt, REG_TBTT_PROHIBIT+2, haldata->RegReg542);
1178 }
1179
1180 static void StopTxBeacon(struct adapter *adapt)
1181 {
1182         struct hal_data_8188e *haldata = GET_HAL_DATA(adapt);
1183
1184         /*  2010.03.01. Marked by tynli. No need to call workitem beacause we record the value */
1185         /*  which should be read from register to a global variable. */
1186
1187         usb_write8(adapt, REG_FWHW_TXQ_CTRL+2, (haldata->RegFwHwTxQCtrl) & (~BIT6));
1188         haldata->RegFwHwTxQCtrl &= (~BIT6);
1189         usb_write8(adapt, REG_TBTT_PROHIBIT+1, 0x64);
1190         haldata->RegReg542 &= ~(BIT0);
1191         usb_write8(adapt, REG_TBTT_PROHIBIT+2, haldata->RegReg542);
1192
1193          /* todo: CheckFwRsvdPageContent(Adapter);  2010.06.23. Added by tynli. */
1194 }
1195
1196 static void hw_var_set_opmode(struct adapter *Adapter, u8 variable, u8 *val)
1197 {
1198         u8 val8;
1199         u8 mode = *((u8 *)val);
1200
1201         /*  disable Port0 TSF update */
1202         usb_write8(Adapter, REG_BCN_CTRL, usb_read8(Adapter, REG_BCN_CTRL)|BIT(4));
1203
1204         /*  set net_type */
1205         val8 = usb_read8(Adapter, MSR)&0x0c;
1206         val8 |= mode;
1207         usb_write8(Adapter, MSR, val8);
1208
1209         DBG_88E("%s()-%d mode = %d\n", __func__, __LINE__, mode);
1210
1211         if ((mode == _HW_STATE_STATION_) || (mode == _HW_STATE_NOLINK_)) {
1212                 StopTxBeacon(Adapter);
1213
1214                 usb_write8(Adapter, REG_BCN_CTRL, 0x19);/* disable atim wnd */
1215         } else if ((mode == _HW_STATE_ADHOC_)) {
1216                 ResumeTxBeacon(Adapter);
1217                 usb_write8(Adapter, REG_BCN_CTRL, 0x1a);
1218         } else if (mode == _HW_STATE_AP_) {
1219                 ResumeTxBeacon(Adapter);
1220
1221                 usb_write8(Adapter, REG_BCN_CTRL, 0x12);
1222
1223                 /* Set RCR */
1224                 usb_write32(Adapter, REG_RCR, 0x7000208e);/* CBSSID_DATA must set to 0,reject ICV_ERR packet */
1225                 /* enable to rx data frame */
1226                 usb_write16(Adapter, REG_RXFLTMAP2, 0xFFFF);
1227                 /* enable to rx ps-poll */
1228                 usb_write16(Adapter, REG_RXFLTMAP1, 0x0400);
1229
1230                 /* Beacon Control related register for first time */
1231                 usb_write8(Adapter, REG_BCNDMATIM, 0x02); /*  2ms */
1232
1233                 usb_write8(Adapter, REG_ATIMWND, 0x0a); /*  10ms */
1234                 usb_write16(Adapter, REG_BCNTCFG, 0x00);
1235                 usb_write16(Adapter, REG_TBTT_PROHIBIT, 0xff04);
1236                 usb_write16(Adapter, REG_TSFTR_SYN_OFFSET, 0x7fff);/*  +32767 (~32ms) */
1237
1238                 /* reset TSF */
1239                 usb_write8(Adapter, REG_DUAL_TSF_RST, BIT(0));
1240
1241                 /* BIT3 - If set 0, hw will clr bcnq when tx becon ok/fail or port 0 */
1242                 usb_write8(Adapter, REG_MBID_NUM, usb_read8(Adapter, REG_MBID_NUM) | BIT(3) | BIT(4));
1243
1244                 /* enable BCN0 Function for if1 */
1245                 /* don't enable update TSF0 for if1 (due to TSF update when beacon/probe rsp are received) */
1246                 usb_write8(Adapter, REG_BCN_CTRL, (DIS_TSF_UDT0_NORMAL_CHIP|EN_BCN_FUNCTION | BIT(1)));
1247
1248                 /* dis BCN1 ATIM  WND if if2 is station */
1249                 usb_write8(Adapter, REG_BCN_CTRL_1, usb_read8(Adapter, REG_BCN_CTRL_1) | BIT(0));
1250         }
1251 }
1252
1253 static void hw_var_set_macaddr(struct adapter *Adapter, u8 variable, u8 *val)
1254 {
1255         u8 idx = 0;
1256         u32 reg_macid;
1257
1258         reg_macid = REG_MACID;
1259
1260         for (idx = 0; idx < 6; idx++)
1261                 usb_write8(Adapter, (reg_macid+idx), val[idx]);
1262 }
1263
1264 static void hw_var_set_bssid(struct adapter *Adapter, u8 variable, u8 *val)
1265 {
1266         u8 idx = 0;
1267         u32 reg_bssid;
1268
1269         reg_bssid = REG_BSSID;
1270
1271         for (idx = 0; idx < 6; idx++)
1272                 usb_write8(Adapter, (reg_bssid+idx), val[idx]);
1273 }
1274
1275 static void hw_var_set_bcn_func(struct adapter *Adapter, u8 variable, u8 *val)
1276 {
1277         u32 bcn_ctrl_reg;
1278
1279         bcn_ctrl_reg = REG_BCN_CTRL;
1280
1281         if (*((u8 *)val))
1282                 usb_write8(Adapter, bcn_ctrl_reg, (EN_BCN_FUNCTION | EN_TXBCN_RPT));
1283         else
1284                 usb_write8(Adapter, bcn_ctrl_reg, usb_read8(Adapter, bcn_ctrl_reg)&(~(EN_BCN_FUNCTION | EN_TXBCN_RPT)));
1285 }
1286
1287 static void SetHwReg8188EU(struct adapter *Adapter, u8 variable, u8 *val)
1288 {
1289         struct hal_data_8188e   *haldata = GET_HAL_DATA(Adapter);
1290         struct dm_priv  *pdmpriv = &haldata->dmpriv;
1291         struct odm_dm_struct *podmpriv = &haldata->odmpriv;
1292
1293         switch (variable) {
1294         case HW_VAR_MEDIA_STATUS:
1295                 {
1296                         u8 val8;
1297
1298                         val8 = usb_read8(Adapter, MSR)&0x0c;
1299                         val8 |= *((u8 *)val);
1300                         usb_write8(Adapter, MSR, val8);
1301                 }
1302                 break;
1303         case HW_VAR_MEDIA_STATUS1:
1304                 {
1305                         u8 val8;
1306
1307                         val8 = usb_read8(Adapter, MSR) & 0x03;
1308                         val8 |= *((u8 *)val) << 2;
1309                         usb_write8(Adapter, MSR, val8);
1310                 }
1311                 break;
1312         case HW_VAR_SET_OPMODE:
1313                 hw_var_set_opmode(Adapter, variable, val);
1314                 break;
1315         case HW_VAR_MAC_ADDR:
1316                 hw_var_set_macaddr(Adapter, variable, val);
1317                 break;
1318         case HW_VAR_BSSID:
1319                 hw_var_set_bssid(Adapter, variable, val);
1320                 break;
1321         case HW_VAR_BASIC_RATE:
1322                 {
1323                         u16 BrateCfg = 0;
1324                         u8 RateIndex = 0;
1325
1326                         /*  2007.01.16, by Emily */
1327                         /*  Select RRSR (in Legacy-OFDM and CCK) */
1328                         /*  For 8190, we select only 24M, 12M, 6M, 11M, 5.5M, 2M, and 1M from the Basic rate. */
1329                         /*  We do not use other rates. */
1330                         HalSetBrateCfg(Adapter, val, &BrateCfg);
1331                         DBG_88E("HW_VAR_BASIC_RATE: BrateCfg(%#x)\n", BrateCfg);
1332
1333                         /* 2011.03.30 add by Luke Lee */
1334                         /* CCK 2M ACK should be disabled for some BCM and Atheros AP IOT */
1335                         /* because CCK 2M has poor TXEVM */
1336                         /* CCK 5.5M & 11M ACK should be enabled for better performance */
1337
1338                         BrateCfg = (BrateCfg | 0xd) & 0x15d;
1339                         haldata->BasicRateSet = BrateCfg;
1340
1341                         BrateCfg |= 0x01; /*  default enable 1M ACK rate */
1342                         /*  Set RRSR rate table. */
1343                         usb_write8(Adapter, REG_RRSR, BrateCfg & 0xff);
1344                         usb_write8(Adapter, REG_RRSR+1, (BrateCfg >> 8) & 0xff);
1345                         usb_write8(Adapter, REG_RRSR+2, usb_read8(Adapter, REG_RRSR+2)&0xf0);
1346
1347                         /*  Set RTS initial rate */
1348                         while (BrateCfg > 0x1) {
1349                                 BrateCfg = (BrateCfg >> 1);
1350                                 RateIndex++;
1351                         }
1352                         /*  Ziv - Check */
1353                         usb_write8(Adapter, REG_INIRTS_RATE_SEL, RateIndex);
1354                 }
1355                 break;
1356         case HW_VAR_TXPAUSE:
1357                 usb_write8(Adapter, REG_TXPAUSE, *((u8 *)val));
1358                 break;
1359         case HW_VAR_BCN_FUNC:
1360                 hw_var_set_bcn_func(Adapter, variable, val);
1361                 break;
1362         case HW_VAR_CORRECT_TSF:
1363                 {
1364                         u64     tsf;
1365                         struct mlme_ext_priv    *pmlmeext = &Adapter->mlmeextpriv;
1366                         struct mlme_ext_info    *pmlmeinfo = &(pmlmeext->mlmext_info);
1367
1368                         tsf = pmlmeext->TSFValue - rtw_modular64(pmlmeext->TSFValue, (pmlmeinfo->bcn_interval*1024)) - 1024; /* us */
1369
1370                         if (((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE))
1371                                 StopTxBeacon(Adapter);
1372
1373                         /* disable related TSF function */
1374                         usb_write8(Adapter, REG_BCN_CTRL, usb_read8(Adapter, REG_BCN_CTRL)&(~BIT(3)));
1375
1376                         usb_write32(Adapter, REG_TSFTR, tsf);
1377                         usb_write32(Adapter, REG_TSFTR+4, tsf>>32);
1378
1379                         /* enable related TSF function */
1380                         usb_write8(Adapter, REG_BCN_CTRL, usb_read8(Adapter, REG_BCN_CTRL)|BIT(3));
1381
1382                         if (((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE))
1383                                 ResumeTxBeacon(Adapter);
1384                 }
1385                 break;
1386         case HW_VAR_CHECK_BSSID:
1387                 if (*((u8 *)val)) {
1388                         usb_write32(Adapter, REG_RCR, usb_read32(Adapter, REG_RCR)|RCR_CBSSID_DATA|RCR_CBSSID_BCN);
1389                 } else {
1390                         u32 val32;
1391
1392                         val32 = usb_read32(Adapter, REG_RCR);
1393
1394                         val32 &= ~(RCR_CBSSID_DATA | RCR_CBSSID_BCN);
1395
1396                         usb_write32(Adapter, REG_RCR, val32);
1397                 }
1398                 break;
1399         case HW_VAR_MLME_DISCONNECT:
1400                 /* Set RCR to not to receive data frame when NO LINK state */
1401                 /* reject all data frames */
1402                 usb_write16(Adapter, REG_RXFLTMAP2, 0x00);
1403
1404                 /* reset TSF */
1405                 usb_write8(Adapter, REG_DUAL_TSF_RST, (BIT(0)|BIT(1)));
1406
1407                 /* disable update TSF */
1408                 usb_write8(Adapter, REG_BCN_CTRL, usb_read8(Adapter, REG_BCN_CTRL)|BIT(4));
1409                 break;
1410         case HW_VAR_MLME_SITESURVEY:
1411                 if (*((u8 *)val)) { /* under sitesurvey */
1412                         /* config RCR to receive different BSSID & not to receive data frame */
1413                         u32 v = usb_read32(Adapter, REG_RCR);
1414                         v &= ~(RCR_CBSSID_BCN);
1415                         usb_write32(Adapter, REG_RCR, v);
1416                         /* reject all data frame */
1417                         usb_write16(Adapter, REG_RXFLTMAP2, 0x00);
1418
1419                         /* disable update TSF */
1420                         usb_write8(Adapter, REG_BCN_CTRL, usb_read8(Adapter, REG_BCN_CTRL)|BIT(4));
1421                 } else { /* sitesurvey done */
1422                         struct mlme_ext_priv    *pmlmeext = &Adapter->mlmeextpriv;
1423                         struct mlme_ext_info    *pmlmeinfo = &(pmlmeext->mlmext_info);
1424
1425                         if ((is_client_associated_to_ap(Adapter)) ||
1426                             ((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE)) {
1427                                 /* enable to rx data frame */
1428                                 usb_write16(Adapter, REG_RXFLTMAP2, 0xFFFF);
1429
1430                                 /* enable update TSF */
1431                                 usb_write8(Adapter, REG_BCN_CTRL, usb_read8(Adapter, REG_BCN_CTRL)&(~BIT(4)));
1432                         } else if ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) {
1433                                 usb_write16(Adapter, REG_RXFLTMAP2, 0xFFFF);
1434                                 /* enable update TSF */
1435                                 usb_write8(Adapter, REG_BCN_CTRL, usb_read8(Adapter, REG_BCN_CTRL)&(~BIT(4)));
1436                         }
1437                         if ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE) {
1438                                 usb_write32(Adapter, REG_RCR, usb_read32(Adapter, REG_RCR)|RCR_CBSSID_BCN);
1439                         } else {
1440                                 if (Adapter->in_cta_test) {
1441                                         u32 v = usb_read32(Adapter, REG_RCR);
1442                                         v &= ~(RCR_CBSSID_DATA | RCR_CBSSID_BCN);/*  RCR_ADF */
1443                                         usb_write32(Adapter, REG_RCR, v);
1444                                 } else {
1445                                         usb_write32(Adapter, REG_RCR, usb_read32(Adapter, REG_RCR)|RCR_CBSSID_BCN);
1446                                 }
1447                         }
1448                 }
1449                 break;
1450         case HW_VAR_MLME_JOIN:
1451                 {
1452                         u8 RetryLimit = 0x30;
1453                         u8 type = *((u8 *)val);
1454                         struct mlme_priv        *pmlmepriv = &Adapter->mlmepriv;
1455
1456                         if (type == 0) { /*  prepare to join */
1457                                 /* enable to rx data frame.Accept all data frame */
1458                                 usb_write16(Adapter, REG_RXFLTMAP2, 0xFFFF);
1459
1460                                 if (Adapter->in_cta_test) {
1461                                         u32 v = usb_read32(Adapter, REG_RCR);
1462                                         v &= ~(RCR_CBSSID_DATA | RCR_CBSSID_BCN);/*  RCR_ADF */
1463                                         usb_write32(Adapter, REG_RCR, v);
1464                                 } else {
1465                                         usb_write32(Adapter, REG_RCR, usb_read32(Adapter, REG_RCR)|RCR_CBSSID_DATA|RCR_CBSSID_BCN);
1466                                 }
1467
1468                                 if (check_fwstate(pmlmepriv, WIFI_STATION_STATE))
1469                                         RetryLimit = (haldata->CustomerID == RT_CID_CCX) ? 7 : 48;
1470                                 else /*  Ad-hoc Mode */
1471                                         RetryLimit = 0x7;
1472                         } else if (type == 1) {
1473                                 /* joinbss_event call back when join res < 0 */
1474                                 usb_write16(Adapter, REG_RXFLTMAP2, 0x00);
1475                         } else if (type == 2) {
1476                                 /* sta add event call back */
1477                                 /* enable update TSF */
1478                                 usb_write8(Adapter, REG_BCN_CTRL, usb_read8(Adapter, REG_BCN_CTRL)&(~BIT(4)));
1479
1480                                 if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE|WIFI_ADHOC_MASTER_STATE))
1481                                         RetryLimit = 0x7;
1482                         }
1483                         usb_write16(Adapter, REG_RL, RetryLimit << RETRY_LIMIT_SHORT_SHIFT | RetryLimit << RETRY_LIMIT_LONG_SHIFT);
1484                 }
1485                 break;
1486         case HW_VAR_BEACON_INTERVAL:
1487                 usb_write16(Adapter, REG_BCN_INTERVAL, *((u16 *)val));
1488                 break;
1489         case HW_VAR_SLOT_TIME:
1490                 {
1491                         u8 u1bAIFS, aSifsTime;
1492                         struct mlme_ext_priv    *pmlmeext = &Adapter->mlmeextpriv;
1493                         struct mlme_ext_info    *pmlmeinfo = &(pmlmeext->mlmext_info);
1494
1495                         usb_write8(Adapter, REG_SLOT, val[0]);
1496
1497                         if (pmlmeinfo->WMM_enable == 0) {
1498                                 if (pmlmeext->cur_wireless_mode == WIRELESS_11B)
1499                                         aSifsTime = 10;
1500                                 else
1501                                         aSifsTime = 16;
1502
1503                                 u1bAIFS = aSifsTime + (2 * pmlmeinfo->slotTime);
1504
1505                                 /*  <Roger_EXP> Temporary removed, 2008.06.20. */
1506                                 usb_write8(Adapter, REG_EDCA_VO_PARAM, u1bAIFS);
1507                                 usb_write8(Adapter, REG_EDCA_VI_PARAM, u1bAIFS);
1508                                 usb_write8(Adapter, REG_EDCA_BE_PARAM, u1bAIFS);
1509                                 usb_write8(Adapter, REG_EDCA_BK_PARAM, u1bAIFS);
1510                         }
1511                 }
1512                 break;
1513         case HW_VAR_RESP_SIFS:
1514                 /* RESP_SIFS for CCK */
1515                 usb_write8(Adapter, REG_R2T_SIFS, val[0]); /*  SIFS_T2T_CCK (0x08) */
1516                 usb_write8(Adapter, REG_R2T_SIFS+1, val[1]); /* SIFS_R2T_CCK(0x08) */
1517                 /* RESP_SIFS for OFDM */
1518                 usb_write8(Adapter, REG_T2T_SIFS, val[2]); /* SIFS_T2T_OFDM (0x0a) */
1519                 usb_write8(Adapter, REG_T2T_SIFS+1, val[3]); /* SIFS_R2T_OFDM(0x0a) */
1520                 break;
1521         case HW_VAR_ACK_PREAMBLE:
1522                 {
1523                         u8 regTmp;
1524                         u8 bShortPreamble = *((bool *)val);
1525                         /*  Joseph marked out for Netgear 3500 TKIP channel 7 issue.(Temporarily) */
1526                         regTmp = (haldata->nCur40MhzPrimeSC)<<5;
1527                         if (bShortPreamble)
1528                                 regTmp |= 0x80;
1529
1530                         usb_write8(Adapter, REG_RRSR+2, regTmp);
1531                 }
1532                 break;
1533         case HW_VAR_SEC_CFG:
1534                 usb_write8(Adapter, REG_SECCFG, *((u8 *)val));
1535                 break;
1536         case HW_VAR_DM_FLAG:
1537                 podmpriv->SupportAbility = *((u8 *)val);
1538                 break;
1539         case HW_VAR_DM_FUNC_OP:
1540                 if (val[0])
1541                         podmpriv->BK_SupportAbility = podmpriv->SupportAbility;
1542                 else
1543                         podmpriv->SupportAbility = podmpriv->BK_SupportAbility;
1544                 break;
1545         case HW_VAR_DM_FUNC_SET:
1546                 if (*((u32 *)val) == DYNAMIC_ALL_FUNC_ENABLE) {
1547                         pdmpriv->DMFlag = pdmpriv->InitDMFlag;
1548                         podmpriv->SupportAbility =      pdmpriv->InitODMFlag;
1549                 } else {
1550                         podmpriv->SupportAbility |= *((u32 *)val);
1551                 }
1552                 break;
1553         case HW_VAR_DM_FUNC_CLR:
1554                 podmpriv->SupportAbility &= *((u32 *)val);
1555                 break;
1556         case HW_VAR_CAM_EMPTY_ENTRY:
1557                 {
1558                         u8 ucIndex = *((u8 *)val);
1559                         u8 i;
1560                         u32 ulCommand = 0;
1561                         u32 ulContent = 0;
1562                         u32 ulEncAlgo = CAM_AES;
1563
1564                         for (i = 0; i < CAM_CONTENT_COUNT; i++) {
1565                                 /*  filled id in CAM config 2 byte */
1566                                 if (i == 0)
1567                                         ulContent |= (ucIndex & 0x03) | ((u16)(ulEncAlgo)<<2);
1568                                 else
1569                                         ulContent = 0;
1570                                 /*  polling bit, and No Write enable, and address */
1571                                 ulCommand = CAM_CONTENT_COUNT*ucIndex+i;
1572                                 ulCommand = ulCommand | CAM_POLLINIG|CAM_WRITE;
1573                                 /*  write content 0 is equall to mark invalid */
1574                                 usb_write32(Adapter, WCAMI, ulContent);  /* delay_ms(40); */
1575                                 usb_write32(Adapter, RWCAM, ulCommand);  /* delay_ms(40); */
1576                         }
1577                 }
1578                 break;
1579         case HW_VAR_CAM_INVALID_ALL:
1580                 usb_write32(Adapter, RWCAM, BIT(31)|BIT(30));
1581                 break;
1582         case HW_VAR_CAM_WRITE:
1583                 {
1584                         u32 cmd;
1585                         u32 *cam_val = (u32 *)val;
1586                         usb_write32(Adapter, WCAMI, cam_val[0]);
1587
1588                         cmd = CAM_POLLINIG | CAM_WRITE | cam_val[1];
1589                         usb_write32(Adapter, RWCAM, cmd);
1590                 }
1591                 break;
1592         case HW_VAR_AC_PARAM_VO:
1593                 usb_write32(Adapter, REG_EDCA_VO_PARAM, ((u32 *)(val))[0]);
1594                 break;
1595         case HW_VAR_AC_PARAM_VI:
1596                 usb_write32(Adapter, REG_EDCA_VI_PARAM, ((u32 *)(val))[0]);
1597                 break;
1598         case HW_VAR_AC_PARAM_BE:
1599                 haldata->AcParam_BE = ((u32 *)(val))[0];
1600                 usb_write32(Adapter, REG_EDCA_BE_PARAM, ((u32 *)(val))[0]);
1601                 break;
1602         case HW_VAR_AC_PARAM_BK:
1603                 usb_write32(Adapter, REG_EDCA_BK_PARAM, ((u32 *)(val))[0]);
1604                 break;
1605         case HW_VAR_ACM_CTRL:
1606                 {
1607                         u8 acm_ctrl = *((u8 *)val);
1608                         u8 AcmCtrl = usb_read8(Adapter, REG_ACMHWCTRL);
1609
1610                         if (acm_ctrl > 1)
1611                                 AcmCtrl = AcmCtrl | 0x1;
1612
1613                         if (acm_ctrl & BIT(3))
1614                                 AcmCtrl |= AcmHw_VoqEn;
1615                         else
1616                                 AcmCtrl &= (~AcmHw_VoqEn);
1617
1618                         if (acm_ctrl & BIT(2))
1619                                 AcmCtrl |= AcmHw_ViqEn;
1620                         else
1621                                 AcmCtrl &= (~AcmHw_ViqEn);
1622
1623                         if (acm_ctrl & BIT(1))
1624                                 AcmCtrl |= AcmHw_BeqEn;
1625                         else
1626                                 AcmCtrl &= (~AcmHw_BeqEn);
1627
1628                         DBG_88E("[HW_VAR_ACM_CTRL] Write 0x%X\n", AcmCtrl);
1629                         usb_write8(Adapter, REG_ACMHWCTRL, AcmCtrl);
1630                 }
1631                 break;
1632         case HW_VAR_AMPDU_MIN_SPACE:
1633                 {
1634                         u8 MinSpacingToSet;
1635                         u8 SecMinSpace;
1636
1637                         MinSpacingToSet = *((u8 *)val);
1638                         if (MinSpacingToSet <= 7) {
1639                                 switch (Adapter->securitypriv.dot11PrivacyAlgrthm) {
1640                                 case _NO_PRIVACY_:
1641                                 case _AES_:
1642                                         SecMinSpace = 0;
1643                                         break;
1644                                 case _WEP40_:
1645                                 case _WEP104_:
1646                                 case _TKIP_:
1647                                 case _TKIP_WTMIC_:
1648                                         SecMinSpace = 6;
1649                                         break;
1650                                 default:
1651                                         SecMinSpace = 7;
1652                                         break;
1653                                 }
1654                                 if (MinSpacingToSet < SecMinSpace)
1655                                         MinSpacingToSet = SecMinSpace;
1656                                 usb_write8(Adapter, REG_AMPDU_MIN_SPACE, (usb_read8(Adapter, REG_AMPDU_MIN_SPACE) & 0xf8) | MinSpacingToSet);
1657                         }
1658                 }
1659                 break;
1660         case HW_VAR_AMPDU_FACTOR:
1661                 {
1662                         u8 RegToSet_Normal[4] = {0x41, 0xa8, 0x72, 0xb9};
1663                         u8 FactorToSet;
1664                         u8 *pRegToSet;
1665                         u8 index = 0;
1666
1667                         pRegToSet = RegToSet_Normal; /*  0xb972a841; */
1668                         FactorToSet = *((u8 *)val);
1669                         if (FactorToSet <= 3) {
1670                                 FactorToSet = (1<<(FactorToSet + 2));
1671                                 if (FactorToSet > 0xf)
1672                                         FactorToSet = 0xf;
1673
1674                                 for (index = 0; index < 4; index++) {
1675                                         if ((pRegToSet[index] & 0xf0) > (FactorToSet<<4))
1676                                                 pRegToSet[index] = (pRegToSet[index] & 0x0f) | (FactorToSet<<4);
1677
1678                                         if ((pRegToSet[index] & 0x0f) > FactorToSet)
1679                                                 pRegToSet[index] = (pRegToSet[index] & 0xf0) | (FactorToSet);
1680
1681                                         usb_write8(Adapter, (REG_AGGLEN_LMT+index), pRegToSet[index]);
1682                                 }
1683                         }
1684                 }
1685                 break;
1686         case HW_VAR_RXDMA_AGG_PG_TH:
1687                 {
1688                         u8 threshold = *((u8 *)val);
1689                         if (threshold == 0)
1690                                 threshold = haldata->UsbRxAggPageCount;
1691                         usb_write8(Adapter, REG_RXDMA_AGG_PG_TH, threshold);
1692                 }
1693                 break;
1694         case HW_VAR_SET_RPWM:
1695                 break;
1696         case HW_VAR_H2C_FW_PWRMODE:
1697                 {
1698                         u8 psmode = (*(u8 *)val);
1699
1700                         /*  Forece leave RF low power mode for 1T1R to prevent conficting setting in Fw power */
1701                         /*  saving sequence. 2010.06.07. Added by tynli. Suggested by SD3 yschang. */
1702                         if ((psmode != PS_MODE_ACTIVE) && (!IS_92C_SERIAL(haldata->VersionID)))
1703                                 ODM_RF_Saving(podmpriv, true);
1704                         rtl8188e_set_FwPwrMode_cmd(Adapter, psmode);
1705                 }
1706                 break;
1707         case HW_VAR_H2C_FW_JOINBSSRPT:
1708                 {
1709                         u8 mstatus = (*(u8 *)val);
1710                         rtl8188e_set_FwJoinBssReport_cmd(Adapter, mstatus);
1711                 }
1712                 break;
1713         case HW_VAR_INITIAL_GAIN:
1714                 {
1715                         struct rtw_dig *pDigTable = &podmpriv->DM_DigTable;
1716                         u32 rx_gain = ((u32 *)(val))[0];
1717
1718                         if (rx_gain == 0xff) {/* restore rx gain */
1719                                 ODM_Write_DIG(podmpriv, pDigTable->BackupIGValue);
1720                         } else {
1721                                 pDigTable->BackupIGValue = pDigTable->CurIGValue;
1722                                 ODM_Write_DIG(podmpriv, rx_gain);
1723                         }
1724                 }
1725                 break;
1726         case HW_VAR_TRIGGER_GPIO_0:
1727                 rtl8192cu_trigger_gpio_0(Adapter);
1728                 break;
1729         case HW_VAR_RPT_TIMER_SETTING:
1730                 {
1731                         u16 min_rpt_time = (*(u16 *)val);
1732                         ODM_RA_Set_TxRPT_Time(podmpriv, min_rpt_time);
1733                 }
1734                 break;
1735         case HW_VAR_ANTENNA_DIVERSITY_SELECT:
1736                 {
1737                         u8 Optimum_antenna = (*(u8 *)val);
1738                         u8 Ant;
1739                         /* switch antenna to Optimum_antenna */
1740                         if (haldata->CurAntenna !=  Optimum_antenna) {
1741                                 Ant = (Optimum_antenna == 2) ? MAIN_ANT : AUX_ANT;
1742                                 ODM_UpdateRxIdleAnt_88E(&haldata->odmpriv, Ant);
1743
1744                                 haldata->CurAntenna = Optimum_antenna;
1745                         }
1746                 }
1747                 break;
1748         case HW_VAR_EFUSE_BYTES: /*  To set EFUE total used bytes, added by Roger, 2008.12.22. */
1749                 haldata->EfuseUsedBytes = *((u16 *)val);
1750                 break;
1751         case HW_VAR_FIFO_CLEARN_UP:
1752                 {
1753                         struct pwrctrl_priv *pwrpriv = &Adapter->pwrctrlpriv;
1754                         u8 trycnt = 100;
1755
1756                         /* pause tx */
1757                         usb_write8(Adapter, REG_TXPAUSE, 0xff);
1758
1759                         /* keep sn */
1760                         Adapter->xmitpriv.nqos_ssn = usb_read16(Adapter, REG_NQOS_SEQ);
1761
1762                         if (!pwrpriv->bkeepfwalive) {
1763                                 /* RX DMA stop */
1764                                 usb_write32(Adapter, REG_RXPKT_NUM, (usb_read32(Adapter, REG_RXPKT_NUM)|RW_RELEASE_EN));
1765                                 do {
1766                                         if (!(usb_read32(Adapter, REG_RXPKT_NUM)&RXDMA_IDLE))
1767                                                 break;
1768                                 } while (trycnt--);
1769                                 if (trycnt == 0)
1770                                         DBG_88E("Stop RX DMA failed......\n");
1771
1772                                 /* RQPN Load 0 */
1773                                 usb_write16(Adapter, REG_RQPN_NPQ, 0x0);
1774                                 usb_write32(Adapter, REG_RQPN, 0x80000000);
1775                                 mdelay(10);
1776                         }
1777                 }
1778                 break;
1779         case HW_VAR_CHECK_TXBUF:
1780                 break;
1781         case HW_VAR_APFM_ON_MAC:
1782                 haldata->bMacPwrCtrlOn = *val;
1783                 DBG_88E("%s: bMacPwrCtrlOn=%d\n", __func__, haldata->bMacPwrCtrlOn);
1784                 break;
1785         case HW_VAR_TX_RPT_MAX_MACID:
1786                 {
1787                         u8 maxMacid = *val;
1788                         DBG_88E("### MacID(%d),Set Max Tx RPT MID(%d)\n", maxMacid, maxMacid+1);
1789                         usb_write8(Adapter, REG_TX_RPT_CTRL+1, maxMacid+1);
1790                 }
1791                 break;
1792         case HW_VAR_H2C_MEDIA_STATUS_RPT:
1793                 rtl8188e_set_FwMediaStatus_cmd(Adapter , (*(__le16 *)val));
1794                 break;
1795         case HW_VAR_BCN_VALID:
1796                 /* BCN_VALID, BIT16 of REG_TDECTRL = BIT0 of REG_TDECTRL+2, write 1 to clear, Clear by sw */
1797                 usb_write8(Adapter, REG_TDECTRL+2, usb_read8(Adapter, REG_TDECTRL+2) | BIT0);
1798                 break;
1799         default:
1800                 break;
1801         }
1802 }
1803
1804 static void GetHwReg8188EU(struct adapter *Adapter, u8 variable, u8 *val)
1805 {
1806         struct hal_data_8188e   *haldata = GET_HAL_DATA(Adapter);
1807         struct odm_dm_struct *podmpriv = &haldata->odmpriv;
1808
1809         switch (variable) {
1810         case HW_VAR_BASIC_RATE:
1811                 *((u16 *)(val)) = haldata->BasicRateSet;
1812         case HW_VAR_TXPAUSE:
1813                 val[0] = usb_read8(Adapter, REG_TXPAUSE);
1814                 break;
1815         case HW_VAR_BCN_VALID:
1816                 /* BCN_VALID, BIT16 of REG_TDECTRL = BIT0 of REG_TDECTRL+2 */
1817                 val[0] = (BIT0 & usb_read8(Adapter, REG_TDECTRL+2)) ? true : false;
1818                 break;
1819         case HW_VAR_DM_FLAG:
1820                 val[0] = podmpriv->SupportAbility;
1821                 break;
1822         case HW_VAR_RF_TYPE:
1823                 val[0] = haldata->rf_type;
1824                 break;
1825         case HW_VAR_FWLPS_RF_ON:
1826                 {
1827                         /* When we halt NIC, we should check if FW LPS is leave. */
1828                         if (Adapter->pwrctrlpriv.rf_pwrstate == rf_off) {
1829                                 /*  If it is in HW/SW Radio OFF or IPS state, we do not check Fw LPS Leave, */
1830                                 /*  because Fw is unload. */
1831                                 val[0] = true;
1832                         } else {
1833                                 u32 valRCR;
1834                                 valRCR = usb_read32(Adapter, REG_RCR);
1835                                 valRCR &= 0x00070000;
1836                                 if (valRCR)
1837                                         val[0] = false;
1838                                 else
1839                                         val[0] = true;
1840                         }
1841                 }
1842                 break;
1843         case HW_VAR_CURRENT_ANTENNA:
1844                 val[0] = haldata->CurAntenna;
1845                 break;
1846         case HW_VAR_EFUSE_BYTES: /*  To get EFUE total used bytes, added by Roger, 2008.12.22. */
1847                 *((u16 *)(val)) = haldata->EfuseUsedBytes;
1848                 break;
1849         case HW_VAR_APFM_ON_MAC:
1850                 *val = haldata->bMacPwrCtrlOn;
1851                 break;
1852         case HW_VAR_CHK_HI_QUEUE_EMPTY:
1853                 *val = ((usb_read32(Adapter, REG_HGQ_INFORMATION)&0x0000ff00) == 0) ? true : false;
1854                 break;
1855         default:
1856                 break;
1857         }
1858
1859 }
1860
1861 /*  */
1862 /*      Description: */
1863 /*              Query setting of specified variable. */
1864 /*  */
1865 static u8
1866 GetHalDefVar8188EUsb(
1867                 struct adapter *Adapter,
1868                 enum hal_def_variable eVariable,
1869                 void *pValue
1870         )
1871 {
1872         struct hal_data_8188e   *haldata = GET_HAL_DATA(Adapter);
1873         u8 bResult = _SUCCESS;
1874
1875         switch (eVariable) {
1876         case HAL_DEF_UNDERCORATEDSMOOTHEDPWDB:
1877                 {
1878                         struct mlme_priv *pmlmepriv = &Adapter->mlmepriv;
1879                         struct sta_priv *pstapriv = &Adapter->stapriv;
1880                         struct sta_info *psta;
1881                         psta = rtw_get_stainfo(pstapriv, pmlmepriv->cur_network.network.MacAddress);
1882                         if (psta)
1883                                 *((int *)pValue) = psta->rssi_stat.UndecoratedSmoothedPWDB;
1884                 }
1885                 break;
1886         case HAL_DEF_IS_SUPPORT_ANT_DIV:
1887                 *((u8 *)pValue) = (haldata->AntDivCfg == 0) ? false : true;
1888                 break;
1889         case HAL_DEF_CURRENT_ANTENNA:
1890                 *((u8 *)pValue) = haldata->CurAntenna;
1891                 break;
1892         case HAL_DEF_DRVINFO_SZ:
1893                 *((u32 *)pValue) = DRVINFO_SZ;
1894                 break;
1895         case HAL_DEF_MAX_RECVBUF_SZ:
1896                 *((u32 *)pValue) = MAX_RECVBUF_SZ;
1897                 break;
1898         case HAL_DEF_RX_PACKET_OFFSET:
1899                 *((u32 *)pValue) = RXDESC_SIZE + DRVINFO_SZ;
1900                 break;
1901         case HAL_DEF_DBG_DM_FUNC:
1902                 *((u32 *)pValue) = haldata->odmpriv.SupportAbility;
1903                 break;
1904         case HAL_DEF_RA_DECISION_RATE:
1905                 {
1906                         u8 MacID = *((u8 *)pValue);
1907                         *((u8 *)pValue) = ODM_RA_GetDecisionRate_8188E(&(haldata->odmpriv), MacID);
1908                 }
1909                 break;
1910         case HAL_DEF_RA_SGI:
1911                 {
1912                         u8 MacID = *((u8 *)pValue);
1913                         *((u8 *)pValue) = ODM_RA_GetShortGI_8188E(&(haldata->odmpriv), MacID);
1914                 }
1915                 break;
1916         case HAL_DEF_PT_PWR_STATUS:
1917                 {
1918                         u8 MacID = *((u8 *)pValue);
1919                         *((u8 *)pValue) = ODM_RA_GetHwPwrStatus_8188E(&(haldata->odmpriv), MacID);
1920                 }
1921                 break;
1922         case HW_VAR_MAX_RX_AMPDU_FACTOR:
1923                 *((u32 *)pValue) = MAX_AMPDU_FACTOR_64K;
1924                 break;
1925         case HW_DEF_RA_INFO_DUMP:
1926                 {
1927                         u8 entry_id = *((u8 *)pValue);
1928                         if (check_fwstate(&Adapter->mlmepriv, _FW_LINKED)) {
1929                                 DBG_88E("============ RA status check ===================\n");
1930                                 DBG_88E("Mac_id:%d , RateID = %d, RAUseRate = 0x%08x, RateSGI = %d, DecisionRate = 0x%02x ,PTStage = %d\n",
1931                                         entry_id,
1932                                         haldata->odmpriv.RAInfo[entry_id].RateID,
1933                                         haldata->odmpriv.RAInfo[entry_id].RAUseRate,
1934                                         haldata->odmpriv.RAInfo[entry_id].RateSGI,
1935                                         haldata->odmpriv.RAInfo[entry_id].DecisionRate,
1936                                         haldata->odmpriv.RAInfo[entry_id].PTStage);
1937                         }
1938                 }
1939                 break;
1940         case HW_DEF_ODM_DBG_FLAG:
1941                 {
1942                         struct odm_dm_struct *dm_ocm = &(haldata->odmpriv);
1943                         pr_info("dm_ocm->DebugComponents = 0x%llx\n", dm_ocm->DebugComponents);
1944                 }
1945                 break;
1946         case HAL_DEF_DBG_DUMP_RXPKT:
1947                 *((u8 *)pValue) = haldata->bDumpRxPkt;
1948                 break;
1949         case HAL_DEF_DBG_DUMP_TXPKT:
1950                 *((u8 *)pValue) = haldata->bDumpTxPkt;
1951                 break;
1952         default:
1953                 bResult = _FAIL;
1954                 break;
1955         }
1956
1957         return bResult;
1958 }
1959
1960 /*  */
1961 /*      Description: */
1962 /*              Change default setting of specified variable. */
1963 /*  */
1964 static u8 SetHalDefVar8188EUsb(struct adapter *Adapter, enum hal_def_variable eVariable, void *pValue)
1965 {
1966         struct hal_data_8188e   *haldata = GET_HAL_DATA(Adapter);
1967         u8 bResult = _SUCCESS;
1968
1969         switch (eVariable) {
1970         case HAL_DEF_DBG_DM_FUNC:
1971                 {
1972                         u8 dm_func = *((u8 *)pValue);
1973                         struct odm_dm_struct *podmpriv = &haldata->odmpriv;
1974
1975                         if (dm_func == 0) { /* disable all dynamic func */
1976                                 podmpriv->SupportAbility = DYNAMIC_FUNC_DISABLE;
1977                                 DBG_88E("==> Disable all dynamic function...\n");
1978                         } else if (dm_func == 1) {/* disable DIG */
1979                                 podmpriv->SupportAbility  &= (~DYNAMIC_BB_DIG);
1980                                 DBG_88E("==> Disable DIG...\n");
1981                         } else if (dm_func == 2) {/* disable High power */
1982                                 podmpriv->SupportAbility  &= (~DYNAMIC_BB_DYNAMIC_TXPWR);
1983                         } else if (dm_func == 3) {/* disable tx power tracking */
1984                                 podmpriv->SupportAbility  &= (~DYNAMIC_RF_CALIBRATION);
1985                                 DBG_88E("==> Disable tx power tracking...\n");
1986                         } else if (dm_func == 5) {/* disable antenna diversity */
1987                                 podmpriv->SupportAbility  &= (~DYNAMIC_BB_ANT_DIV);
1988                         } else if (dm_func == 6) {/* turn on all dynamic func */
1989                                 if (!(podmpriv->SupportAbility  & DYNAMIC_BB_DIG)) {
1990                                         struct rtw_dig *pDigTable = &podmpriv->DM_DigTable;
1991                                         pDigTable->CurIGValue = usb_read8(Adapter, 0xc50);
1992                                 }
1993                                 podmpriv->SupportAbility = DYNAMIC_ALL_FUNC_ENABLE;
1994                                 DBG_88E("==> Turn on all dynamic function...\n");
1995                         }
1996                 }
1997                 break;
1998         case HAL_DEF_DBG_DUMP_RXPKT:
1999                 haldata->bDumpRxPkt = *((u8 *)pValue);
2000                 break;
2001         case HAL_DEF_DBG_DUMP_TXPKT:
2002                 haldata->bDumpTxPkt = *((u8 *)pValue);
2003                 break;
2004         case HW_DEF_FA_CNT_DUMP:
2005                 {
2006                         u8 bRSSIDump = *((u8 *)pValue);
2007                         struct odm_dm_struct *dm_ocm = &(haldata->odmpriv);
2008                         if (bRSSIDump)
2009                                 dm_ocm->DebugComponents =       ODM_COMP_DIG|ODM_COMP_FA_CNT    ;
2010                         else
2011                                 dm_ocm->DebugComponents = 0;
2012                 }
2013                 break;
2014         case HW_DEF_ODM_DBG_FLAG:
2015                 {
2016                         u64     DebugComponents = *((u64 *)pValue);
2017                         struct odm_dm_struct *dm_ocm = &(haldata->odmpriv);
2018                         dm_ocm->DebugComponents = DebugComponents;
2019                 }
2020                 break;
2021         default:
2022                 bResult = _FAIL;
2023                 break;
2024         }
2025
2026         return bResult;
2027 }
2028
2029 static void UpdateHalRAMask8188EUsb(struct adapter *adapt, u32 mac_id, u8 rssi_level)
2030 {
2031         u8 init_rate = 0;
2032         u8 networkType, raid;
2033         u32 mask, rate_bitmap;
2034         u8 shortGIrate = false;
2035         int     supportRateNum = 0;
2036         struct sta_info *psta;
2037         struct hal_data_8188e   *haldata = GET_HAL_DATA(adapt);
2038         struct mlme_ext_priv    *pmlmeext = &adapt->mlmeextpriv;
2039         struct mlme_ext_info    *pmlmeinfo = &(pmlmeext->mlmext_info);
2040         struct wlan_bssid_ex    *cur_network = &(pmlmeinfo->network);
2041
2042         if (mac_id >= NUM_STA) /* CAM_SIZE */
2043                 return;
2044         psta = pmlmeinfo->FW_sta_info[mac_id].psta;
2045         if (psta == NULL)
2046                 return;
2047         switch (mac_id) {
2048         case 0:/*  for infra mode */
2049                 supportRateNum = rtw_get_rateset_len(cur_network->SupportedRates);
2050                 networkType = judge_network_type(adapt, cur_network->SupportedRates, supportRateNum) & 0xf;
2051                 raid = networktype_to_raid(networkType);
2052                 mask = update_supported_rate(cur_network->SupportedRates, supportRateNum);
2053                 mask |= (pmlmeinfo->HT_enable) ? update_MSC_rate(&(pmlmeinfo->HT_caps)) : 0;
2054                 if (support_short_GI(adapt, &(pmlmeinfo->HT_caps)))
2055                         shortGIrate = true;
2056                 break;
2057         case 1:/* for broadcast/multicast */
2058                 supportRateNum = rtw_get_rateset_len(pmlmeinfo->FW_sta_info[mac_id].SupportedRates);
2059                 if (pmlmeext->cur_wireless_mode & WIRELESS_11B)
2060                         networkType = WIRELESS_11B;
2061                 else
2062                         networkType = WIRELESS_11G;
2063                 raid = networktype_to_raid(networkType);
2064                 mask = update_basic_rate(cur_network->SupportedRates, supportRateNum);
2065                 break;
2066         default: /* for each sta in IBSS */
2067                 supportRateNum = rtw_get_rateset_len(pmlmeinfo->FW_sta_info[mac_id].SupportedRates);
2068                 networkType = judge_network_type(adapt, pmlmeinfo->FW_sta_info[mac_id].SupportedRates, supportRateNum) & 0xf;
2069                 raid = networktype_to_raid(networkType);
2070                 mask = update_supported_rate(cur_network->SupportedRates, supportRateNum);
2071
2072                 /* todo: support HT in IBSS */
2073                 break;
2074         }
2075
2076         rate_bitmap = 0x0fffffff;
2077         rate_bitmap = ODM_Get_Rate_Bitmap(&haldata->odmpriv, mac_id, mask, rssi_level);
2078         DBG_88E("%s => mac_id:%d, networkType:0x%02x, mask:0x%08x\n\t ==> rssi_level:%d, rate_bitmap:0x%08x\n",
2079                 __func__, mac_id, networkType, mask, rssi_level, rate_bitmap);
2080
2081         mask &= rate_bitmap;
2082
2083         init_rate = get_highest_rate_idx(mask)&0x3f;
2084
2085         if (haldata->fw_ractrl) {
2086                 u8 arg;
2087
2088                 arg = mac_id & 0x1f;/* MACID */
2089                 arg |= BIT(7);
2090                 if (shortGIrate)
2091                         arg |= BIT(5);
2092                 mask |= ((raid << 28) & 0xf0000000);
2093                 DBG_88E("update raid entry, mask=0x%x, arg=0x%x\n", mask, arg);
2094                 psta->ra_mask = mask;
2095                 mask |= ((raid << 28) & 0xf0000000);
2096
2097                 /* to do ,for 8188E-SMIC */
2098                 rtl8188e_set_raid_cmd(adapt, mask);
2099         } else {
2100                 ODM_RA_UpdateRateInfo_8188E(&(haldata->odmpriv),
2101                                 mac_id,
2102                                 raid,
2103                                 mask,
2104                                 shortGIrate
2105                                 );
2106         }
2107         /* set ra_id */
2108         psta->raid = raid;
2109         psta->init_rate = init_rate;
2110 }
2111
2112 static void SetBeaconRelatedRegisters8188EUsb(struct adapter *adapt)
2113 {
2114         u32 value32;
2115         struct mlme_ext_priv    *pmlmeext = &(adapt->mlmeextpriv);
2116         struct mlme_ext_info    *pmlmeinfo = &(pmlmeext->mlmext_info);
2117         u32 bcn_ctrl_reg                        = REG_BCN_CTRL;
2118         /* reset TSF, enable update TSF, correcting TSF On Beacon */
2119
2120         /* BCN interval */
2121         usb_write16(adapt, REG_BCN_INTERVAL, pmlmeinfo->bcn_interval);
2122         usb_write8(adapt, REG_ATIMWND, 0x02);/*  2ms */
2123
2124         _InitBeaconParameters(adapt);
2125
2126         usb_write8(adapt, REG_SLOT, 0x09);
2127
2128         value32 = usb_read32(adapt, REG_TCR);
2129         value32 &= ~TSFRST;
2130         usb_write32(adapt,  REG_TCR, value32);
2131
2132         value32 |= TSFRST;
2133         usb_write32(adapt, REG_TCR, value32);
2134
2135         /*  NOTE: Fix test chip's bug (about contention windows's randomness) */
2136         usb_write8(adapt,  REG_RXTSF_OFFSET_CCK, 0x50);
2137         usb_write8(adapt, REG_RXTSF_OFFSET_OFDM, 0x50);
2138
2139         _BeaconFunctionEnable(adapt, true, true);
2140
2141         ResumeTxBeacon(adapt);
2142
2143         usb_write8(adapt, bcn_ctrl_reg, usb_read8(adapt, bcn_ctrl_reg)|BIT(1));
2144 }
2145
2146 static void rtl8188eu_init_default_value(struct adapter *adapt)
2147 {
2148         struct hal_data_8188e *haldata;
2149         struct pwrctrl_priv *pwrctrlpriv;
2150         u8 i;
2151
2152         haldata = GET_HAL_DATA(adapt);
2153         pwrctrlpriv = &adapt->pwrctrlpriv;
2154
2155         /* init default value */
2156         haldata->fw_ractrl = false;
2157         if (!pwrctrlpriv->bkeepfwalive)
2158                 haldata->LastHMEBoxNum = 0;
2159
2160         /* init dm default value */
2161         haldata->odmpriv.RFCalibrateInfo.bIQKInitialized = false;
2162         haldata->odmpriv.RFCalibrateInfo.TM_Trigger = 0;/* for IQK */
2163         haldata->pwrGroupCnt = 0;
2164         haldata->PGMaxGroup = 13;
2165         haldata->odmpriv.RFCalibrateInfo.ThermalValue_HP_index = 0;
2166         for (i = 0; i < HP_THERMAL_NUM; i++)
2167                 haldata->odmpriv.RFCalibrateInfo.ThermalValue_HP[i] = 0;
2168 }
2169
2170 void rtl8188eu_set_hal_ops(struct adapter *adapt)
2171 {
2172         struct hal_ops  *halfunc = &adapt->HalFunc;
2173
2174
2175         adapt->HalData = kzalloc(sizeof(struct hal_data_8188e), GFP_KERNEL);
2176         if (adapt->HalData == NULL)
2177                 DBG_88E("cant not alloc memory for HAL DATA\n");
2178
2179         halfunc->hal_power_on = rtl8188eu_InitPowerOn;
2180         halfunc->hal_init = &rtl8188eu_hal_init;
2181         halfunc->hal_deinit = &rtl8188eu_hal_deinit;
2182
2183         halfunc->inirp_init = &rtl8188eu_inirp_init;
2184         halfunc->inirp_deinit = &rtl8188eu_inirp_deinit;
2185
2186         halfunc->init_xmit_priv = &rtl8188eu_init_xmit_priv;
2187
2188         halfunc->init_recv_priv = &rtl8188eu_init_recv_priv;
2189         halfunc->free_recv_priv = &rtl8188eu_free_recv_priv;
2190         halfunc->InitSwLeds = &rtl8188eu_InitSwLeds;
2191         halfunc->DeInitSwLeds = &rtl8188eu_DeInitSwLeds;
2192
2193         halfunc->init_default_value = &rtl8188eu_init_default_value;
2194         halfunc->intf_chip_configure = &rtl8188eu_interface_configure;
2195         halfunc->read_adapter_info = &_ReadAdapterInfo8188EU;
2196
2197         halfunc->SetHwRegHandler = &SetHwReg8188EU;
2198         halfunc->GetHwRegHandler = &GetHwReg8188EU;
2199         halfunc->GetHalDefVarHandler = &GetHalDefVar8188EUsb;
2200         halfunc->SetHalDefVarHandler = &SetHalDefVar8188EUsb;
2201
2202         halfunc->UpdateRAMaskHandler = &UpdateHalRAMask8188EUsb;
2203         halfunc->SetBeaconRelatedRegistersHandler = &SetBeaconRelatedRegisters8188EUsb;
2204
2205         halfunc->hal_xmit = &rtl8188eu_hal_xmit;
2206         halfunc->mgnt_xmit = &rtl8188eu_mgnt_xmit;
2207
2208         rtl8188e_set_hal_ops(halfunc);
2209 }