← Back to branch summary

~ubuntu-branches/ubuntu/trusty/linux-ti-omap/trusty

« back to all changes in this revision

Viewing changes to ubuntu/rtl8192se/rtllib/rtl819x_BAProc.c

  • Committer: Bazaar Package Importer
  • Author(s): Stefan Bader, Amit Kucheria
  • Date: 2010-03-23 18:05:12 UTC
  • Revision ID: james.westby@ubuntu.com-20100323180512-iavj906ocnphdubp
Tags: 2.6.33-500.3
[ Amit Kucheria ]

* [Config] Fix the debug package name to end in -dbgsym
* SAUCE: Add the ubuntu/ drivers to omap
* SAUCE: Re-export the symbols for aufs
* [Config] Enable AUFS and COMPCACHE

Show diffs side-by-side

added added

removed removed

Lines of Context:
ubuntu/rtl8192se/rtllib/rtl819x_BAProc.c
 
1
/******************************************************************************
 
2
 * Copyright(c) 2008 - 2010 Realtek Corporation. All rights reserved.
 
3
 *
 
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
 
7
 * more details.
 
8
 *
 
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
 
12
 *
 
13
 * The full GNU General Public License is included in this distribution in the
 
14
 * file called LICENSE.
 
15
 *
 
16
 * Contact Information:
 
17
 * wlanfae <wlanfae@realtek.com>
 
18
******************************************************************************/
 
19
#include "rtllib.h"
 
20
#include "rtl819x_BA.h"
 
21
#ifdef RTK_DMP_PLATFORM
 
22
#include <linux/usb_setting.h> 
 
23
#endif
 
24
 
 
25
void ActivateBAEntry(struct rtllib_device* ieee, PBA_RECORD pBA, u16 Time)
 
26
{
 
27
        pBA->bValid = true;
 
28
        if(Time != 0)
 
29
                mod_timer(&pBA->Timer, jiffies + MSECS(Time));
 
30
}
 
31
 
 
32
void DeActivateBAEntry( struct rtllib_device* ieee, PBA_RECORD pBA)
 
33
{
 
34
        pBA->bValid = false;
 
35
        del_timer_sync(&pBA->Timer);
 
36
}
 
37
u8 TxTsDeleteBA( struct rtllib_device* ieee, PTX_TS_RECORD      pTxTs)
 
38
{
 
39
        PBA_RECORD              pAdmittedBa = &pTxTs->TxAdmittedBARecord;  
 
40
        PBA_RECORD              pPendingBa = &pTxTs->TxPendingBARecord;
 
41
        u8                      bSendDELBA = false;
 
42
 
 
43
        if(pPendingBa->bValid)
 
44
        {
 
45
                DeActivateBAEntry(ieee, pPendingBa);
 
46
                bSendDELBA = true;
 
47
        }
 
48
 
 
49
        if(pAdmittedBa->bValid)
 
50
        {
 
51
                DeActivateBAEntry(ieee, pAdmittedBa);
 
52
                bSendDELBA = true;
 
53
        }
 
54
 
 
55
        return bSendDELBA;
 
56
}
 
57
 
 
58
u8 RxTsDeleteBA( struct rtllib_device* ieee, PRX_TS_RECORD      pRxTs)
 
59
{
 
60
        PBA_RECORD              pBa = &pRxTs->RxAdmittedBARecord;
 
61
        u8                      bSendDELBA = false;
 
62
 
 
63
        if(pBa->bValid)
 
64
        {
 
65
                DeActivateBAEntry(ieee, pBa);
 
66
                bSendDELBA = true;
 
67
        }
 
68
 
 
69
        return bSendDELBA;
 
70
}
 
71
 
 
72
void ResetBaEntry( PBA_RECORD pBA)
 
73
{
 
74
        pBA->bValid                     = false;
 
75
        pBA->BaParamSet.shortData       = 0;
 
76
        pBA->BaTimeoutValue             = 0;
 
77
        pBA->DialogToken                = 0;
 
78
        pBA->BaStartSeqCtrl.ShortData   = 0;
 
79
}
 
80
static struct sk_buff* rtllib_ADDBA(struct rtllib_device* ieee, u8* Dst, PBA_RECORD pBA, u16 StatusCode, u8 type)
 
