1
2
3
4
5
6
7
8
9
10
11
12#include "r8192E.h"
13#include "r8192E_hw.h"
14#include "r819xE_phyreg.h"
15#include "r819xE_phy.h"
16#include "r8190_rtl8256.h"
17
18
19
20
21
22
23
24
25
26void PHY_SetRF8256Bandwidth(struct net_device* dev , HT_CHANNEL_WIDTH Bandwidth)
27{
28 u8 eRFPath;
29 struct r8192_priv *priv = ieee80211_priv(dev);
30
31
32 for(eRFPath = 0; eRFPath <priv->NumTotalRFPath; eRFPath++)
33 {
34 if (!rtl8192_phy_CheckIsLegalRFPath(dev, eRFPath))
35 continue;
36
37 switch(Bandwidth)
38 {
39 case HT_CHANNEL_WIDTH_20:
40 if(priv->card_8192_version == VERSION_8190_BD || priv->card_8192_version == VERSION_8190_BE)
41 {
42 rtl8192_phy_SetRFReg(dev, (RF90_RADIO_PATH_E)eRFPath, 0x0b, bMask12Bits, 0x100);
43 rtl8192_phy_SetRFReg(dev, (RF90_RADIO_PATH_E)eRFPath, 0x2c, bMask12Bits, 0x3d7);
44 rtl8192_phy_SetRFReg(dev, (RF90_RADIO_PATH_E)eRFPath, 0x0e, bMask12Bits, 0x021);
45
46
47
48 }
49 else
50 {
51 RT_TRACE(COMP_ERR, "PHY_SetRF8256Bandwidth(): unknown hardware version\n");
52 }
53
54 break;
55 case HT_CHANNEL_WIDTH_20_40:
56 if(priv->card_8192_version == VERSION_8190_BD ||priv->card_8192_version == VERSION_8190_BE)
57 {
58 rtl8192_phy_SetRFReg(dev, (RF90_RADIO_PATH_E)eRFPath, 0x0b, bMask12Bits, 0x300);
59 rtl8192_phy_SetRFReg(dev, (RF90_RADIO_PATH_E)eRFPath, 0x2c, bMask12Bits, 0x3ff);
60 rtl8192_phy_SetRFReg(dev, (RF90_RADIO_PATH_E)eRFPath, 0x0e, bMask12Bits, 0x0e1);
61
62
63 #if 0
64 if(priv->chan == 3 || priv->chan == 9)
65 rtl8192_phy_SetRFReg(dev, (RF90_RADIO_PATH_E)eRFPath, 0x14, bMask12Bits, 0x59b);
66 else
67 rtl8192_phy_SetRFReg(dev, (RF90_RADIO_PATH_E)eRFPath, 0x14, bMask12Bits, 0x5ab);
68 #endif
69 }
70 else
71 {
72 RT_TRACE(COMP_ERR, "PHY_SetRF8256Bandwidth(): unknown hardware version\n");
73 }
74
75
76 break;
77 default:
78 RT_TRACE(COMP_ERR, "PHY_SetRF8256Bandwidth(): unknown Bandwidth: %#X\n",Bandwidth );
79 break;
80
81 }
82 }
83 return;
84}
85
86
87
88
89
90
91RT_STATUS PHY_RF8256_Config(struct net_device* dev)
92{
93 struct r8192_priv *priv = ieee80211_priv(dev);
94
95
96 RT_STATUS rtStatus = RT_STATUS_SUCCESS;
97
98 priv->NumTotalRFPath = RTL819X_TOTAL_RF_PATH;
99
100 rtStatus = phy_RF8256_Config_ParaFile(dev);
101
102 return rtStatus;
103}
104
105
106
107
108
109
110RT_STATUS phy_RF8256_Config_ParaFile(struct net_device* dev)
111{
112 u32 u4RegValue = 0;
113 u8 eRFPath;
114 RT_STATUS rtStatus = RT_STATUS_SUCCESS;
115 BB_REGISTER_DEFINITION_T *pPhyReg;
116 struct r8192_priv *priv = ieee80211_priv(dev);
117 u32 RegOffSetToBeCheck = 0x3;
118 u32 RegValueToBeCheck = 0x7f1;
119 u32 RF3_Final_Value = 0;
120 u8 ConstRetryTimes = 5, RetryTimes = 5;
121 u8 ret = 0;
122
123
124
125 for(eRFPath = (RF90_RADIO_PATH_E)RF90_PATH_A; eRFPath <priv->NumTotalRFPath; eRFPath++)
126 {
127 if (!rtl8192_phy_CheckIsLegalRFPath(dev, eRFPath))
128 continue;
129
130 pPhyReg = &priv->PHYRegDef[eRFPath];
131
132
133
134
135
136 switch(eRFPath)
137 {
138 case RF90_PATH_A:
139 case RF90_PATH_C:
140 u4RegValue = rtl8192_QueryBBReg(dev, pPhyReg->rfintfs, bRFSI_RFENV);
141 break;
142 case RF90_PATH_B :
143 case RF90_PATH_D:
144 u4RegValue = rtl8192_QueryBBReg(dev, pPhyReg->rfintfs, bRFSI_RFENV<<16);
145 break;
146 }
147
148
149 rtl8192_setBBreg(dev, pPhyReg->rfintfe, bRFSI_RFENV<<16, 0x1);
150
151
152 rtl8192_setBBreg(dev, pPhyReg->rfintfo, bRFSI_RFENV, 0x1);
153
154
155 rtl8192_setBBreg(dev, pPhyReg->rfHSSIPara2, b3WireAddressLength, 0x0);
156 rtl8192_setBBreg(dev, pPhyReg->rfHSSIPara2, b3WireDataLength, 0x0);
157
158 rtl8192_phy_SetRFReg(dev, (RF90_RADIO_PATH_E) eRFPath, 0x0, bMask12Bits, 0xbf);
159
160
161
162 rtStatus = rtl8192_phy_checkBBAndRF(dev, HW90_BLOCK_RF, (RF90_RADIO_PATH_E)eRFPath);
163 if(rtStatus!= RT_STATUS_SUCCESS)
164 {
165 RT_TRACE(COMP_ERR, "PHY_RF8256_Config():Check Radio[%d] Fail!!\n", eRFPath);
166 goto phy_RF8256_Config_ParaFile_Fail;
167 }
168
169 RetryTimes = ConstRetryTimes;
170 RF3_Final_Value = 0;
171
172 switch(eRFPath)
173 {
174 case RF90_PATH_A:
175 while(RF3_Final_Value!=RegValueToBeCheck && RetryTimes!=0)
176 {
177 ret = rtl8192_phy_ConfigRFWithHeaderFile(dev,(RF90_RADIO_PATH_E)eRFPath);
178 RF3_Final_Value = rtl8192_phy_QueryRFReg(dev, (RF90_RADIO_PATH_E)eRFPath, RegOffSetToBeCheck, bMask12Bits);
179 RT_TRACE(COMP_RF, "RF %d %d register final value: %x\n", eRFPath, RegOffSetToBeCheck, RF3_Final_Value);
180 RetryTimes--;
181 }
182 break;
183 case RF90_PATH_B:
184 while(RF3_Final_Value!=RegValueToBeCheck && RetryTimes!=0)
185 {
186 ret = rtl8192_phy_ConfigRFWithHeaderFile(dev,(RF90_RADIO_PATH_E)eRFPath);
187 RF3_Final_Value = rtl8192_phy_QueryRFReg(dev, (RF90_RADIO_PATH_E)eRFPath, RegOffSetToBeCheck, bMask12Bits);
188 RT_TRACE(COMP_RF, "RF %d %d register final value: %x\n", eRFPath, RegOffSetToBeCheck, RF3_Final_Value);
189 RetryTimes--;
190 }
191 break;
192 case RF90_PATH_C:
193 while(RF3_Final_Value!=RegValueToBeCheck && RetryTimes!=0)
194 {
195 ret = rtl8192_phy_ConfigRFWithHeaderFile(dev,(RF90_RADIO_PATH_E)eRFPath);
196 RF3_Final_Value = rtl8192_phy_QueryRFReg(dev, (RF90_RADIO_PATH_E)eRFPath, RegOffSetToBeCheck, bMask12Bits);
197 RT_TRACE(COMP_RF, "RF %d %d register final value: %x\n", eRFPath, RegOffSetToBeCheck, RF3_Final_Value);
198 RetryTimes--;
199 }
200 break;
201 case RF90_PATH_D:
202 while(RF3_Final_Value!=RegValueToBeCheck && RetryTimes!=0)
203 {
204 ret = rtl8192_phy_ConfigRFWithHeaderFile(dev,(RF90_RADIO_PATH_E)eRFPath);
205 RF3_Final_Value = rtl8192_phy_QueryRFReg(dev, (RF90_RADIO_PATH_E)eRFPath, RegOffSetToBeCheck, bMask12Bits);
206 RT_TRACE(COMP_RF, "RF %d %d register final value: %x\n", eRFPath, RegOffSetToBeCheck, RF3_Final_Value);
207 RetryTimes--;
208 }
209 break;
210 }
211
212 ;
213 switch(eRFPath)
214 {
215 case RF90_PATH_A:
216 case RF90_PATH_C:
217 rtl8192_setBBreg(dev, pPhyReg->rfintfs, bRFSI_RFENV, u4RegValue);
218 break;
219 case RF90_PATH_B :
220 case RF90_PATH_D:
221 rtl8192_setBBreg(dev, pPhyReg->rfintfs, bRFSI_RFENV<<16, u4RegValue);
222 break;
223 }
224
225 if(ret){
226 RT_TRACE(COMP_ERR, "phy_RF8256_Config_ParaFile():Radio[%d] Fail!!", eRFPath);
227 goto phy_RF8256_Config_ParaFile_Fail;
228 }
229
230 }
231
232 RT_TRACE(COMP_PHY, "PHY Initialization Success\n") ;
233 return RT_STATUS_SUCCESS;
234
235phy_RF8256_Config_ParaFile_Fail:
236 RT_TRACE(COMP_ERR, "PHY Initialization failed\n") ;
237 return RT_STATUS_FAILURE;
238}
239
240
241void PHY_SetRF8256CCKTxPower(struct net_device* dev, u8 powerlevel)
242{
243 u32 TxAGC=0;
244 struct r8192_priv *priv = ieee80211_priv(dev);
245#ifdef RTL8190P
246 u8 byte0, byte1;
247
248 TxAGC |= ((powerlevel<<8)|powerlevel);
249 TxAGC += priv->CCKTxPowerLevelOriginalOffset;
250
251 if(priv->bDynamicTxLowPower == true
252 )
253 {
254 if(priv->CustomerID == RT_CID_819x_Netcore)
255 TxAGC = 0x2222;
256 else
257 TxAGC += ((priv->CckPwEnl<<8)|priv->CckPwEnl);
258 }
259
260 byte0 = (u8)(TxAGC & 0xff);
261 byte1 = (u8)((TxAGC & 0xff00)>>8);
262 if(byte0 > 0x24)
263 byte0 = 0x24;
264 if(byte1 > 0x24)
265 byte1 = 0x24;
266 if(priv->rf_type == RF_2T4R)
267 {
268 if(priv->RF_C_TxPwDiff > 0)
269 {
270 if( (byte0 + (u8)priv->RF_C_TxPwDiff) > 0x24)
271 byte0 = 0x24 - priv->RF_C_TxPwDiff;
272 if( (byte1 + (u8)priv->RF_C_TxPwDiff) > 0x24)
273 byte1 = 0x24 - priv->RF_C_TxPwDiff;
274 }
275 }
276 TxAGC = (byte1<<8) |byte0;
277 write_nic_dword(dev, CCK_TXAGC, TxAGC);
278#else
279 #ifdef RTL8192E
280
281 TxAGC = powerlevel;
282 if(priv->bDynamicTxLowPower == true)
283 {
284 if(priv->CustomerID == RT_CID_819x_Netcore)
285 TxAGC = 0x22;
286 else
287 TxAGC += priv->CckPwEnl;
288 }
289 if(TxAGC > 0x24)
290 TxAGC = 0x24;
291 rtl8192_setBBreg(dev, rTxAGC_CCK_Mcs32, bTxAGCRateCCK, TxAGC);
292 #endif
293#endif
294}
295
296
297void PHY_SetRF8256OFDMTxPower(struct net_device* dev, u8 powerlevel)
298{
299 struct r8192_priv *priv = ieee80211_priv(dev);
300
301#ifdef RTL8190P
302 u32 TxAGC1=0, TxAGC2=0, TxAGC2_tmp = 0;
303 u8 i, byteVal1[4], byteVal2[4], byteVal3[4];
304
305 if(priv->bDynamicTxHighPower == true)
306 {
307 TxAGC1 |= ((powerlevel<<24)|(powerlevel<<16)|(powerlevel<<8)|powerlevel);
308
309 TxAGC2_tmp = TxAGC1;
310
311 TxAGC1 += priv->MCSTxPowerLevelOriginalOffset[0];
312 TxAGC2 =0x03030303;
313
314
315 TxAGC2_tmp += priv->MCSTxPowerLevelOriginalOffset[1];
316 }
317 else
318 {
319 TxAGC1 |= ((powerlevel<<24)|(powerlevel<<16)|(powerlevel<<8)|powerlevel);
320 TxAGC2 = TxAGC1;
321
322 TxAGC1 += priv->MCSTxPowerLevelOriginalOffset[0];
323 TxAGC2 += priv->MCSTxPowerLevelOriginalOffset[1];
324
325 TxAGC2_tmp = TxAGC2;
326
327 }
328 for(i=0; i<4; i++)
329 {
330 byteVal1[i] = (u8)( (TxAGC1 & (0xff<<(i*8))) >>(i*8) );
331 if(byteVal1[i] > 0x24)
332 byteVal1[i] = 0x24;
333 byteVal2[i] = (u8)( (TxAGC2 & (0xff<<(i*8))) >>(i*8) );
334 if(byteVal2[i] > 0x24)
335 byteVal2[i] = 0x24;
336
337
338 byteVal3[i] = (u8)( (TxAGC2_tmp & (0xff<<(i*8))) >>(i*8) );
339 if(byteVal3[i] > 0x24)
340 byteVal3[i] = 0x24;
341 }
342
343 if(priv->rf_type == RF_2T4R)
344 {
345 if(priv->RF_C_TxPwDiff > 0)
346 {
347 for(i=0; i<4; i++)
348 {
349 if( (byteVal1[i] + (u8)priv->RF_C_TxPwDiff) > 0x24)
350 byteVal1[i] = 0x24 - priv->RF_C_TxPwDiff;
351 if( (byteVal2[i] + (u8)priv->RF_C_TxPwDiff) > 0x24)
352 byteVal2[i] = 0x24 - priv->RF_C_TxPwDiff;
353 if( (byteVal3[i] + (u8)priv->RF_C_TxPwDiff) > 0x24)
354 byteVal3[i] = 0x24 - priv->RF_C_TxPwDiff;
355 }
356 }
357 }
358
359 TxAGC1 = (byteVal1[3]<<24) | (byteVal1[2]<<16) |(byteVal1[1]<<8) |byteVal1[0];
360 TxAGC2 = (byteVal2[3]<<24) | (byteVal2[2]<<16) |(byteVal2[1]<<8) |byteVal2[0];
361
362
363 TxAGC2_tmp = (byteVal3[3]<<24) | (byteVal3[2]<<16) |(byteVal3[1]<<8) |byteVal3[0];
364 priv->Pwr_Track = TxAGC2_tmp;
365
366
367
368 write_nic_dword(dev, MCS_TXAGC, TxAGC1);
369 write_nic_dword(dev, MCS_TXAGC+4, TxAGC2);
370#else
371#ifdef RTL8192E
372 u32 writeVal, powerBase0, powerBase1, writeVal_tmp;
373 u8 index = 0;
374 u16 RegOffset[6] = {0xe00, 0xe04, 0xe10, 0xe14, 0xe18, 0xe1c};
375 u8 byte0, byte1, byte2, byte3;
376
377 powerBase0 = powerlevel + priv->LegacyHTTxPowerDiff;
378 powerBase0 = (powerBase0<<24) | (powerBase0<<16) |(powerBase0<<8) |powerBase0;
379 powerBase1 = powerlevel;
380 powerBase1 = (powerBase1<<24) | (powerBase1<<16) |(powerBase1<<8) |powerBase1;
381
382 for(index=0; index<6; index++)
383 {
384 writeVal = priv->MCSTxPowerLevelOriginalOffset[index] + ((index<2)?powerBase0:powerBase1);
385 byte0 = (u8)(writeVal & 0x7f);
386 byte1 = (u8)((writeVal & 0x7f00)>>8);
387 byte2 = (u8)((writeVal & 0x7f0000)>>16);
388 byte3 = (u8)((writeVal & 0x7f000000)>>24);
389 if(byte0 > 0x24)
390 byte0 = 0x24;
391 if(byte1 > 0x24)
392 byte1 = 0x24;
393 if(byte2 > 0x24)
394 byte2 = 0x24;
395 if(byte3 > 0x24)
396 byte3 = 0x24;
397
398 if(index == 3)
399 {
400 writeVal_tmp = (byte3<<24) | (byte2<<16) |(byte1<<8) |byte0;
401 priv->Pwr_Track = writeVal_tmp;
402 }
403
404 if(priv->bDynamicTxHighPower == true)
405 {
406 writeVal = 0x03030303;
407 }
408 else
409 {
410 writeVal = (byte3<<24) | (byte2<<16) |(byte1<<8) |byte0;
411 }
412 rtl8192_setBBreg(dev, RegOffset[index], 0x7f7f7f7f, writeVal);
413 }
414
415#endif
416#endif
417 return;
418}
419
420#define MAX_DOZE_WAITING_TIMES_9x 64
421static bool
422SetRFPowerState8190(
423 struct net_device* dev,
424 RT_RF_POWER_STATE eRFPowerState
425 )
426{
427 struct r8192_priv *priv = ieee80211_priv(dev);
428 PRT_POWER_SAVE_CONTROL pPSC = (PRT_POWER_SAVE_CONTROL)(&(priv->ieee80211->PowerSaveControl));
429 bool bResult = true;
430
431 u8 i = 0, QueueID = 0;
432 ptx_ring head=NULL,tail=NULL;
433
434 if(priv->SetRFPowerStateInProgress == true)
435 return false;
436 RT_TRACE(COMP_POWER, "===========> SetRFPowerState8190()!\n");
437 priv->SetRFPowerStateInProgress = true;
438
439 switch(priv->rf_chip)
440 {
441 case RF_8256:
442 switch( eRFPowerState )
443 {
444 case eRfOn:
445 RT_TRACE(COMP_POWER, "SetRFPowerState8190() eRfOn !\n");
446
447
448
449 #ifdef RTL8190P
450 if(priv->rf_type == RF_2T4R)
451 {
452
453 rtl8192_setBBreg(dev, rFPGA0_XA_RFInterfaceOE, BIT4, 0x1);
454
455 rtl8192_setBBreg(dev, rFPGA0_XC_RFInterfaceOE, BIT4, 0x1);
456
457 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter4, 0xf00, 0xf);
458
459 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter1, 0x1e0, 0xf);
460
461 rtl8192_setBBreg(dev, rOFDM0_TRxPathEnable, 0xf, 0xf);
462
463 rtl8192_setBBreg(dev, rOFDM1_TRxPathEnable, 0xf, 0xf);
464
465 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter1, 0x1e00, 0xf);
466 }
467 else if(priv->rf_type == RF_1T2R)
468 {
469
470 rtl8192_setBBreg(dev, rFPGA0_XC_RFInterfaceOE, BIT4, 0x1);
471
472 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter4, 0xc00, 0x3);
473
474 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter1, 0x180, 0x3);
475
476 rtl8192_setBBreg(dev, rOFDM0_TRxPathEnable, 0xc, 0x3);
477
478 rtl8192_setBBreg(dev, rOFDM1_TRxPathEnable, 0xc, 0x3);
479
480 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter1, 0x1800, 0x3);
481 }
482 #else
483 write_nic_byte(dev, ANAPAR, 0x37);
484 write_nic_byte(dev, MacBlkCtrl, 0x17);
485 mdelay(1);
486
487
488 priv->bHwRfOffAction = 0;
489
490
491
492 write_nic_byte(dev, BB_RESET, (read_nic_byte(dev, BB_RESET)|BIT0));
493
494
495
496 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter2, 0x20000000, 0x1);
497
498 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter1, 0x60, 0x3);
499
500 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter1, 0x98, 0x13);
501
502 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter4, 0xf03, 0xf03);
503
504
505
506
507
508
509
510 rtl8192_setBBreg(dev, rFPGA0_XA_RFInterfaceOE, BIT4, 0x1);
511 rtl8192_setBBreg(dev, rFPGA0_XB_RFInterfaceOE, BIT4, 0x1);
512 #endif
513 break;
514
515
516
517
518
519 case eRfSleep:
520 case eRfOff:
521 RT_TRACE(COMP_POWER, "SetRFPowerState8190() eRfOff/Sleep !\n");
522 if (pPSC->bLeisurePs)
523 {
524 for(QueueID = 0, i = 0; QueueID < MAX_TX_QUEUE; )
525 {
526 switch(QueueID) {
527 case MGNT_QUEUE:
528 tail=priv->txmapringtail;
529 head=priv->txmapringhead;
530 break;
531
532 case BK_QUEUE:
533 tail=priv->txbkpringtail;
534 head=priv->txbkpringhead;
535 break;
536
537 case BE_QUEUE:
538 tail=priv->txbepringtail;
539 head=priv->txbepringhead;
540 break;
541
542 case VI_QUEUE:
543 tail=priv->txvipringtail;
544 head=priv->txvipringhead;
545 break;
546
547 case VO_QUEUE:
548 tail=priv->txvopringtail;
549 head=priv->txvopringhead;
550 break;
551
552 default:
553 tail=head=NULL;
554 break;
555 }
556 if(tail == head)
557 {
558
559 QueueID++;
560 continue;
561 }
562 else
563 {
564 RT_TRACE(COMP_POWER, "eRf Off/Sleep: %d times BusyQueue[%d] !=0 before doze!\n", (i+1), QueueID);
565 udelay(10);
566 i++;
567 }
568
569 if(i >= MAX_DOZE_WAITING_TIMES_9x)
570 {
571 RT_TRACE(COMP_POWER, "\n\n\n TimeOut!! SetRFPowerState8190(): eRfOff: %d times BusyQueue[%d] != 0 !!!\n\n\n", MAX_DOZE_WAITING_TIMES_9x, QueueID);
572 break;
573 }
574 }
575 }
576 #ifdef RTL8190P
577 if(priv->rf_type == RF_2T4R)
578 {
579
580 rtl8192_setBBreg(dev, rFPGA0_XA_RFInterfaceOE, BIT4, 0x0);
581 }
582
583 rtl8192_setBBreg(dev, rFPGA0_XC_RFInterfaceOE, BIT4, 0x0);
584
585 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter4, 0xf00, 0x0);
586
587 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter1, 0x1e0, 0x0);
588
589 rtl8192_setBBreg(dev, rOFDM0_TRxPathEnable, 0xf, 0x0);
590
591 rtl8192_setBBreg(dev, rOFDM1_TRxPathEnable, 0xf, 0x0);
592
593 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter1, 0x1e00, 0x0);
594#else
595
596
597 rtl8192_setBBreg(dev, rFPGA0_XA_RFInterfaceOE, BIT4, 0x0);
598 rtl8192_setBBreg(dev, rFPGA0_XB_RFInterfaceOE, BIT4, 0x0);
599
600
601
602 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter4, 0xf03, 0x0);
603
604
605 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter1, 0x98, 0x0);
606
607
608
609
610
611 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter1, 0x60, 0x0);
612
613 rtl8192_setBBreg(dev, rFPGA0_AnalogParameter2, 0x20000000, 0x0);
614
615
616
617
618
619
620 write_nic_byte(dev, BB_RESET, (read_nic_byte(dev, BB_RESET)|BIT0));
621
622 write_nic_byte(dev, MacBlkCtrl, 0x0);
623
624 write_nic_byte(dev, ANAPAR, 0x07);
625 priv->bHwRfOffAction = 0;
626
627 #endif
628 break;
629
630 default:
631 bResult = false;
632 RT_TRACE(COMP_ERR, "SetRFPowerState8190(): unknow state to set: 0x%X!!!\n", eRFPowerState);
633 break;
634 }
635
636 break;
637
638 default:
639 RT_TRACE(COMP_ERR, "SetRFPowerState8190(): Unknown RF type\n");
640 break;
641 }
642
643 if(bResult)
644 {
645
646 priv->ieee80211->eRFPowerState = eRFPowerState;
647
648 switch(priv->rf_chip )
649 {
650 case RF_8256:
651 switch(priv->ieee80211->eRFPowerState)
652 {
653 case eRfOff:
654
655
656
657 if(priv->ieee80211->RfOffReason==RF_CHANGE_BY_IPS )
658 {
659 #ifdef TO_DO
660 Adapter->HalFunc.LedControlHandler(Adapter,LED_CTL_NO_LINK);
661 #endif
662 }
663 else
664 {
665
666 #ifdef TO_DO
667 Adapter->HalFunc.LedControlHandler(Adapter, LED_CTL_POWER_OFF);
668 #endif
669 }
670 break;
671
672 case eRfOn:
673
674
675 if( priv->ieee80211->state == IEEE80211_LINKED)
676 {
677 #ifdef TO_DO
678 Adapter->HalFunc.LedControlHandler(Adapter, LED_CTL_LINK);
679 #endif
680 }
681 else
682 {
683
684 #ifdef TO_DO
685 Adapter->HalFunc.LedControlHandler(Adapter, LED_CTL_NO_LINK);
686 #endif
687 }
688 break;
689
690 default:
691
692 break;
693 }
694
695 break;
696
697 default:
698 RT_TRACE(COMP_ERR, "SetRFPowerState8190(): Unknown RF type\n");
699 break;
700 }
701 }
702
703 priv->SetRFPowerStateInProgress = false;
704 RT_TRACE(COMP_POWER, "<=========== SetRFPowerState8190() bResult = %d!\n", bResult);
705 return bResult;
706}
707
708
709
710
711
712
713
714
715
716
717
718
719
720static bool
721SetRFPowerState(
722 struct net_device* dev,
723 RT_RF_POWER_STATE eRFPowerState
724 )
725{
726 struct r8192_priv *priv = ieee80211_priv(dev);
727
728 bool bResult = false;
729
730 RT_TRACE(COMP_RF,"---------> SetRFPowerState(): eRFPowerState(%d)\n", eRFPowerState);
731#ifdef RTL8192E
732 if(eRFPowerState == priv->ieee80211->eRFPowerState && priv->bHwRfOffAction == 0)
733#else
734 if(eRFPowerState == priv->ieee80211->eRFPowerState)
735#endif
736 {
737 RT_TRACE(COMP_POWER, "<--------- SetRFPowerState(): discard the request for eRFPowerState(%d) is the same.\n", eRFPowerState);
738 return bResult;
739 }
740
741 bResult = SetRFPowerState8190(dev, eRFPowerState);
742
743 RT_TRACE(COMP_POWER, "<--------- SetRFPowerState(): bResult(%d)\n", bResult);
744
745 return bResult;
746}
747
748static void
749MgntDisconnectIBSS(
750 struct net_device* dev
751)
752{
753 struct r8192_priv *priv = ieee80211_priv(dev);
754
755 u8 i;
756 bool bFilterOutNonAssociatedBSSID = false;
757
758
759
760 priv->ieee80211->state = IEEE80211_NOLINK;
761
762
763 for(i=0;i<6;i++) priv->ieee80211->current_network.bssid[i]= 0x55;
764 priv->OpMode = RT_OP_MODE_NO_LINK;
765 write_nic_word(dev, BSSIDR, ((u16*)priv->ieee80211->current_network.bssid)[0]);
766 write_nic_dword(dev, BSSIDR+2, ((u32*)(priv->ieee80211->current_network.bssid+2))[0]);
767 {
768 RT_OP_MODE OpMode = priv->OpMode;
769
770 u8 btMsr = read_nic_byte(dev, MSR);
771
772 btMsr &= 0xfc;
773
774 switch(OpMode)
775 {
776 case RT_OP_MODE_INFRASTRUCTURE:
777 btMsr |= MSR_LINK_MANAGED;
778
779 break;
780
781 case RT_OP_MODE_IBSS:
782 btMsr |= MSR_LINK_ADHOC;
783
784 break;
785
786 case RT_OP_MODE_AP:
787 btMsr |= MSR_LINK_MASTER;
788
789 break;
790
791 default:
792 btMsr |= MSR_LINK_NONE;
793 break;
794 }
795
796 write_nic_byte(dev, MSR, btMsr);
797
798
799
800 }
801 ieee80211_stop_send_beacons(priv->ieee80211);
802
803
804 bFilterOutNonAssociatedBSSID = false;
805 {
806 u32 RegRCR, Type;
807 Type = bFilterOutNonAssociatedBSSID;
808 RegRCR = read_nic_dword(dev,RCR);
809 priv->ReceiveConfig = RegRCR;
810 if (Type == true)
811 RegRCR |= (RCR_CBSSID);
812 else if (Type == false)
813 RegRCR &= (~RCR_CBSSID);
814
815 {
816 write_nic_dword(dev, RCR,RegRCR);
817 priv->ReceiveConfig = RegRCR;
818 }
819
820 }
821
822 notify_wx_assoc_event(priv->ieee80211);
823
824}
825
826static void
827MlmeDisassociateRequest(
828 struct net_device* dev,
829 u8* asSta,
830 u8 asRsn
831 )
832{
833 struct r8192_priv *priv = ieee80211_priv(dev);
834 u8 i;
835
836 RemovePeerTS(priv->ieee80211, asSta);
837
838 SendDisassociation( priv->ieee80211, asSta, asRsn );
839
840 if(memcpy(priv->ieee80211->current_network.bssid,asSta,6) == NULL)
841 {
842
843
844 priv->ieee80211->state = IEEE80211_NOLINK;
845
846 for(i=0;i<6;i++) priv->ieee80211->current_network.bssid[i] = 0x22;
847
848
849 priv->OpMode = RT_OP_MODE_NO_LINK;
850 {
851 RT_OP_MODE OpMode = priv->OpMode;
852
853 u8 btMsr = read_nic_byte(dev, MSR);
854
855 btMsr &= 0xfc;
856
857 switch(OpMode)
858 {
859 case RT_OP_MODE_INFRASTRUCTURE:
860 btMsr |= MSR_LINK_MANAGED;
861
862 break;
863
864 case RT_OP_MODE_IBSS:
865 btMsr |= MSR_LINK_ADHOC;
866
867 break;
868
869 case RT_OP_MODE_AP:
870 btMsr |= MSR_LINK_MASTER;
871
872 break;
873
874 default:
875 btMsr |= MSR_LINK_NONE;
876 break;
877 }
878
879 write_nic_byte(dev, MSR, btMsr);
880
881
882
883 }
884 ieee80211_disassociate(priv->ieee80211);
885
886 write_nic_word(dev, BSSIDR, ((u16*)priv->ieee80211->current_network.bssid)[0]);
887 write_nic_dword(dev, BSSIDR+2, ((u32*)(priv->ieee80211->current_network.bssid+2))[0]);
888
889 }
890
891}
892
893
894static void
895MgntDisconnectAP(
896 struct net_device* dev,
897 u8 asRsn
898)
899{
900 struct r8192_priv *priv = ieee80211_priv(dev);
901 bool bFilterOutNonAssociatedBSSID = false;
902
903
904
905
906
907
908
909
910
911#ifdef TO_DO
912 if( pMgntInfo->SecurityInfo.AuthMode > RT_802_11AuthModeAutoSwitch ||
913 (pMgntInfo->bAPSuportCCKM && pMgntInfo->bCCX8021xenable) )
914 {
915 SecClearAllKeys(Adapter);
916 RT_TRACE(COMP_SEC, DBG_LOUD,("======>CCKM clear key..."))
917 }
918#endif
919
920 bFilterOutNonAssociatedBSSID = false;
921 {
922 u32 RegRCR, Type;
923
924 Type = bFilterOutNonAssociatedBSSID;
925
926 RegRCR = read_nic_dword(dev,RCR);
927 priv->ReceiveConfig = RegRCR;
928
929 if (Type == true)
930 RegRCR |= (RCR_CBSSID);
931 else if (Type == false)
932 RegRCR &= (~RCR_CBSSID);
933
934 write_nic_dword(dev, RCR,RegRCR);
935 priv->ReceiveConfig = RegRCR;
936
937
938 }
939
940
941 MlmeDisassociateRequest( dev, priv->ieee80211->current_network.bssid, asRsn );
942
943 priv->ieee80211->state = IEEE80211_NOLINK;
944
945}
946
947
948static bool
949MgntDisconnect(
950 struct net_device* dev,
951 u8 asRsn
952)
953{
954 struct r8192_priv *priv = ieee80211_priv(dev);
955
956
957
958
959#ifdef TO_DO
960 if(pMgntInfo->mPss != eAwake)
961 {
962
963
964
965
966
967 PlatformSetTimer( Adapter, &(pMgntInfo->AwakeTimer), 0 );
968 }
969#endif
970
971#ifdef TO_DO
972 if(pMgntInfo->mActingAsAp)
973 {
974 RT_TRACE(COMP_MLME, DBG_LOUD, ("MgntDisconnect() ===> AP_DisassociateAllStation\n"));
975 AP_DisassociateAllStation(Adapter, unspec_reason);
976 return TRUE;
977 }
978#endif
979
980
981
982
983 if( priv->ieee80211->state == IEEE80211_LINKED )
984 {
985 if( priv->ieee80211->iw_mode == IW_MODE_ADHOC )
986 {
987
988 MgntDisconnectIBSS(dev);
989 }
990 if( priv->ieee80211->iw_mode == IW_MODE_INFRA )
991 {
992
993
994
995
996
997
998 MgntDisconnectAP(dev, asRsn);
999 }
1000
1001
1002
1003 }
1004
1005 return true;
1006}
1007
1008
1009
1010
1011
1012
1013
1014
1015
1016bool
1017MgntActSet_RF_State(
1018 struct net_device* dev,
1019 RT_RF_POWER_STATE StateToSet,
1020 RT_RF_CHANGE_SOURCE ChangeSource
1021 )
1022{
1023 struct r8192_priv *priv = ieee80211_priv(dev);
1024 bool bActionAllowed = false;
1025 bool bConnectBySSID = false;
1026 RT_RF_POWER_STATE rtState;
1027 u16 RFWaitCounter = 0;
1028 unsigned long flag;
1029 RT_TRACE(COMP_POWER, "===>MgntActSet_RF_State(): StateToSet(%d)\n",StateToSet);
1030
1031
1032
1033
1034
1035
1036 while(true)
1037 {
1038 spin_lock_irqsave(&priv->rf_ps_lock,flag);
1039 if(priv->RFChangeInProgress)
1040 {
1041 spin_unlock_irqrestore(&priv->rf_ps_lock,flag);
1042 RT_TRACE(COMP_POWER, "MgntActSet_RF_State(): RF Change in progress! Wait to set..StateToSet(%d).\n", StateToSet);
1043
1044
1045 while(priv->RFChangeInProgress)
1046 {
1047 RFWaitCounter ++;
1048 RT_TRACE(COMP_POWER, "MgntActSet_RF_State(): Wait 1 ms (%d times)...\n", RFWaitCounter);
1049 udelay(1000);
1050
1051
1052 if(RFWaitCounter > 100)
1053 {
1054 RT_TRACE(COMP_ERR, "MgntActSet_RF_State(): Wait too logn to set RF\n");
1055
1056 return false;
1057 }
1058 }
1059 }
1060 else
1061 {
1062 priv->RFChangeInProgress = true;
1063 spin_unlock_irqrestore(&priv->rf_ps_lock,flag);
1064 break;
1065 }
1066 }
1067
1068 rtState = priv->ieee80211->eRFPowerState;
1069
1070 switch(StateToSet)
1071 {
1072 case eRfOn:
1073
1074
1075
1076
1077
1078 priv->ieee80211->RfOffReason &= (~ChangeSource);
1079
1080 if(! priv->ieee80211->RfOffReason)
1081 {
1082 priv->ieee80211->RfOffReason = 0;
1083 bActionAllowed = true;
1084
1085
1086 if(rtState == eRfOff && ChangeSource >=RF_CHANGE_BY_HW )
1087 {
1088 bConnectBySSID = true;
1089 }
1090 }
1091 else
1092 RT_TRACE(COMP_POWER, "MgntActSet_RF_State - eRfon reject pMgntInfo->RfOffReason= 0x%x, ChangeSource=0x%X\n", priv->ieee80211->RfOffReason, ChangeSource);
1093
1094 break;
1095
1096 case eRfOff:
1097
1098 if (priv->ieee80211->RfOffReason > RF_CHANGE_BY_IPS)
1099 {
1100
1101
1102
1103
1104
1105
1106 MgntDisconnect(dev, disas_lv_ss);
1107
1108
1109
1110
1111 }
1112
1113
1114 priv->ieee80211->RfOffReason |= ChangeSource;
1115 bActionAllowed = true;
1116 break;
1117
1118 case eRfSleep:
1119 priv->ieee80211->RfOffReason |= ChangeSource;
1120 bActionAllowed = true;
1121 break;
1122
1123 default:
1124 break;
1125 }
1126
1127 if(bActionAllowed)
1128 {
1129 RT_TRACE(COMP_POWER, "MgntActSet_RF_State(): Action is allowed.... StateToSet(%d), RfOffReason(%#X)\n", StateToSet, priv->ieee80211->RfOffReason);
1130
1131 SetRFPowerState(dev, StateToSet);
1132
1133 if(StateToSet == eRfOn)
1134 {
1135
1136 if(bConnectBySSID)
1137 {
1138
1139 }
1140 }
1141
1142 else if(StateToSet == eRfOff)
1143 {
1144
1145 }
1146 }
1147 else
1148 {
1149 RT_TRACE(COMP_POWER, "MgntActSet_RF_State(): Action is rejected.... StateToSet(%d), ChangeSource(%#X), RfOffReason(%#X)\n", StateToSet, ChangeSource, priv->ieee80211->RfOffReason);
1150 }
1151
1152
1153 spin_lock_irqsave(&priv->rf_ps_lock,flag);
1154 priv->RFChangeInProgress = false;
1155 spin_unlock_irqrestore(&priv->rf_ps_lock,flag);
1156
1157 RT_TRACE(COMP_POWER, "<===MgntActSet_RF_State()\n");
1158 return bActionAllowed;
1159}
1160
1161
1162