1 /******************************************************************************
2 * Copyright(c) 2008 - 2010 Realtek Corporation. All rights reserved.
4 * This program is distributed in the hope that it will be useful, but WITHOUT
5 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
6 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
9 * You should have received a copy of the GNU General Public License along with
10 * this program; if not, write to the Free Software Foundation, Inc.,
11 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
13 * The full GNU General Public License is included in this distribution in the
14 * file called LICENSE.
16 * Contact Information:
17 * wlanfae <wlanfae@realtek.com>
18 ******************************************************************************/
20 #include <linux/etherdevice.h>
21 #include "rtl819x_TS.h"
23 static void TsSetupTimeOut(unsigned long data
)
27 static void TsInactTimeout(unsigned long data
)
31 static void RxPktPendingTimeout(unsigned long data
)
33 struct rx_ts_record
*pRxTs
= (struct rx_ts_record
*)data
;
34 struct rtllib_device
*ieee
= container_of(pRxTs
, struct rtllib_device
,
35 RxTsRecord
[pRxTs
->num
]);
37 struct rx_reorder_entry
*pReorderEntry
= NULL
;
39 unsigned long flags
= 0;
41 bool bPktInBuf
= false;
43 spin_lock_irqsave(&(ieee
->reorder_spinlock
), flags
);
44 if (pRxTs
->RxTimeoutIndicateSeq
!= 0xffff) {
45 while (!list_empty(&pRxTs
->RxPendingPktList
)) {
46 pReorderEntry
= (struct rx_reorder_entry
*)
47 list_entry(pRxTs
->RxPendingPktList
.prev
,
48 struct rx_reorder_entry
, List
);
50 pRxTs
->RxIndicateSeq
= pReorderEntry
->SeqNum
;
52 if (SN_LESS(pReorderEntry
->SeqNum
, pRxTs
->RxIndicateSeq
) ||
53 SN_EQUAL(pReorderEntry
->SeqNum
, pRxTs
->RxIndicateSeq
)) {
54 list_del_init(&pReorderEntry
->List
);
56 if (SN_EQUAL(pReorderEntry
->SeqNum
,
57 pRxTs
->RxIndicateSeq
))
58 pRxTs
->RxIndicateSeq
=
59 (pRxTs
->RxIndicateSeq
+ 1) % 4096;
61 RTLLIB_DEBUG(RTLLIB_DL_REORDER
, "%s(): Indicate"
62 " SeqNum: %d\n", __func__
,
63 pReorderEntry
->SeqNum
);
64 ieee
->stats_IndicateArray
[index
] =
68 list_add_tail(&pReorderEntry
->List
,
69 &ieee
->RxReorder_Unused_List
);
78 pRxTs
->RxTimeoutIndicateSeq
= 0xffff;
80 if (index
> REORDER_WIN_SIZE
) {
81 RTLLIB_DEBUG(RTLLIB_DL_ERR
, "RxReorderIndicatePacket():"
82 " Rx Reorer struct buffer full!!\n");
83 spin_unlock_irqrestore(&(ieee
->reorder_spinlock
),
87 rtllib_indicate_packets(ieee
, ieee
->stats_IndicateArray
, index
);
91 if (bPktInBuf
&& (pRxTs
->RxTimeoutIndicateSeq
== 0xffff)) {
92 pRxTs
->RxTimeoutIndicateSeq
= pRxTs
->RxIndicateSeq
;
93 mod_timer(&pRxTs
->RxPktPendingTimer
, jiffies
+
94 MSECS(ieee
->pHTInfo
->RxReorderPendingTime
));
96 spin_unlock_irqrestore(&(ieee
->reorder_spinlock
), flags
);
99 static void TsAddBaProcess(unsigned long data
)
101 struct tx_ts_record
*pTxTs
= (struct tx_ts_record
*)data
;
103 struct rtllib_device
*ieee
= container_of(pTxTs
, struct rtllib_device
,
106 TsInitAddBA(ieee
, pTxTs
, BA_POLICY_IMMEDIATE
, false);
107 RTLLIB_DEBUG(RTLLIB_DL_BA
, "TsAddBaProcess(): ADDBA Req is "
111 static void ResetTsCommonInfo(struct ts_common_info
*pTsCommonInfo
)
113 memset(pTsCommonInfo
->Addr
, 0, 6);
114 memset(&pTsCommonInfo
->TSpec
, 0, sizeof(union tspec_body
));
115 memset(&pTsCommonInfo
->TClass
, 0, sizeof(union qos_tclas
)*TCLAS_NUM
);
116 pTsCommonInfo
->TClasProc
= 0;
117 pTsCommonInfo
->TClasNum
= 0;
120 static void ResetTxTsEntry(struct tx_ts_record
*pTS
)
122 ResetTsCommonInfo(&pTS
->TsCommonInfo
);
124 pTS
->bAddBaReqInProgress
= false;
125 pTS
->bAddBaReqDelayed
= false;
126 pTS
->bUsingBa
= false;
127 pTS
->bDisable_AddBa
= false;
128 ResetBaEntry(&pTS
->TxAdmittedBARecord
);
129 ResetBaEntry(&pTS
->TxPendingBARecord
);
132 static void ResetRxTsEntry(struct rx_ts_record
*pTS
)
134 ResetTsCommonInfo(&pTS
->TsCommonInfo
);
135 pTS
->RxIndicateSeq
= 0xffff;
136 pTS
->RxTimeoutIndicateSeq
= 0xffff;
137 ResetBaEntry(&pTS
->RxAdmittedBARecord
);
140 void TSInitialize(struct rtllib_device
*ieee
)
142 struct tx_ts_record
*pTxTS
= ieee
->TxTsRecord
;
143 struct rx_ts_record
*pRxTS
= ieee
->RxTsRecord
;
144 struct rx_reorder_entry
*pRxReorderEntry
= ieee
->RxReorderEntry
;
146 RTLLIB_DEBUG(RTLLIB_DL_TS
, "==========>%s()\n", __func__
);
147 INIT_LIST_HEAD(&ieee
->Tx_TS_Admit_List
);
148 INIT_LIST_HEAD(&ieee
->Tx_TS_Pending_List
);
149 INIT_LIST_HEAD(&ieee
->Tx_TS_Unused_List
);
151 for (count
= 0; count
< TOTAL_TS_NUM
; count
++) {
153 _setup_timer(&pTxTS
->TsCommonInfo
.SetupTimer
,
155 (unsigned long) pTxTS
);
157 _setup_timer(&pTxTS
->TsCommonInfo
.InactTimer
,
159 (unsigned long) pTxTS
);
161 _setup_timer(&pTxTS
->TsAddBaTimer
,
163 (unsigned long) pTxTS
);
165 _setup_timer(&pTxTS
->TxPendingBARecord
.Timer
,
167 (unsigned long) pTxTS
);
168 _setup_timer(&pTxTS
->TxAdmittedBARecord
.Timer
,
170 (unsigned long) pTxTS
);
172 ResetTxTsEntry(pTxTS
);
173 list_add_tail(&pTxTS
->TsCommonInfo
.List
,
174 &ieee
->Tx_TS_Unused_List
);
178 INIT_LIST_HEAD(&ieee
->Rx_TS_Admit_List
);
179 INIT_LIST_HEAD(&ieee
->Rx_TS_Pending_List
);
180 INIT_LIST_HEAD(&ieee
->Rx_TS_Unused_List
);
181 for (count
= 0; count
< TOTAL_TS_NUM
; count
++) {
183 INIT_LIST_HEAD(&pRxTS
->RxPendingPktList
);
185 _setup_timer(&pRxTS
->TsCommonInfo
.SetupTimer
,
187 (unsigned long) pRxTS
);
189 _setup_timer(&pRxTS
->TsCommonInfo
.InactTimer
,
191 (unsigned long) pRxTS
);
193 _setup_timer(&pRxTS
->RxAdmittedBARecord
.Timer
,
195 (unsigned long) pRxTS
);
197 _setup_timer(&pRxTS
->RxPktPendingTimer
,
199 (unsigned long) pRxTS
);
201 ResetRxTsEntry(pRxTS
);
202 list_add_tail(&pRxTS
->TsCommonInfo
.List
,
203 &ieee
->Rx_TS_Unused_List
);
206 INIT_LIST_HEAD(&ieee
->RxReorder_Unused_List
);
207 for (count
= 0; count
< REORDER_ENTRY_NUM
; count
++) {
208 list_add_tail(&pRxReorderEntry
->List
,
209 &ieee
->RxReorder_Unused_List
);
210 if (count
== (REORDER_ENTRY_NUM
-1))
212 pRxReorderEntry
= &ieee
->RxReorderEntry
[count
+1];
217 static void AdmitTS(struct rtllib_device
*ieee
,
218 struct ts_common_info
*pTsCommonInfo
, u32 InactTime
)
220 del_timer_sync(&pTsCommonInfo
->SetupTimer
);
221 del_timer_sync(&pTsCommonInfo
->InactTimer
);
224 mod_timer(&pTsCommonInfo
->InactTimer
, jiffies
+
228 static struct ts_common_info
*SearchAdmitTRStream(struct rtllib_device
*ieee
,
230 enum tr_select TxRxSelect
)
233 bool search_dir
[4] = {0};
234 struct list_head
*psearch_list
;
235 struct ts_common_info
*pRet
= NULL
;
236 if (ieee
->iw_mode
== IW_MODE_MASTER
) {
237 if (TxRxSelect
== TX_DIR
) {
238 search_dir
[DIR_DOWN
] = true;
239 search_dir
[DIR_BI_DIR
] = true;
241 search_dir
[DIR_UP
] = true;
242 search_dir
[DIR_BI_DIR
] = true;
244 } else if (ieee
->iw_mode
== IW_MODE_ADHOC
) {
245 if (TxRxSelect
== TX_DIR
)
246 search_dir
[DIR_UP
] = true;
248 search_dir
[DIR_DOWN
] = true;
250 if (TxRxSelect
== TX_DIR
) {
251 search_dir
[DIR_UP
] = true;
252 search_dir
[DIR_BI_DIR
] = true;
253 search_dir
[DIR_DIRECT
] = true;
255 search_dir
[DIR_DOWN
] = true;
256 search_dir
[DIR_BI_DIR
] = true;
257 search_dir
[DIR_DIRECT
] = true;
261 if (TxRxSelect
== TX_DIR
)
262 psearch_list
= &ieee
->Tx_TS_Admit_List
;
264 psearch_list
= &ieee
->Rx_TS_Admit_List
;
266 for (dir
= 0; dir
<= DIR_BI_DIR
; dir
++) {
267 if (search_dir
[dir
] == false)
269 list_for_each_entry(pRet
, psearch_list
, List
) {
270 if (memcmp(pRet
->Addr
, Addr
, 6) == 0)
271 if (pRet
->TSpec
.f
.TSInfo
.field
.ucTSID
== TID
)
272 if (pRet
->TSpec
.f
.TSInfo
.field
.ucDirection
== dir
)
276 if (&pRet
->List
!= psearch_list
)
280 if (pRet
&& &pRet
->List
!= psearch_list
)
286 static void MakeTSEntry(struct ts_common_info
*pTsCommonInfo
, u8
*Addr
,
287 union tspec_body
*pTSPEC
, union qos_tclas
*pTCLAS
,
288 u8 TCLAS_Num
, u8 TCLAS_Proc
)
292 if (pTsCommonInfo
== NULL
)
295 memcpy(pTsCommonInfo
->Addr
, Addr
, 6);
298 memcpy((u8
*)(&(pTsCommonInfo
->TSpec
)), (u8
*)pTSPEC
,
299 sizeof(union tspec_body
));
301 for (count
= 0; count
< TCLAS_Num
; count
++)
302 memcpy((u8
*)(&(pTsCommonInfo
->TClass
[count
])),
303 (u8
*)pTCLAS
, sizeof(union qos_tclas
));
305 pTsCommonInfo
->TClasProc
= TCLAS_Proc
;
306 pTsCommonInfo
->TClasNum
= TCLAS_Num
;
309 bool GetTs(struct rtllib_device
*ieee
, struct ts_common_info
**ppTS
,
310 u8
*Addr
, u8 TID
, enum tr_select TxRxSelect
, bool bAddNewTs
)
313 if (is_broadcast_ether_addr(Addr
) || is_multicast_ether_addr(Addr
)) {
314 RTLLIB_DEBUG(RTLLIB_DL_ERR
, "ERR! get TS for Broadcast or "
318 if (ieee
->current_network
.qos_data
.supported
== 0) {
321 if (!IsACValid(TID
)) {
322 RTLLIB_DEBUG(RTLLIB_DL_ERR
, "ERR! in %s(), TID(%d) is "
323 "not valid\n", __func__
, TID
);
347 *ppTS
= SearchAdmitTRStream(ieee
, Addr
, UP
, TxRxSelect
);
351 if (bAddNewTs
== false) {
352 RTLLIB_DEBUG(RTLLIB_DL_TS
, "add new TS failed"
356 union tspec_body TSpec
;
357 union qos_tsinfo
*pTSInfo
= &TSpec
.f
.TSInfo
;
358 struct list_head
*pUnusedList
=
359 (TxRxSelect
== TX_DIR
) ?
360 (&ieee
->Tx_TS_Unused_List
) :
361 (&ieee
->Rx_TS_Unused_List
);
363 struct list_head
*pAddmitList
=
364 (TxRxSelect
== TX_DIR
) ?
365 (&ieee
->Tx_TS_Admit_List
) :
366 (&ieee
->Rx_TS_Admit_List
);
368 enum direction_value Dir
=
369 (ieee
->iw_mode
== IW_MODE_MASTER
) ?
370 ((TxRxSelect
== TX_DIR
) ? DIR_DOWN
: DIR_UP
) :
371 ((TxRxSelect
== TX_DIR
) ? DIR_UP
: DIR_DOWN
);
372 RTLLIB_DEBUG(RTLLIB_DL_TS
, "to add Ts\n");
373 if (!list_empty(pUnusedList
)) {
374 (*ppTS
) = list_entry(pUnusedList
->next
,
375 struct ts_common_info
, List
);
376 list_del_init(&(*ppTS
)->List
);
377 if (TxRxSelect
== TX_DIR
) {
378 struct tx_ts_record
*tmp
=
384 struct rx_ts_record
*tmp
=
391 RTLLIB_DEBUG(RTLLIB_DL_TS
, "to init current TS"
392 ", UP:%d, Dir:%d, addr: %pM"
393 " ppTs=%p\n", UP
, Dir
,
395 pTSInfo
->field
.ucTrafficType
= 0;
396 pTSInfo
->field
.ucTSID
= UP
;
397 pTSInfo
->field
.ucDirection
= Dir
;
398 pTSInfo
->field
.ucAccessPolicy
= 1;
399 pTSInfo
->field
.ucAggregation
= 0;
400 pTSInfo
->field
.ucPSB
= 0;
401 pTSInfo
->field
.ucUP
= UP
;
402 pTSInfo
->field
.ucTSInfoAckPolicy
= 0;
403 pTSInfo
->field
.ucSchedule
= 0;
405 MakeTSEntry(*ppTS
, Addr
, &TSpec
, NULL
, 0, 0);
406 AdmitTS(ieee
, *ppTS
, 0);
407 list_add_tail(&((*ppTS
)->List
), pAddmitList
);
411 RTLLIB_DEBUG(RTLLIB_DL_ERR
, "ERR!!in function "
412 "%s() There is not enough dir=%d"
413 "(0=up down=1) TS record to be "
414 "used!!", __func__
, Dir
);
421 static void RemoveTsEntry(struct rtllib_device
*ieee
, struct ts_common_info
*pTs
,
422 enum tr_select TxRxSelect
)
424 del_timer_sync(&pTs
->SetupTimer
);
425 del_timer_sync(&pTs
->InactTimer
);
426 TsInitDelBA(ieee
, pTs
, TxRxSelect
);
428 if (TxRxSelect
== RX_DIR
) {
429 struct rx_reorder_entry
*pRxReorderEntry
;
430 struct rx_ts_record
*pRxTS
= (struct rx_ts_record
*)pTs
;
432 if (timer_pending(&pRxTS
->RxPktPendingTimer
))
433 del_timer_sync(&pRxTS
->RxPktPendingTimer
);
435 while (!list_empty(&pRxTS
->RxPendingPktList
)) {
436 pRxReorderEntry
= (struct rx_reorder_entry
*)
437 list_entry(pRxTS
->RxPendingPktList
.prev
,
438 struct rx_reorder_entry
, List
);
439 RTLLIB_DEBUG(RTLLIB_DL_REORDER
, "%s(): Delete SeqNum "
441 pRxReorderEntry
->SeqNum
);
442 list_del_init(&pRxReorderEntry
->List
);
445 struct rtllib_rxb
*prxb
= pRxReorderEntry
->prxb
;
448 for (i
= 0; i
< prxb
->nr_subframes
; i
++)
449 dev_kfree_skb(prxb
->subframes
[i
]);
453 list_add_tail(&pRxReorderEntry
->List
,
454 &ieee
->RxReorder_Unused_List
);
457 struct tx_ts_record
*pTxTS
= (struct tx_ts_record
*)pTs
;
458 del_timer_sync(&pTxTS
->TsAddBaTimer
);
462 void RemovePeerTS(struct rtllib_device
*ieee
, u8
*Addr
)
464 struct ts_common_info
*pTS
, *pTmpTS
;
465 printk(KERN_INFO
"===========>RemovePeerTS, %pM\n", Addr
);
467 list_for_each_entry_safe(pTS
, pTmpTS
, &ieee
->Tx_TS_Pending_List
, List
) {
468 if (memcmp(pTS
->Addr
, Addr
, 6) == 0) {
469 RemoveTsEntry(ieee
, pTS
, TX_DIR
);
470 list_del_init(&pTS
->List
);
471 list_add_tail(&pTS
->List
, &ieee
->Tx_TS_Unused_List
);
475 list_for_each_entry_safe(pTS
, pTmpTS
, &ieee
->Tx_TS_Admit_List
, List
) {
476 if (memcmp(pTS
->Addr
, Addr
, 6) == 0) {
477 printk(KERN_INFO
"====>remove Tx_TS_admin_list\n");
478 RemoveTsEntry(ieee
, pTS
, TX_DIR
);
479 list_del_init(&pTS
->List
);
480 list_add_tail(&pTS
->List
, &ieee
->Tx_TS_Unused_List
);
484 list_for_each_entry_safe(pTS
, pTmpTS
, &ieee
->Rx_TS_Pending_List
, List
) {
485 if (memcmp(pTS
->Addr
, Addr
, 6) == 0) {
486 RemoveTsEntry(ieee
, pTS
, RX_DIR
);
487 list_del_init(&pTS
->List
);
488 list_add_tail(&pTS
->List
, &ieee
->Rx_TS_Unused_List
);
492 list_for_each_entry_safe(pTS
, pTmpTS
, &ieee
->Rx_TS_Admit_List
, List
) {
493 if (memcmp(pTS
->Addr
, Addr
, 6) == 0) {
494 RemoveTsEntry(ieee
, pTS
, RX_DIR
);
495 list_del_init(&pTS
->List
);
496 list_add_tail(&pTS
->List
, &ieee
->Rx_TS_Unused_List
);
501 void RemoveAllTS(struct rtllib_device
*ieee
)
503 struct ts_common_info
*pTS
, *pTmpTS
;
505 list_for_each_entry_safe(pTS
, pTmpTS
, &ieee
->Tx_TS_Pending_List
, List
) {
506 RemoveTsEntry(ieee
, pTS
, TX_DIR
);
507 list_del_init(&pTS
->List
);
508 list_add_tail(&pTS
->List
, &ieee
->Tx_TS_Unused_List
);
511 list_for_each_entry_safe(pTS
, pTmpTS
, &ieee
->Tx_TS_Admit_List
, List
) {
512 RemoveTsEntry(ieee
, pTS
, TX_DIR
);
513 list_del_init(&pTS
->List
);
514 list_add_tail(&pTS
->List
, &ieee
->Tx_TS_Unused_List
);
517 list_for_each_entry_safe(pTS
, pTmpTS
, &ieee
->Rx_TS_Pending_List
, List
) {
518 RemoveTsEntry(ieee
, pTS
, RX_DIR
);
519 list_del_init(&pTS
->List
);
520 list_add_tail(&pTS
->List
, &ieee
->Rx_TS_Unused_List
);
523 list_for_each_entry_safe(pTS
, pTmpTS
, &ieee
->Rx_TS_Admit_List
, List
) {
524 RemoveTsEntry(ieee
, pTS
, RX_DIR
);
525 list_del_init(&pTS
->List
);
526 list_add_tail(&pTS
->List
, &ieee
->Rx_TS_Unused_List
);
530 void TsStartAddBaProcess(struct rtllib_device
*ieee
, struct tx_ts_record
*pTxTS
)
532 if (pTxTS
->bAddBaReqInProgress
== false) {
533 pTxTS
->bAddBaReqInProgress
= true;
535 if (pTxTS
->bAddBaReqDelayed
) {
536 RTLLIB_DEBUG(RTLLIB_DL_BA
, "TsStartAddBaProcess(): "
537 "Delayed Start ADDBA after 60 sec!!\n");
538 mod_timer(&pTxTS
->TsAddBaTimer
, jiffies
+
539 MSECS(TS_ADDBA_DELAY
));
541 RTLLIB_DEBUG(RTLLIB_DL_BA
, "TsStartAddBaProcess(): "
542 "Immediately Start ADDBA now!!\n");
543 mod_timer(&pTxTS
->TsAddBaTimer
, jiffies
+10);
546 RTLLIB_DEBUG(RTLLIB_DL_BA
, "%s()==>BA timer is already added\n",