81
{
 
82
        struct sk_buff *skb = NULL;
 
83
         struct rtllib_hdr_3addr* BAReq = NULL;
 
84
        u8* tag = NULL;
 
85
        u16 tmp = 0;
 
86
        u16 len = ieee->tx_headroom + 9;
 
87
        RTLLIB_DEBUG(RTLLIB_DL_TRACE | RTLLIB_DL_BA, "========>%s(), frame(%d) sentd to:"MAC_FMT", ieee->dev:%p\n", __FUNCTION__, type, MAC_ARG(Dst), ieee->dev);
 
88
        if (pBA == NULL||ieee == NULL)
 
89
        {
 
90
                RTLLIB_DEBUG(RTLLIB_DL_ERR, "pBA(%p) is NULL or ieee(%p) is NULL\n", pBA, ieee);
 
91
                return NULL;
 
92
        }
 
93
#ifdef USB_USE_ALIGNMENT
 
94
        u32 Tmpaddr=0;
 
95
        int alignment=0;
 
96
        skb = dev_alloc_skb(len + sizeof( struct rtllib_hdr_3addr) + USB_512B_ALIGNMENT_SIZE); 
 
97
#else
 
98
        skb = dev_alloc_skb(len + sizeof( struct rtllib_hdr_3addr)); 
 
99
#endif
 
100
        if (skb == NULL)
 
101
        {
 
102
                RTLLIB_DEBUG(RTLLIB_DL_ERR, "can't alloc skb for ADDBA_REQ\n");
 
103
                return NULL;
 
104
        }
 
105
 
 
106
        memset(skb->data, 0, sizeof( struct rtllib_hdr_3addr));         
 
107
 
 
108
#ifdef USB_USE_ALIGNMENT
 
109
        Tmpaddr = (u32)skb->data;
 
110
        alignment = Tmpaddr & 0x1ff;
 
111
        skb_reserve(skb,(USB_512B_ALIGNMENT_SIZE - alignment));
 
112
#endif
 
113
 
 
114
        skb_reserve(skb, ieee->tx_headroom);
 
115
 
 
116
        BAReq = ( struct rtllib_hdr_3addr *) skb_put(skb,sizeof( struct rtllib_hdr_3addr));
 
117
 
 
118
        memcpy(BAReq->addr1, Dst, ETH_ALEN);
 
119
        memcpy(BAReq->addr2, ieee->dev->dev_addr, ETH_ALEN);
 
120
 
 
121
        memcpy(BAReq->addr3, ieee->current_network.bssid, ETH_ALEN);
 
122
 
 
123
        BAReq->frame_ctl = cpu_to_le16(RTLLIB_STYPE_MANAGE_ACT); 
 
124
 
 
125
        tag = (u8*)skb_put(skb, 9);
 
126
        *tag ++= ACT_CAT_BA;  
 
127
        *tag ++= type;
 
128
        *tag ++= pBA->DialogToken;
 
129
 
 
130
        if (ACT_ADDBARSP == type)
 
131
        {
 
132
                printk("====>to send ADDBARSP\n");
 
133
                tmp = cpu_to_le16(StatusCode);
 
134
                memcpy(tag, (u8*)&tmp, 2);
 
135
                tag += 2;       
 
136
        }
 
137
        tmp = cpu_to_le16(pBA->BaParamSet.shortData);
 
138
        memcpy(tag, (u8*)&tmp, 2);
 
139
        tag += 2;
 
140
        tmp = cpu_to_le16(pBA->BaTimeoutValue);
 
141
        memcpy(tag, (u8*)&tmp, 2);
 
142
        tag += 2;
 
143
        
 
144
        if (ACT_ADDBAREQ == type)
 
145
        {
 
146
                memcpy(tag,(u8*)&(pBA->BaStartSeqCtrl), 2);
 
147
                tag += 2;
 
148
        }
 
149
        
 
150
        RTLLIB_DEBUG_DATA(RTLLIB_DL_DATA|RTLLIB_DL_BA, skb->data, skb->len);
 
151
        return skb;
 
152
}
 
153
 
 
154
static struct sk_buff* rtllib_DELBA(
 
155
        struct rtllib_device* ieee,
 
156
        u8*                      dst,
 
157
        PBA_RECORD               pBA,
 
158
        TR_SELECT                TxRxSelect,
 
159
        u16                      ReasonCode
 
160
        )
 
