Staging: w35und: kill WBDEBUG and remove common.h header file
[firefly-linux-kernel-4.4.55.git] / drivers / staging / winbond / mto.c
1 //============================================================================
2 //  MTO.C -
3 //
4 //  Description:
5 //    MAC Throughput Optimization for W89C33 802.11g WLAN STA.
6 //
7 //    The following MIB attributes or internal variables will be affected
8 //    while the MTO is being executed:
9 //       dot11FragmentationThreshold,
10 //       dot11RTSThreshold,
11 //       transmission rate and PLCP preamble type,
12 //       CCA mode,
13 //       antenna diversity.
14 //
15 //  Revision history:
16 //  --------------------------------------------------------------------------
17 //           20031227  UN20 Pete Chao
18 //                     First draft
19 //  20031229           Turbo                copy from PD43
20 //  20040210           Kevin                revised
21 //  Copyright (c) 2003 Winbond Electronics Corp. All rights reserved.
22 //============================================================================
23
24 // LA20040210_DTO kevin
25 #include "sysdef.h"
26 #include "sme_api.h"
27 #include "gl_80211.h"
28 #include "wbhal_f.h"
29
30 // Declare SQ3 to rate and fragmentation threshold table
31 // Declare fragmentation thresholds table
32 #define MTO_MAX_FRAG_TH_LEVELS                  5
33 #define MTO_MAX_DATA_RATE_LEVELS                12
34
35 u16 MTO_Frag_Th_Tbl[MTO_MAX_FRAG_TH_LEVELS] =
36 {
37     256, 384, 512, 768, 1536
38 };
39
40 // Declare data rate table
41 //The following table will be changed at anytime if the opration rate supported by AP don't
42 //match the table
43 static u8 MTO_Data_Rate_Tbl[MTO_MAX_DATA_RATE_LEVELS] = {
44     2, 4, 11, 22, 12, 18, 24, 36, 48, 72, 96, 108
45 };
46
47 static int TotalTxPkt = 0;
48 static int TotalTxPktRetry = 0;
49 static int retryrate_rec[MTO_MAX_DATA_RATE_LEVELS];//this record the retry rate at different data rate
50
51 static int PeriodTotalTxPkt = 0;
52 static int PeriodTotalTxPktRetry = 0;
53
54 typedef struct
55 {
56         s32 RSSI;
57         u8  TxRate;
58 }RSSI2RATE;
59
60 static u8 boSparseTxTraffic = false;
61
62 void MTO_Init(MTO_FUNC_INPUT);
63 void TxRateReductionCtrl(MTO_FUNC_INPUT);
64 /** 1.1.31.1000 Turbo modify */
65 void MTO_SetTxCount(MTO_FUNC_INPUT, u8 t0, u8 index);
66 void MTO_TxFailed(MTO_FUNC_INPUT);
67 void hal_get_dto_para(MTO_FUNC_INPUT, char *buffer);
68
69 //===========================================================================
70 //  MTO_Init --
71 //
72 //  Description:
73 //    Initialize MTO parameters.
74 //
75 //    This function should be invoked during system initialization.
76 //
77 //  Arguments:
78 //    adapter      - The pointer to the Miniport adapter Context
79 //
80 //  Return Value:
81 //    None
82 //============================================================================
83 void MTO_Init(MTO_FUNC_INPUT)
84 {
85     int i;
86         //[WKCHEN]pMTOcore_data = pcore_data;
87 // 20040510 Turbo add for global variable
88     MTO_TMR_CNT()       = 0;
89     MTO_TOGGLE_STATE()  = TOGGLE_STATE_IDLE;
90     MTO_TX_RATE_REDUCTION_STATE() = RATE_CHGSTATE_IDLE;
91     MTO_BACKOFF_TMR()   = 0;
92     MTO_LAST_RATE()     = 11;
93     MTO_CO_EFFICENT()   = 0;
94
95     //MTO_TH_FIXANT()     = MTO_DEFAULT_TH_FIXANT;
96     MTO_TH_CNT()        = MTO_DEFAULT_TH_CNT;
97     MTO_TH_SQ3()        = MTO_DEFAULT_TH_SQ3;
98     MTO_TH_IDLE_SLOT()  = MTO_DEFAULT_TH_IDLE_SLOT;
99     MTO_TH_PR_INTERF()  = MTO_DEFAULT_TH_PR_INTERF;
100
101     MTO_TMR_AGING()     = MTO_DEFAULT_TMR_AGING;
102     MTO_TMR_PERIODIC()  = MTO_DEFAULT_TMR_PERIODIC;
103
104     //[WKCHEN]MTO_CCA_MODE_SETUP()= (u8) hal_get_cca_mode(MTO_HAL());
105     //[WKCHEN]MTO_CCA_MODE()      = MTO_CCA_MODE_SETUP();
106
107     //MTO_PREAMBLE_TYPE() = MTO_PREAMBLE_LONG;
108     MTO_PREAMBLE_TYPE() = MTO_PREAMBLE_SHORT;   // for test
109
110     MTO_ANT_SEL()       = hal_get_antenna_number(MTO_HAL());
111     MTO_ANT_MAC()       = MTO_ANT_SEL();
112     MTO_CNT_ANT(0)      = 0;
113     MTO_CNT_ANT(1)      = 0;
114     MTO_SQ_ANT(0)       = 0;
115     MTO_SQ_ANT(1)       = 0;
116     MTO_ANT_DIVERSITY() = MTO_ANTENNA_DIVERSITY_ON;
117     //CardSet_AntennaDiversity(adapter, MTO_ANT_DIVERSITY());
118     //PLMESetAntennaDiversity( adapter, MTO_ANT_DIVERSITY());
119
120     MTO_AGING_TIMEOUT() = 0;//MTO_TMR_AGING() / MTO_TMR_PERIODIC();
121
122     // The following parameters should be initialized to the values set by user
123     //
124     //MTO_RATE_LEVEL()            = 10;
125     MTO_RATE_LEVEL()            = 0;
126     MTO_FRAG_TH_LEVEL()         = 4;
127     /** 1.1.23.1000 Turbo modify from -1 to +1
128         MTO_RTS_THRESHOLD()         = MTO_FRAG_TH() - 1;
129     MTO_RTS_THRESHOLD_SETUP()   = MTO_FRAG_TH() - 1;
130         */
131         MTO_RTS_THRESHOLD()         = MTO_FRAG_TH() + 1;
132     MTO_RTS_THRESHOLD_SETUP()   = MTO_FRAG_TH() + 1;
133     // 1.1.23.1000 Turbo add for mto change preamble from 0 to 1
134         MTO_RATE_CHANGE_ENABLE()    = 1;
135     MTO_FRAG_CHANGE_ENABLE()    = 0;          // 1.1.29.1000 Turbo add don't support frag
136         //The default valud of ANTDIV_DEFAULT_ON will be decided by EEPROM
137         //#ifdef ANTDIV_DEFAULT_ON
138     //MTO_ANT_DIVERSITY_ENABLE()  = 1;
139         //#else
140     //MTO_ANT_DIVERSITY_ENABLE()  = 0;
141         //#endif
142     MTO_POWER_CHANGE_ENABLE()   = 1;
143         MTO_PREAMBLE_CHANGE_ENABLE()= 1;
144     MTO_RTS_CHANGE_ENABLE()     = 0;          // 1.1.29.1000 Turbo add don't support frag
145     // 20040512 Turbo add
146         //old_antenna[0] = 1;
147         //old_antenna[1] = 0;
148         //old_antenna[2] = 1;
149         //old_antenna[3] = 0;
150         for (i=0;i<MTO_MAX_DATA_RATE_LEVELS;i++)
151                 retryrate_rec[i]=5;
152
153         MTO_TXFLOWCOUNT() = 0;
154         //--------- DTO threshold parameters -------------
155         //MTOPARA_PERIODIC_CHECK_CYCLE() = 50;
156         MTOPARA_PERIODIC_CHECK_CYCLE() = 10;
157         MTOPARA_RSSI_TH_FOR_ANTDIV() = 10;
158         MTOPARA_TXCOUNT_TH_FOR_CALC_RATE() = 50;
159         MTOPARA_TXRATE_INC_TH() = 10;
160         MTOPARA_TXRATE_DEC_TH() = 30;
161         MTOPARA_TXRATE_EQ_TH() = 40;
162         MTOPARA_TXRATE_BACKOFF() = 12;
163         MTOPARA_TXRETRYRATE_REDUCE() = 6;
164         if ( MTO_TXPOWER_FROM_EEPROM == 0xff)
165         {
166                 switch( MTO_HAL()->phy_type)
167                 {
168                         case RF_AIROHA_2230:
169                         case RF_AIROHA_2230S: // 20060420 Add this
170                                 MTOPARA_TXPOWER_INDEX() = 46; // MAX-8 // @@ Only for AL 2230
171                                 break;
172                         case RF_AIROHA_7230:
173                                 MTOPARA_TXPOWER_INDEX() = 49;
174                                 break;
175                         case RF_WB_242:
176                                 MTOPARA_TXPOWER_INDEX() = 10;
177                                 break;
178                         case RF_WB_242_1:
179                                 MTOPARA_TXPOWER_INDEX() = 24; // ->10 20060316.1 modify
180                                 break;
181                 }
182         }
183         else    //follow the setting from EEPROM
184                 MTOPARA_TXPOWER_INDEX() = MTO_TXPOWER_FROM_EEPROM;
185         hal_set_rf_power(MTO_HAL(), (u8)MTOPARA_TXPOWER_INDEX());
186         //------------------------------------------------
187
188         // For RSSI turning 20060808.4 Cancel load from EEPROM
189         MTO_DATA().RSSI_high = -41;
190         MTO_DATA().RSSI_low = -60;
191 }
192
193 //===========================================================================
194 //  Description:
195 //      If we enable DTO, we will ignore the tx count with different tx rate from
196 //      DTO rate. This is because when we adjust DTO tx rate, there could be some
197 //      packets in the tx queue with previous tx rate
198 void MTO_SetTxCount(MTO_FUNC_INPUT, u8 tx_rate, u8 index)
199 {
200         MTO_TXFLOWCOUNT()++;
201         if ((MTO_ENABLE==1) && (MTO_RATE_CHANGE_ENABLE()==1))
202         {
203                 if(tx_rate == MTO_DATA_RATE())
204                 {
205                         if (index == 0)
206                         {
207                                 if (boSparseTxTraffic)
208                                         MTO_HAL()->dto_tx_frag_count += MTOPARA_PERIODIC_CHECK_CYCLE();
209                                 else
210                                         MTO_HAL()->dto_tx_frag_count += 1;
211                         }
212                         else
213                         {
214                                 if (index<8)
215                                 {
216                                         MTO_HAL()->dto_tx_retry_count += index;
217                                         MTO_HAL()->dto_tx_frag_count += (index+1);
218                                 }
219                                 else
220                                 {
221                                         MTO_HAL()->dto_tx_retry_count += 7;
222                                         MTO_HAL()->dto_tx_frag_count += 7;
223                                 }
224                         }
225                 }
226                 else if(MTO_DATA_RATE()>48 && tx_rate ==48)
227                 {//ALFRED
228                         if (index<3) //for reduciing data rate scheme ,
229                                          //do not calcu different data rate
230                                                  //3 is the reducing data rate at retry
231                         {
232                                 MTO_HAL()->dto_tx_retry_count += index;
233                                 MTO_HAL()->dto_tx_frag_count += (index+1);
234                         }
235                         else
236                         {
237                                 MTO_HAL()->dto_tx_retry_count += 3;
238                                 MTO_HAL()->dto_tx_frag_count += 3;
239                         }
240
241                 }
242         }
243         else
244         {
245                 MTO_HAL()->dto_tx_retry_count += index;
246                 MTO_HAL()->dto_tx_frag_count += (index+1);
247         }
248         TotalTxPkt ++;
249         TotalTxPktRetry += (index+1);
250
251         PeriodTotalTxPkt ++;
252         PeriodTotalTxPktRetry += (index+1);
253 }