161
{
 
162
        DELBA_PARAM_SET DelbaParamSet;
 
163
        struct sk_buff *skb = NULL;
 
164
         struct rtllib_hdr_3addr* Delba = NULL;
 
165
        u8* tag = NULL;
 
166
        u16 tmp = 0;
 
167
        u16 len = 6 + ieee->tx_headroom;        
 
168
 
 
169
        if (net_ratelimit())
 
170
        RTLLIB_DEBUG(RTLLIB_DL_TRACE | RTLLIB_DL_BA, "========>%s(), ReasonCode(%d) sentd to:"MAC_FMT"\n", __FUNCTION__, ReasonCode, MAC_ARG(dst));
 
171
 
 
172
        memset(&DelbaParamSet, 0, 2);
 
173
 
 
174
        DelbaParamSet.field.Initiator   = (TxRxSelect==TX_DIR)?1:0;
 
175
        DelbaParamSet.field.TID = pBA->BaParamSet.field.TID;
 
176
        
 
177
#ifdef USB_USE_ALIGNMENT
 
178
        u32 Tmpaddr=0;
 
179
        int alignment=0;
 
180
        skb = dev_alloc_skb(len + sizeof( struct rtllib_hdr_3addr) + USB_512B_ALIGNMENT_SIZE); 
 
181
#else   
 
182
        skb = dev_alloc_skb(len + sizeof( struct rtllib_hdr_3addr)); 
 
183
#endif
 
184
        if (skb == NULL)
 
185
        {
 
186
                RTLLIB_DEBUG(RTLLIB_DL_ERR, "can't alloc skb for ADDBA_REQ\n");
 
187
                return NULL;
 
188
        }
 
189
 
 
190
#ifdef USB_USE_ALIGNMENT
 
191
        Tmpaddr = (u32)skb->data;
 
192
        alignment = Tmpaddr & 0x1ff;
 
193
        skb_reserve(skb,(USB_512B_ALIGNMENT_SIZE - alignment));
 
194
#endif
 
195
        skb_reserve(skb, ieee->tx_headroom);
 
196
        
 
197
        Delba = ( struct rtllib_hdr_3addr *) skb_put(skb,sizeof( struct rtllib_hdr_3addr));
 
198
 
 
199
        memcpy(Delba->addr1, dst, ETH_ALEN);
 
200
        memcpy(Delba->addr2, ieee->dev->dev_addr, ETH_ALEN);
 
201
        memcpy(Delba->addr3, ieee->current_network.bssid, ETH_ALEN);
 
202
        Delba->frame_ctl = cpu_to_le16(RTLLIB_STYPE_MANAGE_ACT); 
 
203
        
 
204
        tag = (u8*)skb_put(skb, 6);     
 
205
 
 
206
        *tag ++= ACT_CAT_BA;  
 
207
        *tag ++= ACT_DELBA;
 
208
 
 
209
        tmp = cpu_to_le16(DelbaParamSet.shortData);
 
210
        memcpy(tag, (u8*)&tmp, 2);
 
211
        tag += 2;
 
212
        tmp = cpu_to_le16(ReasonCode);
 
213
        memcpy(tag, (u8*)&tmp, 2);
 
214
        tag += 2;
 
215
 
 
216
        RTLLIB_DEBUG_DATA(RTLLIB_DL_DATA|RTLLIB_DL_BA, skb->data, skb->len);
 
217
        if (net_ratelimit())
 
218
        RTLLIB_DEBUG(RTLLIB_DL_TRACE | RTLLIB_DL_BA, "<=====%s()\n", __FUNCTION__);
 
219
        return skb;
 
220
}
 
221
 
 
222
void rtllib_send_ADDBAReq(struct rtllib_device* ieee, u8*       dst, PBA_RECORD pBA)
 
223
{
 
224
        struct sk_buff *skb = NULL;
 
225
        skb = rtllib_ADDBA(ieee, dst, pBA, 0, ACT_ADDBAREQ); 
 
226
 
 
227
        if (skb)
 
228
        {
 
229
                printk("====>to send ADDBAREQ!!!!!\n");
 
230
                softmac_mgmt_xmit(skb, ieee);
 
231
        }
 
232
        else
 
233
        {
 
234
                RTLLIB_DEBUG(RTLLIB_DL_ERR, "alloc skb error in function %s()\n", __FUNCTION__);
 
235
        }
 
236
        return;
 
237
}
 
238
 
 
239
void rtllib_send_ADDBARsp(struct rtllib_device* ieee, u8* dst, PBA_RECORD pBA, u16 StatusCode) 
 
240
{
 
241
        struct sk_buff *skb = NULL;
 
242
        skb = rtllib_ADDBA(ieee, dst, pBA, StatusCode, ACT_ADDBARSP); 
 
243
        if (skb)
 
244
        {
 
245
                softmac_mgmt_xmit(skb, ieee);
 
246
        }
 
247
        else
 
248
        {
 
249
                RTLLIB_DEBUG(RTLLIB_DL_ERR, "alloc skb error in function %s()\n", __FUNCTION__);
 
250
        }
 
251
 
 
252
        return;
 
253
 
 
254
}
 
255
 
 
256
void rtllib_send_DELBA(struct rtllib_device* ieee, u8* dst, PBA_RECORD pBA, TR_SELECT TxRxSelect, u16 ReasonCode)
 
257
{
 
258
        struct sk_buff *skb = NULL;
 
259
        skb = rtllib_DELBA(ieee, dst, pBA, TxRxSelect, ReasonCode); 
 
260
        if (skb)
 
261
        {
 
262
                softmac_mgmt_xmit(skb, ieee);
 
263
        }
 
264
        else
 
265
        {
 
266
                RTLLIB_DEBUG(RTLLIB_DL_ERR, "alloc skb error in function %s()\n", __FUNCTION__);
 
267
        }
 
268
        return ;
 
269
}
 
270
 
 
271
int rtllib_rx_ADDBAReq( struct rtllib_device* ieee, struct sk_buff *skb)
 
272
{
 
273
         struct rtllib_hdr_3addr* req = NULL;
 
274
        u16 rc = 0;
 
275
        u8 * dst = NULL, *pDialogToken = NULL, *tag = NULL;
 
276
        PBA_RECORD pBA = NULL;
 
277
        PBA_PARAM_SET   pBaParamSet = NULL;
 
278
        u16* pBaTimeoutVal = NULL;
 
279
        PSEQUENCE_CONTROL pBaStartSeqCtrl = NULL;
 
280
        PRX_TS_RECORD   pTS = NULL;     
 
281
 
 
282
        if (skb->len < sizeof( struct rtllib_hdr_3addr) + 9)
 
283
        {
 
284
                RTLLIB_DEBUG(RTLLIB_DL_ERR, " Invalid skb len in BAREQ(%d / %d)\n",(int)skb->len,       (int)(sizeof( struct rtllib_hdr_3addr) + 9));
 
285
                return -1;
 
286
        }
 
287
 
 
288
        RTLLIB_DEBUG_DATA(RTLLIB_DL_DATA|RTLLIB_DL_BA, skb->data, skb->len);
 
289
        
 
290
        req = ( struct rtllib_hdr_3addr*) skb->data;
 
291
        tag = (u8*)req;
 
292
        dst = (u8*)(&req->addr2[0]);
 
293
        tag += sizeof( struct rtllib_hdr_3addr);
 
294
        pDialogToken = tag + 2;  
 
295
        pBaParamSet = (PBA_PARAM_SET)(tag + 3);   
 
296
        pBaTimeoutVal = (u16*)(tag + 5); 
 
297
        pBaStartSeqCtrl = (PSEQUENCE_CONTROL)(req + 7);
 
298
        
 
299
        printk("====>rx ADDBAREQ from :"MAC_FMT"\n", MAC_ARG(dst));     
 
300
        if(
 
301
#ifdef _RTL8192_EXT_PATCH_
 
302
                (ieee->current_network.qos_data.active == 0 && ieee->current_mesh_network.qos_data.active==0) ||
 
303
#else
 
304
                ieee->current_network.qos_data.active == 0  ||
 
305
#endif  
 
306
                (ieee->pHTInfo->bCurrentHTSupport == false) ||
 
307
                (ieee->pHTInfo->IOTAction & HT_IOT_ACT_REJECT_ADDBA_REQ)) 
 
308
        {
 
309
                rc = ADDBA_STATUS_REFUSED;
 
310
                RTLLIB_DEBUG(RTLLIB_DL_ERR, "Failed to reply on ADDBA_REQ as some capability is not ready(%d, %d)\n", ieee->current_network.qos_data.active, ieee->pHTInfo->bCurrentHTSupport);
 
311
                goto OnADDBAReq_Fail;
 
312
        }
 
313
        if(     !GetTs(
 
314
                        ieee, 
 
315
                        (PTS_COMMON_INFO*)(&pTS), 
 
316
                        dst, 
 
317
                        (u8)(pBaParamSet->field.TID), 
 
318
                        RX_DIR,
 
319
                        true)   )
 
320
        {
 
321
                rc = ADDBA_STATUS_REFUSED;
 
322
                RTLLIB_DEBUG(RTLLIB_DL_ERR, "can't get TS in %s()\n", __FUNCTION__);
 
323
                goto OnADDBAReq_Fail;
 
324
        }
 
325
        pBA = &pTS->RxAdmittedBARecord;
 
326
 
 
327
        if(pBaParamSet->field.BAPolicy == BA_POLICY_DELAYED)
 
328
        {
 
329
                rc = ADDBA_STATUS_INVALID_PARAM;
 
330
                RTLLIB_DEBUG(RTLLIB_DL_ERR, "BA Policy is not correct in %s()\n", __FUNCTION__);
 
331
                goto OnADDBAReq_Fail;
 
332
        }
 
333
 
 
334
 
 
335
        rtllib_FlushRxTsPendingPkts(ieee, pTS);
 
336
        
 
337
        DeActivateBAEntry(ieee, pBA);   
 
338
        pBA->DialogToken = *pDialogToken;
 
339
        pBA->BaParamSet = *pBaParamSet;
 
340
        pBA->BaTimeoutValue = *pBaTimeoutVal;
 
341
        pBA->BaStartSeqCtrl = *pBaStartSeqCtrl;
 
342
        
 
343
        if (ieee->GetHalfNmodeSupportByAPsHandler(ieee->dev)||
 
344
        (ieee->pHTInfo->IOTAction & HT_IOT_ACT_ALLOW_PEER_AGG_ONE_PKT))
 
345
        pBA->BaParamSet.field.BufferSize = 1;
 
346
        else
 
347
        pBA->BaParamSet.field.BufferSize = 32;
 
348
        
 
349
        ActivateBAEntry(ieee, pBA, 0);
 
350
        rtllib_send_ADDBARsp(ieee, dst, pBA, ADDBA_STATUS_SUCCESS);
 
351
 
 
352
        return 0;
 
353
        
 
354
OnADDBAReq_Fail:
 
355
        {
 
356
                BA_RECORD       BA;
 
357
                BA.BaParamSet = *pBaParamSet;
 
358
                BA.BaTimeoutValue = *pBaTimeoutVal;
 
359
                BA.DialogToken = *pDialogToken;
 
360
                BA.BaParamSet.field.BAPolicy = BA_POLICY_IMMEDIATE;
 
361
                rtllib_send_ADDBARsp(ieee, dst, &BA, rc);
 
362
                return 0; 
 
363
        }
 
364
 
 
365
}
 
366
 
 
367
int rtllib_rx_ADDBARsp( struct rtllib_device* ieee, struct sk_buff *skb)
 
368
{
 
369
         struct rtllib_hdr_3addr* rsp = NULL;
 
370
        PBA_RECORD              pPendingBA, pAdmittedBA;
 
371
        PTX_TS_RECORD           pTS = NULL;
 
372
        u8* dst = NULL, *pDialogToken = NULL, *tag = NULL;
 
373
        u16* pStatusCode = NULL, *pBaTimeoutVal = NULL;
 
374
        PBA_PARAM_SET           pBaParamSet = NULL;
 
375
        u16                     ReasonCode;
 
376
 
 
377
        if (skb->len < sizeof( struct rtllib_hdr_3addr) + 9)
 
378
        {
 
379
                RTLLIB_DEBUG(RTLLIB_DL_ERR, " Invalid skb len in BARSP(%d / %d)\n", (int)skb->len,      (int)(sizeof( struct rtllib_hdr_3addr) + 9));
 
380
                return -1;
 
381
        }
 
382
        rsp = ( struct rtllib_hdr_3addr*)skb->data;
 
383
        tag = (u8*)rsp;
 
384
        dst = (u8*)(&rsp->addr2[0]);
 
385
        tag += sizeof( struct rtllib_hdr_3addr);
 
386
        pDialogToken = tag + 2;
 
387
        pStatusCode = (u16*)(tag + 3);
 
388
        pBaParamSet = (PBA_PARAM_SET)(tag + 5);
 
389
        pBaTimeoutVal = (u16*)(tag + 7);
 
390
 
 
391
        printk("====>rx ADDBARSP from :"MAC_FMT"\n", MAC_ARG(dst));     
 
392
        if(     
 
393
#ifdef _RTL8192_EXT_PATCH_
 
394
                (ieee->current_network.qos_data.active == 0 && ieee->current_mesh_network.qos_data.active==0) ||
 
395
#else
 
396
                ieee->current_network.qos_data.active == 0  ||
 
397
#endif  
 
398
                ieee->pHTInfo->bCurrentHTSupport == false ||
 
399
                ieee->pHTInfo->bCurrentAMPDUEnable == false )
 
400
        {
 
401
                RTLLIB_DEBUG(RTLLIB_DL_ERR, "reject to ADDBA_RSP as some capability is not ready(%d, %d, %d)\n",ieee->current_network.qos_data.active, ieee->pHTInfo->bCurrentHTSupport, ieee->pHTInfo->bCurrentAMPDUEnable);
 
402
                ReasonCode = DELBA_REASON_UNKNOWN_BA;
 
403
                goto OnADDBARsp_Reject;
 
404
        }
 
405
 
 
406
        
 
407
        if (!GetTs(
 
408
                        ieee, 
 
409
                        (PTS_COMMON_INFO*)(&pTS), 
 
410
                        dst, 
 
411
                        (u8)(pBaParamSet->field.TID), 
 
412
                        TX_DIR,
 
413
                        false)  )
 
414
        {
 
415
                RTLLIB_DEBUG(RTLLIB_DL_ERR, "can't get TS in %s()\n", __FUNCTION__);
 
416
                ReasonCode = DELBA_REASON_UNKNOWN_BA;
 
417
                goto OnADDBARsp_Reject;
 
418
        }
 
419
        
 
420
        pTS->bAddBaReqInProgress = false;
 
421
        pPendingBA = &pTS->TxPendingBARecord;
 
422
        pAdmittedBA = &pTS->TxAdmittedBARecord;
 
423
 
 
424
 
 
425
        if((pAdmittedBA->bValid==true))
 
426
        {
 
427
                RTLLIB_DEBUG(RTLLIB_DL_BA, "OnADDBARsp(): Recv ADDBA Rsp. Drop because already admit it! \n");
 
428
                return -1;
 
429
        }
 
430
        else if((pPendingBA->bValid == false) ||(*pDialogToken != pPendingBA->DialogToken))
 
431
        {
 
432
                RTLLIB_DEBUG(RTLLIB_DL_ERR,  "OnADDBARsp(): Recv ADDBA Rsp. BA invalid, DELBA! \n");
 
433
                ReasonCode = DELBA_REASON_UNKNOWN_BA;
 
434
                goto OnADDBARsp_Reject;
 
435
        }
 
436
        else
 
437
        {
 
438
                RTLLIB_DEBUG(RTLLIB_DL_BA, "OnADDBARsp(): Recv ADDBA Rsp. BA is admitted! Status code:%X\n", *pStatusCode);
 
439
                DeActivateBAEntry(ieee, pPendingBA);
 
440
        }
 
441
 
 
442
 
 
443
        if(*pStatusCode == ADDBA_STATUS_SUCCESS)
 
444
        {
 
445
                if(pBaParamSet->field.BAPolicy == BA_POLICY_DELAYED)
 
446
                {
 
447
                        pTS->bAddBaReqDelayed = true;
 
448
                        DeActivateBAEntry(ieee, pAdmittedBA);
 
449
                        ReasonCode = DELBA_REASON_END_BA;
 
450
                        goto OnADDBARsp_Reject;
 
451
                }
 
452
 
 
453
 
 
454
                pAdmittedBA->DialogToken = *pDialogToken;
 
455
                pAdmittedBA->BaTimeoutValue = *pBaTimeoutVal;
 
456
                pAdmittedBA->BaStartSeqCtrl = pPendingBA->BaStartSeqCtrl;
 
457
                pAdmittedBA->BaParamSet = *pBaParamSet;
 
458
                DeActivateBAEntry(ieee, pAdmittedBA);
 
459
                ActivateBAEntry(ieee, pAdmittedBA, *pBaTimeoutVal);
 
460
        } else {
 
461
                pTS->bAddBaReqDelayed = true;
 
462
                pTS->bDisable_AddBa = true;
 
463
                ReasonCode = DELBA_REASON_END_BA;
 
464
                goto OnADDBARsp_Reject;
 
465
        }
 
466
 
 
467
        return 0;
 
468
 
 
469
OnADDBARsp_Reject:
 
470
        {
 
471
                BA_RECORD       BA;
 
472
                BA.BaParamSet = *pBaParamSet;
 
473
                rtllib_send_DELBA(ieee, dst, &BA, TX_DIR, ReasonCode);
 
474
                return 0;
 
475
        }
 
476
        
 
477
}
 
478
 
 
479
int rtllib_rx_DELBA(struct rtllib_device* ieee,struct sk_buff *skb)
 
480
{
 
481
         struct rtllib_hdr_3addr* delba = NULL;
 
482
        PDELBA_PARAM_SET        pDelBaParamSet = NULL;
 
483
        u16*                    pReasonCode = NULL;
 
484
        u8*                     dst = NULL;
 
485
 
 
486
        if (skb->len < sizeof( struct rtllib_hdr_3addr) + 6)
 
487
        {
 
488
                RTLLIB_DEBUG(RTLLIB_DL_ERR, " Invalid skb len in DELBA(%d / %d)\n", (int)skb->len,      (int)(sizeof( struct rtllib_hdr_3addr) + 6));
 
489
                return -1;
 
490
        }
 
491
        
 
492
        if(
 
493
#ifdef _RTL8192_EXT_PATCH_
 
494
                (ieee->current_network.qos_data.active == 0 && ieee->current_mesh_network.qos_data.active==0) ||
 
495
#else
 
496
                ieee->current_network.qos_data.active == 0  ||
 
497
#endif  
 
498
                ieee->pHTInfo->bCurrentHTSupport == false )
 
499
        {
 
500
                RTLLIB_DEBUG(RTLLIB_DL_ERR, "received DELBA while QOS or HT is not supported(%d, %d)\n",ieee->current_network.qos_data.active, ieee->pHTInfo->bCurrentHTSupport);
 
501
                return -1;
 
502
        }
 
503
        
 
504
        RTLLIB_DEBUG_DATA(RTLLIB_DL_DATA|RTLLIB_DL_BA, skb->data, skb->len);
 
505
        delba = ( struct rtllib_hdr_3addr*)skb->data;
 
506
        dst = (u8*)(&delba->addr2[0]);
 
507
        delba += sizeof( struct rtllib_hdr_3addr);
 
508
        pDelBaParamSet = (PDELBA_PARAM_SET)(delba+2);
 
509
        pReasonCode = (u16*)(delba+4);
 
510
 
 
511
        if(pDelBaParamSet->field.Initiator == 1)
 
512
        {
 
513
                PRX_TS_RECORD   pRxTs;
 
514
 
 
515
                if( !GetTs(
 
516
                                ieee, 
 
517
                                (PTS_COMMON_INFO*)&pRxTs, 
 
518
                                dst, 
 
519
                                (u8)pDelBaParamSet->field.TID, 
 
520
                                RX_DIR,
 
521
                                false)  )
 
522
                {
 
523
                        RTLLIB_DEBUG(RTLLIB_DL_ERR,  "can't get TS for RXTS in %s().dsf:"MAC_FMT" TID:%d\n", __FUNCTION__, MAC_ARG(dst), (u8)pDelBaParamSet->field.TID);
 
524
                        return -1;
 
525
                }
 
526
                
 
527
                RxTsDeleteBA(ieee, pRxTs);
 
528
        }
 
529
        else
 
530
        {
 
531
                PTX_TS_RECORD   pTxTs;
 
532
 
 
533
                if(!GetTs(
 
534
                        ieee, 
 
535
                        (PTS_COMMON_INFO*)&pTxTs, 
 
536
                        dst, 
 
537
                        (u8)pDelBaParamSet->field.TID, 
 
538
                        TX_DIR,
 
539
                        false)  )
 
540
                {
 
541
                        RTLLIB_DEBUG(RTLLIB_DL_ERR,  "can't get TS for TXTS in %s()\n", __FUNCTION__);
 
542
                        return -1;
 
543
                }
 
544
                
 
545
                pTxTs->bUsingBa = false;
 
546
                pTxTs->bAddBaReqInProgress = false;
 
547
                pTxTs->bAddBaReqDelayed = false;
 
548
                del_timer_sync(&pTxTs->TsAddBaTimer);
 
549
                TxTsDeleteBA(ieee, pTxTs);
 
550
        }
 
551
        return 0;
 
552
}
 
553
 
 
554
void
 
555
TsInitAddBA(
 
556
        struct rtllib_device* ieee,
 
557
        PTX_TS_RECORD   pTS,
 
558
        u8              Policy,
 
559
        u8              bOverwritePending
 
560
        )
 
561
{
 
562
        PBA_RECORD                      pBA = &pTS->TxPendingBARecord;
 
563
 
 
564
        if(pBA->bValid==true && bOverwritePending==false)
 
565
                return;
 
566
 
 
567
        DeActivateBAEntry(ieee, pBA);
 
568
        
 
569
        pBA->DialogToken++;                                             
 
570
        pBA->BaParamSet.field.AMSDU_Support = 0;        
 
571
        pBA->BaParamSet.field.BAPolicy = Policy;        
 
572
        pBA->BaParamSet.field.TID = pTS->TsCommonInfo.TSpec.f.TSInfo.field.ucTSID;      
 
573
        pBA->BaParamSet.field.BufferSize = 32;          
 
574
        pBA->BaTimeoutValue = 0;                                        
 
575
        pBA->BaStartSeqCtrl.field.SeqNum = (pTS->TxCurSeq + 3) % 4096;  
 
576
 
 
577
        ActivateBAEntry(ieee, pBA, BA_SETUP_TIMEOUT);
 
578
 
 
579
        rtllib_send_ADDBAReq(ieee, pTS->TsCommonInfo.Addr, pBA);
 
580
}
 
581
 
 
582
void
 
583
TsInitDelBA( struct rtllib_device* ieee, PTS_COMMON_INFO pTsCommonInfo, TR_SELECT TxRxSelect)
 
584
{
 
585
 
 
586
        if(TxRxSelect == TX_DIR)
 
587
        {
 
588
                PTX_TS_RECORD   pTxTs = (PTX_TS_RECORD)pTsCommonInfo;
 
589
 
 
590
                if(TxTsDeleteBA(ieee, pTxTs))
 
591
                        rtllib_send_DELBA(
 
592
                                ieee, 
 
593
                                pTsCommonInfo->Addr, 
 
594
                                (pTxTs->TxAdmittedBARecord.bValid)?(&pTxTs->TxAdmittedBARecord):(&pTxTs->TxPendingBARecord), 
 
595
                                TxRxSelect, 
 
596
                                DELBA_REASON_END_BA);
 
597
        }
 
598
        else if(TxRxSelect == RX_DIR)
 
599
        {
 
600
                PRX_TS_RECORD   pRxTs = (PRX_TS_RECORD)pTsCommonInfo;
 
601
                if(RxTsDeleteBA(ieee, pRxTs))
 
602
                        rtllib_send_DELBA(
 
603
                                ieee, 
 
604
                                pTsCommonInfo->Addr, 
 
605
                                &pRxTs->RxAdmittedBARecord, 
 
606
                                TxRxSelect, 
 
607
                                DELBA_REASON_END_BA     );
 
608
        }
 
609
}
 
610
void BaSetupTimeOut(unsigned long data)
 
611
{
 
612
        PTX_TS_RECORD   pTxTs = (PTX_TS_RECORD)data;
 
613
 
 
614
        pTxTs->bAddBaReqInProgress = false;
 
615
        pTxTs->bAddBaReqDelayed = true;
 
616
        pTxTs->TxPendingBARecord.bValid = false;
 
617
}
 
618
 
 
619
void TxBaInactTimeout(unsigned long data)
 
620
{
 
621
        PTX_TS_RECORD   pTxTs = (PTX_TS_RECORD)data;
 
622
        struct rtllib_device *ieee = container_of(pTxTs, struct rtllib_device, TxTsRecord[pTxTs->num]);
 
623
        TxTsDeleteBA(ieee, pTxTs);
 
624
        rtllib_send_DELBA(
 
625
                ieee, 
 
626
                pTxTs->TsCommonInfo.Addr, 
 
627
                &pTxTs->TxAdmittedBARecord,
 
628
                TX_DIR, 
 
629
                DELBA_REASON_TIMEOUT);
 
630
}
 
631
 
 
632
void RxBaInactTimeout(unsigned long data)
 
633
{
 
634
        PRX_TS_RECORD   pRxTs = (PRX_TS_RECORD)data;
 
635
        struct rtllib_device *ieee = container_of(pRxTs, struct rtllib_device, RxTsRecord[pRxTs->num]);
 
636
        
 
637
        RxTsDeleteBA(ieee, pRxTs);
 
638
        rtllib_send_DELBA(
 
639
                ieee, 
 
640
                pRxTs->TsCommonInfo.Addr, 
 
641
                &pRxTs->RxAdmittedBARecord,
 
642
                RX_DIR, 
 
643
                DELBA_REASON_TIMEOUT);
 
644
        return ;
 
645
}
 
646