← Back to branch summary

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

« back to all changes in this revision

Viewing changes to drivers/staging/rt2860/common/cmm_mac_usb.c

  • Committer: Bazaar Package Importer
  • Author(s): Amit Kucheria, Amit Kucheria
  • Date: 2010-03-10 02:28:15 UTC
  • Revision ID: james.westby@ubuntu.com-20100310022815-7sd3gwvn5kenaq33
Tags: 2.6.33-500.1
[ Amit Kucheria ]

* Initial release of a 2.6.33-based OMAP kernel
* UBUNTU: [Upstream] Fix omap 1-wire driver compilation
* UBUNTU: ubuntu: AppArmor -- update to mainline 2010-03-04

Show diffs side-by-side

added added

removed removed

Lines of Context:
drivers/staging/rt2860/common/cmm_mac_usb.c
 
1
/*
 
2
 *************************************************************************
 
3
 * Ralink Tech Inc.
 
4
 * 5F., No.36, Taiyuan St., Jhubei City,
 
5
 * Hsinchu County 302,
 
6
 * Taiwan, R.O.C.
 
7
 *
 
8
 * (c) Copyright 2002-2007, Ralink Technology, Inc.
 
9
 *
 
10
 * This program is free software; you can redistribute it and/or modify  *
 
11
 * it under the terms of the GNU General Public License as published by  *
 
12
 * the Free Software Foundation; either version 2 of the License, or     *
 
13
 * (at your option) any later version.                                   *
 
14
 *                                                                       *
 
15
 * This program is distributed in the hope that it will be useful,       *
 
16
 * but WITHOUT ANY WARRANTY; without even the implied warranty of        *
 
17
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the         *
 
18
 * GNU General Public License for more details.                          *
 
19
 *                                                                       *
 
20
 * You should have received a copy of the GNU General Public License     *
 
21
 * along with this program; if not, write to the                         *
 
22
 * Free Software Foundation, Inc.,                                       *
 
23
 * 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.             *
 
24
 *                                                                       *
 
25
 *************************************************************************
 
26
*/
 
27
 
 
28
#ifdef RTMP_MAC_USB
 
29
 
 
30
#include        "../rt_config.h"
 
31
 
 
32
/*
 
33
========================================================================
 
34
Routine Description:
 
35
    Initialize receive data structures.
 
36
 
 
37
Arguments:
 
38
    pAd                                 Pointer to our adapter
 
39
 
 
40
Return Value:
 
41
        NDIS_STATUS_SUCCESS
 
42
        NDIS_STATUS_RESOURCES
 
43
 
 
44
Note:
 
45
        Initialize all receive releated private buffer, include those define
 
46
        in struct rt_rtmp_adapter structure and all private data structures. The mahor
 
47
        work is to allocate buffer for each packet and chain buffer to
 
48
        NDIS packet descriptor.
 
49
========================================================================
 
50
*/
 
51
int NICInitRecv(struct rt_rtmp_adapter *pAd)
 
52
{
 
53
        u8 i;
 
54
        int Status = NDIS_STATUS_SUCCESS;
 
55
        struct os_cookie *pObj = (struct os_cookie *)pAd->OS_Cookie;
 
56
 
 
57
        DBGPRINT(RT_DEBUG_TRACE, ("--> NICInitRecv\n"));
 
58
        pObj = pObj;
 
59
 
 
60
        /*InterlockedExchange(&pAd->PendingRx, 0); */
 
61
        pAd->PendingRx = 0;
 
62
        pAd->NextRxBulkInReadIndex = 0; /* Next Rx Read index */
 
63
        pAd->NextRxBulkInIndex = 0;     /*RX_RING_SIZE -1; // Rx Bulk pointer */
 
64
        pAd->NextRxBulkInPosition = 0;
 
65
 
 
66
        for (i = 0; i < (RX_RING_SIZE); i++) {
 
67
                struct rt_rx_context *pRxContext = &(pAd->RxContext[i]);
 
68
 
 
69
                /*Allocate URB */
 
70
                pRxContext->pUrb = RTUSB_ALLOC_URB(0);
 
71
                if (pRxContext->pUrb == NULL) {
 
72
                        Status = NDIS_STATUS_RESOURCES;
 
73
                        goto out1;
 
74
                }
 
75
                /* Allocate transfer buffer */
 
76
                pRxContext->TransferBuffer =
 
77
                    RTUSB_URB_ALLOC_BUFFER(pObj->pUsb_Dev, MAX_RXBULK_SIZE,
 
78
                                           &pRxContext->data_dma);
 
79
                if (pRxContext->TransferBuffer == NULL) {
 
80
                        Status = NDIS_STATUS_RESOURCES;
 
81
                        goto out1;
 
82
                }
 
83
 
 
84
                NdisZeroMemory(pRxContext->TransferBuffer, MAX_RXBULK_SIZE);
 
85
 
 
86
                pRxContext->pAd = pAd;
 
87
                pRxContext->pIrp = NULL;
 
88
                pRxContext->InUse = FALSE;
 
89
                pRxContext->IRPPending = FALSE;
 
90
                pRxContext->Readable = FALSE;
 
91
                /*pRxContext->ReorderInUse = FALSE; */
 
92
                pRxContext->bRxHandling = FALSE;
 
93
                pRxContext->BulkInOffset = 0;
 
94
        }
 
95
 
 
96
        DBGPRINT(RT_DEBUG_TRACE, ("<-- NICInitRecv(Status=%d)\n", Status));
 
97
        return Status;
 
98
 
 
99
out1:
 
100
        for (i = 0; i < (RX_RING_SIZE); i++) {
 
101
                struct rt_rx_context *pRxContext = &(pAd->RxContext[i]);
 
102
 
 
103
                if (NULL != pRxContext->TransferBuffer) {
 
104
                        RTUSB_URB_FREE_BUFFER(pObj->pUsb_Dev, MAX_RXBULK_SIZE,
 
105
                                              pRxContext->TransferBuffer,
 
106
                                              pRxContext->data_dma);
 
107
                        pRxContext->TransferBuffer = NULL;
 
108
                }
 
109
 
 
110
                if (NULL != pRxContext->pUrb) {
 
111
                        RTUSB_UNLINK_URB(pRxContext->pUrb);
 
112
                        RTUSB_FREE_URB(pRxContext->pUrb);
 
113
                        pRxContext->pUrb = NULL;
 
114
                }
 
115
        }
 
116
 
 
117
        return Status;
 
118
}
 
119
 
 
120
/*
 
121
========================================================================
 
122
Routine Description:
 
123
    Initialize transmit data structures.
 
124
 
 
125
Arguments:
 
126
    pAd                                 Pointer to our adapter
 
127
 
 
128
Return Value:
 
129
        NDIS_STATUS_SUCCESS
 
130
        NDIS_STATUS_RESOURCES
 
131
 
 
132
Note:
 
133
========================================================================
 
134
*/
 
135
int NICInitTransmit(struct rt_rtmp_adapter *pAd)
 
136
{
 
137
#define LM_USB_ALLOC(pObj, Context, TB_Type, BufferSize, Status, msg1, err1, msg2, err2)        \
 
138
        Context->pUrb = RTUSB_ALLOC_URB(0);             \
 
139
        if (Context->pUrb == NULL) {                    \
 
140
                DBGPRINT(RT_DEBUG_ERROR, msg1);         \
 
141
                Status = NDIS_STATUS_RESOURCES;         \
 
142
                goto err1; }                                            \
 
143
                                                                                        \
 
144
        Context->TransferBuffer =                               \
 
145
                (TB_Type)RTUSB_URB_ALLOC_BUFFER(pObj->pUsb_Dev, BufferSize, &Context->data_dma);        \
 
146
        if (Context->TransferBuffer == NULL) {  \
 
147
                DBGPRINT(RT_DEBUG_ERROR, msg2);         \
 
148
                Status = NDIS_STATUS_RESOURCES;         \
 
149
                goto err2; }
 
150
 
 
151
#define LM_URB_FREE(pObj, Context, BufferSize)                          \
 
152
        if (NULL != Context->pUrb) {                                                    \
 
153
                RTUSB_UNLINK_URB(Context->pUrb);                                        \
 
154
                RTUSB_FREE_URB(Context->pUrb);                                          \
 
155
                Context->pUrb = NULL; }                                                         \
 
156
        if (NULL != Context->TransferBuffer) {                          \
 
157
                RTUSB_URB_FREE_BUFFER(pObj->pUsb_Dev, BufferSize,       \
 
158
                                                                Context->TransferBuffer,        \
 
159
                                                                Context->data_dma);                     \
 
160
                Context->TransferBuffer = NULL; }
 
161
 
 
162
        u8 i, acidx;
 
163
        int Status = NDIS_STATUS_SUCCESS;
 
164
        struct rt_tx_context *pNullContext = &(pAd->NullContext);
 
165
        struct rt_tx_context *pPsPollContext = &(pAd->PsPollContext);
 
166
        struct rt_tx_context *pRTSContext = &(pAd->RTSContext);
 
167
        struct rt_tx_context *pMLMEContext = NULL;
 
168
/*      struct rt_ht_tx_context *pHTTXContext = NULL; */
 
169
        struct os_cookie *pObj = (struct os_cookie *)pAd->OS_Cookie;
 
170
        void *RingBaseVa;
 
171
/*      struct rt_rtmp_tx_ring *pTxRing; */
 
172
        struct rt_rtmp_mgmt_ring *pMgmtRing;
 
173
 
 
174
        DBGPRINT(RT_DEBUG_TRACE, ("--> NICInitTransmit\n"));
 
175
        pObj = pObj;
 
176
 
 
177
        /* Init 4 set of Tx parameters */
 
178
        for (acidx = 0; acidx < NUM_OF_TX_RING; acidx++) {
 
179
                /* Initialize all Transmit releated queues */
 
180
                InitializeQueueHeader(&pAd->TxSwQueue[acidx]);
 
181
 
 
182
                /* Next Local tx ring pointer waiting for buck out */
 
183
                pAd->NextBulkOutIndex[acidx] = acidx;
 
184
                pAd->BulkOutPending[acidx] = FALSE;     /* Buck Out control flag */
 
185
                /*pAd->DataBulkDoneIdx[acidx] = 0; */
 
186
        }
 
187
 
 
188
        /*pAd->NextMLMEIndex    = 0; */
 
189
        /*pAd->PushMgmtIndex    = 0; */
 
190
        /*pAd->PopMgmtIndex     = 0; */
 
191
        /*InterlockedExchange(&pAd->MgmtQueueSize, 0); */
 
192
        /*InterlockedExchange(&pAd->TxCount, 0); */
 
193
 
 
194
        /*pAd->PrioRingFirstIndex       = 0; */
 
195
        /*pAd->PrioRingTxCnt            = 0; */
 
196
 
 
197
        do {
 
198
                /* */
 
199
                /* TX_RING_SIZE, 4 ACs */
 
200
                /* */
 
201
                for (acidx = 0; acidx < 4; acidx++) {
 
202
                        struct rt_ht_tx_context *pHTTXContext = &(pAd->TxContext[acidx]);
 
203
 
 
204
                        NdisZeroMemory(pHTTXContext, sizeof(struct rt_ht_tx_context));
 
205
                        /*Allocate URB */
 
206
                        LM_USB_ALLOC(pObj, pHTTXContext, struct rt_httx_buffer *,
 
207
                                     sizeof(struct rt_httx_buffer), Status,
 
208
                                     ("<-- ERROR in Alloc TX TxContext[%d] urb!\n",
 
209
                                      acidx), done,
 
210
                                     ("<-- ERROR in Alloc TX TxContext[%d] struct rt_httx_buffer!\n",
 
211
                                      acidx), out1);
 
212
 
 
213
                        NdisZeroMemory(pHTTXContext->TransferBuffer->
 
214
                                       Aggregation, 4);
 
215
                        pHTTXContext->pAd = pAd;
 
216
                        pHTTXContext->pIrp = NULL;
 
217
                        pHTTXContext->IRPPending = FALSE;
 
218
                        pHTTXContext->NextBulkOutPosition = 0;
 
219
                        pHTTXContext->ENextBulkOutPosition = 0;
 
220
                        pHTTXContext->CurWritePosition = 0;
 
221
                        pHTTXContext->CurWriteRealPos = 0;
 
222
                        pHTTXContext->BulkOutSize = 0;
 
223
                        pHTTXContext->BulkOutPipeId = acidx;
 
224
                        pHTTXContext->bRingEmpty = TRUE;
 
225
                        pHTTXContext->bCopySavePad = FALSE;
 
226
                        pAd->BulkOutPending[acidx] = FALSE;
 
227
                }
 
228
 
 
229
                /* */
 
230
                /* MGMT_RING_SIZE */
 
231
                /* */
 
232
 
 
233
                /* Allocate MGMT ring descriptor's memory */
 
234
                pAd->MgmtDescRing.AllocSize =
 
235
                    MGMT_RING_SIZE * sizeof(struct rt_tx_context);
 
236
                os_alloc_mem(pAd, (u8 **) (&pAd->MgmtDescRing.AllocVa),
 
237
                             pAd->MgmtDescRing.AllocSize);
 
238
                if (pAd->MgmtDescRing.AllocVa == NULL) {
 
239
                        DBGPRINT_ERR(("Failed to allocate a big buffer for MgmtDescRing!\n"));
 
240
                        Status = NDIS_STATUS_RESOURCES;
 
241
                        goto out1;
 
242
                }
 
243
                NdisZeroMemory(pAd->MgmtDescRing.AllocVa,
 
244
                               pAd->MgmtDescRing.AllocSize);
 
245
                RingBaseVa = pAd->MgmtDescRing.AllocVa;
 
246
 
 
247
                /* Initialize MGMT Ring and associated buffer memory */
 
248
                pMgmtRing = &pAd->MgmtRing;
 
249
                for (i = 0; i < MGMT_RING_SIZE; i++) {
 
250
                        /* link the pre-allocated Mgmt buffer to MgmtRing.Cell */
 
251
                        pMgmtRing->Cell[i].AllocSize = sizeof(struct rt_tx_context);
 
252
                        pMgmtRing->Cell[i].AllocVa = RingBaseVa;
 
253
                        pMgmtRing->Cell[i].pNdisPacket = NULL;
 
254
                        pMgmtRing->Cell[i].pNextNdisPacket = NULL;
 
255
 
 
256
                        /*Allocate URB for MLMEContext */
 
257
                        pMLMEContext =
 
258
                            (struct rt_tx_context *)pAd->MgmtRing.Cell[i].AllocVa;
 
259
                        pMLMEContext->pUrb = RTUSB_ALLOC_URB(0);
 
260
                        if (pMLMEContext->pUrb == NULL) {
 
261
                                DBGPRINT(RT_DEBUG_ERROR,
 
262
                                         ("<-- ERROR in Alloc TX MLMEContext[%d] urb!\n",
 
263
                                          i));
 
264
                                Status = NDIS_STATUS_RESOURCES;
 
265
                                goto out2;
 
266
                        }
 
267
                        pMLMEContext->pAd = pAd;
 
268
                        pMLMEContext->pIrp = NULL;
 
269
                        pMLMEContext->TransferBuffer = NULL;
 
270
                        pMLMEContext->InUse = FALSE;
 
271
                        pMLMEContext->IRPPending = FALSE;
 
272
                        pMLMEContext->bWaitingBulkOut = FALSE;
 
273
                        pMLMEContext->BulkOutSize = 0;
 
274
                        pMLMEContext->SelfIdx = i;
 
275
 
 
276
                        /* Offset to next ring descriptor address */
 
277
                        RingBaseVa = (u8 *)RingBaseVa + sizeof(struct rt_tx_context);
 
278
                }
 
279
                DBGPRINT(RT_DEBUG_TRACE,
 
280
                         ("MGMT Ring: total %d entry allocated\n", i));
 
281
 
 
282
                /*pAd->MgmtRing.TxSwFreeIdx = (MGMT_RING_SIZE - 1); */
 
283
                pAd->MgmtRing.TxSwFreeIdx = MGMT_RING_SIZE;
 
284
                pAd->MgmtRing.TxCpuIdx = 0;
 
285
                pAd->MgmtRing.TxDmaIdx = 0;
 
286
 
 
287
                /* */
 
288
                /* BEACON_RING_SIZE */
 
289
                /* */
 
290
                for (i = 0; i < BEACON_RING_SIZE; i++)  /* 2 */
 
291
                {
 
292
                        struct rt_tx_context *pBeaconContext = &(pAd->BeaconContext[i]);
 
293
 
 
294
                        NdisZeroMemory(pBeaconContext, sizeof(struct rt_tx_context));
 
295
 
 
296
                        /*Allocate URB */
 
297
                        LM_USB_ALLOC(pObj, pBeaconContext, struct rt_tx_buffer *,
 
298
                                     sizeof(struct rt_tx_buffer), Status,
 
299
                                     ("<-- ERROR in Alloc TX BeaconContext[%d] urb!\n",
 
300
                                      i), out2,
 
301
                                     ("<-- ERROR in Alloc TX BeaconContext[%d] struct rt_tx_buffer!\n",
 
302
                                      i), out3);
 
303
 
 
304
                        pBeaconContext->pAd = pAd;
 
305
                        pBeaconContext->pIrp = NULL;
 
306
                        pBeaconContext->InUse = FALSE;
 
307
                        pBeaconContext->IRPPending = FALSE;
 
308
                }
 
309
 
 
310
                /* */
 
311
                /* NullContext */
 
312
                /* */
 
313
                NdisZeroMemory(pNullContext, sizeof(struct rt_tx_context));
 
314
 
 
315
                /*Allocate URB */
 
316
                LM_USB_ALLOC(pObj, pNullContext, struct rt_tx_buffer *, sizeof(struct rt_tx_buffer),
 
317
                             Status,
 
318
                             ("<-- ERROR in Alloc TX NullContext urb!\n"),
 
319
                             out3,
 
320
                             ("<-- ERROR in Alloc TX NullContext struct rt_tx_buffer!\n"),
 
321
                             out4);
 
322
 
 
323
                pNullContext->pAd = pAd;
 
324
                pNullContext->pIrp = NULL;
 
325
                pNullContext->InUse = FALSE;
 
326
                pNullContext->IRPPending = FALSE;
 
327
 
 
328
                /* */
 
329
                /* RTSContext */
 
330
                /* */
 
331
                NdisZeroMemory(pRTSContext, sizeof(struct rt_tx_context));
 
332
 
 
333
                /*Allocate URB */
 
334
                LM_USB_ALLOC(pObj, pRTSContext, struct rt_tx_buffer *, sizeof(struct rt_tx_buffer),
 
335
                             Status,
 
336
                             ("<-- ERROR in Alloc TX RTSContext urb!\n"),
 
337
                             out4,
 
338
                             ("<-- ERROR in Alloc TX RTSContext struct rt_tx_buffer!\n"),
 
339
                             out5);
 
340
 
 
341
                pRTSContext->pAd = pAd;
 
342
                pRTSContext->pIrp = NULL;
 
343
                pRTSContext->InUse = FALSE;
 
344
                pRTSContext->IRPPending = FALSE;
 
345
 
 
346
                /* */
 
347
                /* PsPollContext */
 
348
                /* */
 
349
                /*NdisZeroMemory(pPsPollContext, sizeof(struct rt_tx_context)); */
 
350
                /*Allocate URB */
 
351
                LM_USB_ALLOC(pObj, pPsPollContext, struct rt_tx_buffer *,
 
352
                             sizeof(struct rt_tx_buffer), Status,
 
353
                             ("<-- ERROR in Alloc TX PsPollContext urb!\n"),
 
354
                             out5,
 
355
                             ("<-- ERROR in Alloc TX PsPollContext struct rt_tx_buffer!\n"),
 
356
                             out6);
 
357
 
 
358
                pPsPollContext->pAd = pAd;
 
359
                pPsPollContext->pIrp = NULL;
 
360
                pPsPollContext->InUse = FALSE;
 
361
                pPsPollContext->IRPPending = FALSE;
 
362
                pPsPollContext->bAggregatible = FALSE;
 
363
                pPsPollContext->LastOne = TRUE;
 
364
 
 
365
        } while (FALSE);
 
366
 
 
367
done:
 
368
        DBGPRINT(RT_DEBUG_TRACE, ("<-- NICInitTransmit(Status=%d)\n", Status));
 
369
 
 
370
        return Status;
 
371
 
 
372
        /* --------------------------- ERROR HANDLE --------------------------- */
 
373
out6:
 
374
        LM_URB_FREE(pObj, pPsPollContext, sizeof(struct rt_tx_buffer));
 
375
 
 
376
out5:
 
377
        LM_URB_FREE(pObj, pRTSContext, sizeof(struct rt_tx_buffer));
 
378
 
 
379
out4:
 
380
        LM_URB_FREE(pObj, pNullContext, sizeof(struct rt_tx_buffer));
 
381
 
 
382
out3:
 
383
        for (i = 0; i < BEACON_RING_SIZE; i++) {
 
384
                struct rt_tx_context *pBeaconContext = &(pAd->BeaconContext[i]);
 
385
                if (pBeaconContext)
 
386
                        LM_URB_FREE(pObj, pBeaconContext, sizeof(struct rt_tx_buffer));
 
387
        }
 
388
 
 
389
out2:
 
390
        if (pAd->MgmtDescRing.AllocVa) {
 
391
                pMgmtRing = &pAd->MgmtRing;
 
392
                for (i = 0; i < MGMT_RING_SIZE; i++) {
 
393
                        pMLMEContext =
 
394
                            (struct rt_tx_context *)pAd->MgmtRing.Cell[i].AllocVa;
 
395
                        if (pMLMEContext)
 
396
                                LM_URB_FREE(pObj, pMLMEContext,
 
397
                                            sizeof(struct rt_tx_buffer));
 
398
                }
 
399
                os_free_mem(pAd, pAd->MgmtDescRing.AllocVa);
 
400
                pAd->MgmtDescRing.AllocVa = NULL;
 
401
        }
 
402
 
 
403
out1:
 
404
        for (acidx = 0; acidx < 4; acidx++) {
 
405
                struct rt_ht_tx_context *pTxContext = &(pAd->TxContext[acidx]);
 
406
                if (pTxContext)
 
407
                        LM_URB_FREE(pObj, pTxContext, sizeof(struct rt_httx_buffer));
 
408
        }
 
409
 
 
410
        /* Here we didn't have any pre-allocated memory need to free. */
 
411
 
 
412
        return Status;
 
413
}
 
414
 
 
415
/*
 
416
========================================================================
 
417
Routine Description:
 
418
    Allocate DMA memory blocks for send, receive.
 
419
 
 
420
Arguments:
 
421
    pAd                                 Pointer to our adapter
 
422
 
 
423
Return Value:
 
424
        NDIS_STATUS_SUCCESS
 
425
        NDIS_STATUS_FAILURE
 
426
        NDIS_STATUS_RESOURCES
 
427
 
 
428
Note:
 
429
========================================================================
 
430
*/
 
431
int RTMPAllocTxRxRingMemory(struct rt_rtmp_adapter *pAd)
 
432
{
 
433
/*      struct rt_counter_802_11  pCounter = &pAd->WlanCounters; */
 
434
        int Status;
 
435
        int num;
 
436
 
 
437
        DBGPRINT(RT_DEBUG_TRACE, ("--> RTMPAllocTxRxRingMemory\n"));
 
438
 
 
439
        do {
 
440
                /* Init the struct rt_cmdq and CmdQLock */
 
441
                NdisAllocateSpinLock(&pAd->CmdQLock);
 
442
                NdisAcquireSpinLock(&pAd->CmdQLock);
 
443
                RTUSBInitializeCmdQ(&pAd->CmdQ);
 
444
                NdisReleaseSpinLock(&pAd->CmdQLock);
 
445
 
 
446
                NdisAllocateSpinLock(&pAd->MLMEBulkOutLock);
 
447
                /*NdisAllocateSpinLock(&pAd->MLMEWaitQueueLock); */
 
448
                NdisAllocateSpinLock(&pAd->BulkOutLock[0]);
 
449
                NdisAllocateSpinLock(&pAd->BulkOutLock[1]);
 
450
                NdisAllocateSpinLock(&pAd->BulkOutLock[2]);
 
451
                NdisAllocateSpinLock(&pAd->BulkOutLock[3]);
 
452
                NdisAllocateSpinLock(&pAd->BulkOutLock[4]);
 
453
                NdisAllocateSpinLock(&pAd->BulkOutLock[5]);
 
454
                NdisAllocateSpinLock(&pAd->BulkInLock);
 
455
 
 
456
                for (num = 0; num < NUM_OF_TX_RING; num++) {
 
457
                        NdisAllocateSpinLock(&pAd->TxContextQueueLock[num]);
 
458
                }
 
459
 
 
460
/*              NdisAllocateSpinLock(&pAd->MemLock);    // Not used in RT28XX */
 
461
 
 
462
/*              NdisAllocateSpinLock(&pAd->MacTabLock); // init it in UserCfgInit() */
 
463
/*              NdisAllocateSpinLock(&pAd->BATabLock); // init it in BATableInit() */
 
464
 
 
465
/*              for(num=0; num<MAX_LEN_OF_BA_REC_TABLE; num++) */
 
466
/*              { */
 
467
/*                      NdisAllocateSpinLock(&pAd->BATable.BARecEntry[num].RxReRingLock); */
 
468
/*              } */
 
469
 
 
470
                /* */
 
471
                /* Init Mac Table */
 
472
                /* */
 
473
/*              MacTableInitialize(pAd); */
 
474
 
 
475
                /* */
 
476
                /* Init send data structures and related parameters */
 
477
                /* */
 
478
                Status = NICInitTransmit(pAd);
 
479
                if (Status != NDIS_STATUS_SUCCESS)
 
480
                        break;
 
481
 
 
482
                /* */
 
483
                /* Init receive data structures and related parameters */
 
484
                /* */
 
485
                Status = NICInitRecv(pAd);
 
486
                if (Status != NDIS_STATUS_SUCCESS)
 
487
                        break;
 
488
 
 
489
                pAd->PendingIoCount = 1;
 
490
 
 
491
        } while (FALSE);
 
492
 
 
493
        NdisZeroMemory(&pAd->FragFrame, sizeof(struct rt_fragment_frame));
 
494
        pAd->FragFrame.pFragPacket =
 
495
            RTMP_AllocateFragPacketBuffer(pAd, RX_BUFFER_NORMSIZE);
 
496
 
 
497
        if (pAd->FragFrame.pFragPacket == NULL) {
 
498
                Status = NDIS_STATUS_RESOURCES;
 
499
        }
 
500
 
 
501
        DBGPRINT_S(Status,
 
502
                   ("<-- RTMPAllocTxRxRingMemory, Status=%x\n", Status));
 
503
        return Status;
 
504
}
 
505
 
 
506
/*
 
507
========================================================================
 
508
Routine Description:
 
509
        Calls USB_InterfaceStop and frees memory allocated for the URBs
 
510
    calls NdisMDeregisterDevice and frees the memory
 
511
    allocated in VNetInitialize for the Adapter Object
 
512
 
 
513
Arguments:
 
514
        *pAd                            the raxx interface data pointer
 
515
 
 
516
Return Value:
 
517
        None
 
518
 
 
519
Note:
 
520
========================================================================
 
521
*/
 
522
void RTMPFreeTxRxRingMemory(struct rt_rtmp_adapter *pAd)
 
523
{
 
524
#define LM_URB_FREE(pObj, Context, BufferSize)                          \
 
525
        if (NULL != Context->pUrb) {                                                    \
 
526
                RTUSB_UNLINK_URB(Context->pUrb);                                        \
 
527
                RTUSB_FREE_URB(Context->pUrb);                                          \
 
528
                Context->pUrb = NULL; }                                                         \
 
529
        if (NULL != Context->TransferBuffer) {                                  \
 
530
                RTUSB_URB_FREE_BUFFER(pObj->pUsb_Dev, BufferSize,       \
 
531
                                                                Context->TransferBuffer,        \
 
532
                                                                Context->data_dma);                     \
 
533
                Context->TransferBuffer = NULL; }
 
534
 
 
535
        u32 i, acidx;
 
536
        struct rt_tx_context *pNullContext = &pAd->NullContext;
 
537
        struct rt_tx_context *pPsPollContext = &pAd->PsPollContext;
 
538
        struct rt_tx_context *pRTSContext = &pAd->RTSContext;
 
539
/*      struct rt_ht_tx_context *pHTTXContext; */
 
540
        /*PRTMP_REORDERBUF      pReorderBuf; */
 
541
        struct os_cookie *pObj = (struct os_cookie *)pAd->OS_Cookie;
 
542
/*      struct rt_rtmp_tx_ring *pTxRing; */
 
543
 
 
544
        DBGPRINT(RT_DEBUG_ERROR, ("---> RTMPFreeTxRxRingMemory\n"));
 
545
        pObj = pObj;
 
546
 
 
547
        /* Free all resources for the RECEIVE buffer queue. */
 
548
        for (i = 0; i < (RX_RING_SIZE); i++) {
 
549
                struct rt_rx_context *pRxContext = &(pAd->RxContext[i]);
 
550
                if (pRxContext)
 
551
                        LM_URB_FREE(pObj, pRxContext, MAX_RXBULK_SIZE);
 
552
        }
 
553
 
 
554
        /* Free PsPoll frame resource */
 
555
        LM_URB_FREE(pObj, pPsPollContext, sizeof(struct rt_tx_buffer));
 
556
 
 
557
        /* Free NULL frame resource */
 
558
        LM_URB_FREE(pObj, pNullContext, sizeof(struct rt_tx_buffer));
 
559
 
 
560
        /* Free RTS frame resource */
 
561
        LM_URB_FREE(pObj, pRTSContext, sizeof(struct rt_tx_buffer));
 
562
 
 
563
        /* Free beacon frame resource */
 
564
        for (i = 0; i < BEACON_RING_SIZE; i++) {
 
565
                struct rt_tx_context *pBeaconContext = &(pAd->BeaconContext[i]);
 
566
                if (pBeaconContext)
 
567
                        LM_URB_FREE(pObj, pBeaconContext, sizeof(struct rt_tx_buffer));
 
568
        }
 
569
 
 
570
        /* Free mgmt frame resource */
 
571
        for (i = 0; i < MGMT_RING_SIZE; i++) {
 
572
                struct rt_tx_context *pMLMEContext =
 
573
                    (struct rt_tx_context *)pAd->MgmtRing.Cell[i].AllocVa;
 
574
                /*LM_URB_FREE(pObj, pMLMEContext, sizeof(struct rt_tx_buffer)); */
 
575
                if (NULL != pAd->MgmtRing.Cell[i].pNdisPacket) {
 
576
                        RTMPFreeNdisPacket(pAd,
 
577
                                           pAd->MgmtRing.Cell[i].pNdisPacket);
 
578
                        pAd->MgmtRing.Cell[i].pNdisPacket = NULL;
 
579
                        pMLMEContext->TransferBuffer = NULL;
 
580
                }
 
581
 
 
582
                if (pMLMEContext) {
 
583
                        if (NULL != pMLMEContext->pUrb) {
 
584
                                RTUSB_UNLINK_URB(pMLMEContext->pUrb);
 
585
                                RTUSB_FREE_URB(pMLMEContext->pUrb);
 
586
                                pMLMEContext->pUrb = NULL;
 
587
                        }
 
588
                }
 
589
        }
 
590
        if (pAd->MgmtDescRing.AllocVa)
 
591
                os_free_mem(pAd, pAd->MgmtDescRing.AllocVa);
 
592
 
 
593
        /* Free Tx frame resource */
 
594
        for (acidx = 0; acidx < 4; acidx++) {
 
595
                struct rt_ht_tx_context *pHTTXContext = &(pAd->TxContext[acidx]);
 
596
                if (pHTTXContext)
 
597
                        LM_URB_FREE(pObj, pHTTXContext, sizeof(struct rt_httx_buffer));
 
598
        }
 
599
 
 
600
        if (pAd->FragFrame.pFragPacket)
 
601
                RELEASE_NDIS_PACKET(pAd, pAd->FragFrame.pFragPacket,
 
602
                                    NDIS_STATUS_SUCCESS);
 
603
 
 
604
        for (i = 0; i < 6; i++) {
 
605
                NdisFreeSpinLock(&pAd->BulkOutLock[i]);
 
606
        }
 
607
 
 
608
        NdisFreeSpinLock(&pAd->BulkInLock);
 
609
        NdisFreeSpinLock(&pAd->MLMEBulkOutLock);
 
610
 
 
611
        NdisFreeSpinLock(&pAd->CmdQLock);
 
612
        /* Clear all pending bulk-out request flags. */
 
613
        RTUSB_CLEAR_BULK_FLAG(pAd, 0xffffffff);
 
614
 
 
615
/*      NdisFreeSpinLock(&pAd->MacTabLock); */
 
616
 
 
617
/*      for(i=0; i<MAX_LEN_OF_BA_REC_TABLE; i++) */
 
618
/*      { */
 
619
/*              NdisFreeSpinLock(&pAd->BATable.BARecEntry[i].RxReRingLock); */
 
620
/*      } */
 
621
 
 
622
        DBGPRINT(RT_DEBUG_ERROR, ("<--- RTMPFreeTxRxRingMemory\n"));
 
623
}
 
624
 
 
625
/*
 
626
========================================================================
 
627
Routine Description:
 
628
    Write WLAN MAC address to USB 2870.
 
629
 
 
630
Arguments:
 
631
    pAd                                 Pointer to our adapter
 
632
 
 
633
Return Value:
 
634
        NDIS_STATUS_SUCCESS
 
635
 
 
636
Note:
 
637
========================================================================
 
638
*/
 
639
int RTUSBWriteHWMACAddress(struct rt_rtmp_adapter *pAd)
 
640
{
 
641
        MAC_DW0_STRUC StaMacReg0;
 
642
        MAC_DW1_STRUC StaMacReg1;
 
643
        int Status = NDIS_STATUS_SUCCESS;
 
644
        LARGE_INTEGER NOW;
 
645
 
 
646
        /* initialize the random number generator */
 
647
        RTMP_GetCurrentSystemTime(&NOW);
 
648
 
 
649
        if (pAd->bLocalAdminMAC != TRUE) {
 
650
                pAd->CurrentAddress[0] = pAd->PermanentAddress[0];
 
651
                pAd->CurrentAddress[1] = pAd->PermanentAddress[1];
 
652
                pAd->CurrentAddress[2] = pAd->PermanentAddress[2];
 
653
                pAd->CurrentAddress[3] = pAd->PermanentAddress[3];
 
654
                pAd->CurrentAddress[4] = pAd->PermanentAddress[4];
 
655
                pAd->CurrentAddress[5] = pAd->PermanentAddress[5];
 
656
        }
 
657
        /* Write New MAC address to MAC_CSR2 & MAC_CSR3 & let ASIC know our new MAC */
 
658
        StaMacReg0.field.Byte0 = pAd->CurrentAddress[0];
 
659
        StaMacReg0.field.Byte1 = pAd->CurrentAddress[1];
 
660
        StaMacReg0.field.Byte2 = pAd->CurrentAddress[2];
 
661
        StaMacReg0.field.Byte3 = pAd->CurrentAddress[3];
 
662
        StaMacReg1.field.Byte4 = pAd->CurrentAddress[4];
 
663
        StaMacReg1.field.Byte5 = pAd->CurrentAddress[5];
 
664
        StaMacReg1.field.U2MeMask = 0xff;
 
665
        DBGPRINT_RAW(RT_DEBUG_TRACE,
 
666
                     ("Local MAC = %02x:%02x:%02x:%02x:%02x:%02x\n",
 
667
                      pAd->CurrentAddress[0], pAd->CurrentAddress[1],
 
668
                      pAd->CurrentAddress[2], pAd->CurrentAddress[3],
 
669
                      pAd->CurrentAddress[4], pAd->CurrentAddress[5]));
 
670
 
 
671
        RTUSBWriteMACRegister(pAd, MAC_ADDR_DW0, StaMacReg0.word);
 
672
        RTUSBWriteMACRegister(pAd, MAC_ADDR_DW1, StaMacReg1.word);
 
673
        return Status;
 
674
}
 
675
 
 
676
/*
 
677
========================================================================
 
678
Routine Description:
 
679
    Disable DMA.
 
680
 
 
681
Arguments:
 
682
        *pAd                            the raxx interface data pointer
 
683
 
 
684
Return Value:
 
685
        None
 
686
 
 
687
Note:
 
688
========================================================================
 
689
*/
 
690
void RT28XXDMADisable(struct rt_rtmp_adapter *pAd)
 
691
{
 
692
        /* no use */
 
693
}
 
694
 
 
695
/*
 
696
========================================================================
 
697
Routine Description:
 
698
    Enable DMA.
 
699
 
 
700
Arguments:
 
701
        *pAd                            the raxx interface data pointer
 
702
 
 
703
Return Value:
 
704
        None
 
705
 
 
706
Note:
 
707
========================================================================
 
708
*/
 
709
void RT28XXDMAEnable(struct rt_rtmp_adapter *pAd)
 
710
{
 
711
        WPDMA_GLO_CFG_STRUC GloCfg;
 
712
        USB_DMA_CFG_STRUC UsbCfg;
 
713
        int i = 0;
 
714
 
 
715
        RTMP_IO_WRITE32(pAd, MAC_SYS_CTRL, 0x4);
 
716
        do {
 
717
                RTMP_IO_READ32(pAd, WPDMA_GLO_CFG, &GloCfg.word);
 
718
                if ((GloCfg.field.TxDMABusy == 0)
 
719
                    && (GloCfg.field.RxDMABusy == 0))
 
720
                        break;
 
721
 
 
722
                DBGPRINT(RT_DEBUG_TRACE, ("==>  DMABusy\n"));
 
723
                RTMPusecDelay(1000);
 
724
                i++;
 
725
        } while (i < 200);
 
726
 
 
727
        RTMPusecDelay(50);
 
728
        GloCfg.field.EnTXWriteBackDDONE = 1;
 
729
        GloCfg.field.EnableRxDMA = 1;
 
730
        GloCfg.field.EnableTxDMA = 1;
 
731
        DBGPRINT(RT_DEBUG_TRACE,
 
732
                 ("<== WRITE DMA offset 0x208 = 0x%x\n", GloCfg.word));
 
733
        RTMP_IO_WRITE32(pAd, WPDMA_GLO_CFG, GloCfg.word);
 
734
 
 
735
        UsbCfg.word = 0;
 
736
        UsbCfg.field.phyclear = 0;
 
737
        /* usb version is 1.1,do not use bulk in aggregation */
 
738
        if (pAd->BulkInMaxPacketSize == 512)
 
739
                UsbCfg.field.RxBulkAggEn = 1;
 
740
        /* for last packet, PBF might use more than limited, so minus 2 to prevent from error */
 
741
        UsbCfg.field.RxBulkAggLmt = (MAX_RXBULK_SIZE / 1024) - 3;
 
742
        UsbCfg.field.RxBulkAggTOut = 0x80;      /* 2006-10-18 */
 
743
        UsbCfg.field.RxBulkEn = 1;
 
744
        UsbCfg.field.TxBulkEn = 1;
 
745
 
 
746
        RTUSBWriteMACRegister(pAd, USB_DMA_CFG, UsbCfg.word);
 
747
 
 
748
}
 
749
 
 
750
/********************************************************************
 
751
  *
 
752
  *     2870 Beacon Update Related functions.
 
753
  *
 
754
  ********************************************************************/
 
755
 
 
756
/*
 
757
========================================================================
 
758
Routine Description:
 
759
    Write Beacon buffer to Asic.
 
760
 
 
761
Arguments:
 
762
        *pAd                            the raxx interface data pointer
 
763
 
 
764
Return Value:
 
765
        None
 
766
 
 
767
Note:
 
768
========================================================================
 
769
*/
 
770
void RT28xx_UpdateBeaconToAsic(struct rt_rtmp_adapter *pAd,
 
771
                               int apidx,
 
772
                               unsigned long FrameLen, unsigned long UpdatePos)
 
773
{
 
774
        u8 *pBeaconFrame = NULL;
 
775
        u8 *ptr;
 
776
        u32 i, padding;
 
777
        struct rt_beacon_sync *pBeaconSync = pAd->CommonCfg.pBeaconSync;
 
778
        u32 longValue;
 
779
/*      u16                  shortValue; */
 
780
        BOOLEAN bBcnReq = FALSE;
 
781
        u8 bcn_idx = 0;
 
782
 
 
783
        if (pBeaconFrame == NULL) {
 
784
                DBGPRINT(RT_DEBUG_ERROR, ("pBeaconFrame is NULL!\n"));
 
785
                return;
 
786
        }
 
787
 
 
788
        if (pBeaconSync == NULL) {
 
789
                DBGPRINT(RT_DEBUG_ERROR, ("pBeaconSync is NULL!\n"));
 
790
                return;
 
791
        }
 
792
        /*if ((pAd->WdsTab.Mode == WDS_BRIDGE_MODE) || */
 
793
        /*      ((pAd->ApCfg.MBSSID[apidx].MSSIDDev == NULL) || !(pAd->ApCfg.MBSSID[apidx].MSSIDDev->flags & IFF_UP)) */
 
794
        /*      ) */
 
795
        if (bBcnReq == FALSE) {
 
796
                /* when the ra interface is down, do not send its beacon frame */
 
797
                /* clear all zero */
 
798
                for (i = 0; i < TXWI_SIZE; i += 4) {
 
799
                        RTMP_IO_WRITE32(pAd, pAd->BeaconOffset[bcn_idx] + i,
 
800
                                        0x00);
 
801
                }
 
802
                pBeaconSync->BeaconBitMap &=
 
803
                    (~(BEACON_BITMAP_MASK & (1 << bcn_idx)));
 
804
                NdisZeroMemory(pBeaconSync->BeaconTxWI[bcn_idx], TXWI_SIZE);
 
805
        } else {
 
806
                ptr = (u8 *)& pAd->BeaconTxWI;
 
807
                if (NdisEqualMemory(pBeaconSync->BeaconTxWI[bcn_idx], &pAd->BeaconTxWI, TXWI_SIZE) == FALSE) {  /* If BeaconTxWI changed, we need to rewrite the TxWI for the Beacon frames. */
 
808
                        pBeaconSync->BeaconBitMap &=
 
809
                            (~(BEACON_BITMAP_MASK & (1 << bcn_idx)));
 
810
                        NdisMoveMemory(pBeaconSync->BeaconTxWI[bcn_idx],
 
811
                                       &pAd->BeaconTxWI, TXWI_SIZE);
 
812
                }
 
813
 
 
814
                if ((pBeaconSync->BeaconBitMap & (1 << bcn_idx)) !=
 
815
                    (1 << bcn_idx)) {
 
816
                        for (i = 0; i < TXWI_SIZE; i += 4)      /* 16-byte TXWI field */
 
817
                        {
 
818
                                longValue =
 
819
                                    *ptr + (*(ptr + 1) << 8) +
 
820
                                    (*(ptr + 2) << 16) + (*(ptr + 3) << 24);
 
821
                                RTMP_IO_WRITE32(pAd,
 
822
                                                pAd->BeaconOffset[bcn_idx] + i,
 
823
                                                longValue);
 
824
                                ptr += 4;
 
825
                        }
 
826
                }
 
827
 
 
828
                ptr = pBeaconSync->BeaconBuf[bcn_idx];
 
829
                padding = (FrameLen & 0x01);
 
830
                NdisZeroMemory((u8 *)(pBeaconFrame + FrameLen), padding);
 
831
                FrameLen += padding;
 
832
                for (i = 0; i < FrameLen /*HW_BEACON_OFFSET */ ; i += 2) {
 
833
                        if (NdisEqualMemory(ptr, pBeaconFrame, 2) == FALSE) {
 
834
                                NdisMoveMemory(ptr, pBeaconFrame, 2);
 
835
                                /*shortValue = *ptr + (*(ptr+1)<<8); */
 
836
                                /*RTMP_IO_WRITE8(pAd, pAd->BeaconOffset[bcn_idx] + TXWI_SIZE + i, shortValue); */
 
837
                                RTUSBMultiWrite(pAd,
 
838
                                                pAd->BeaconOffset[bcn_idx] +
 
839
                                                TXWI_SIZE + i, ptr, 2);
 
840
                        }
 
841
                        ptr += 2;
 
842
                        pBeaconFrame += 2;
 
843
                }
 
844
 
 
845
                pBeaconSync->BeaconBitMap |= (1 << bcn_idx);
 
846
 
 
847
                /* For AP interface, set the DtimBitOn so that we can send Bcast/Mcast frame out after this beacon frame. */
 
848
        }
 
849
 
 
850
}
 
851
 
 
852
void RTUSBBssBeaconStop(struct rt_rtmp_adapter *pAd)
 
853
{
 
854
        struct rt_beacon_sync *pBeaconSync;
 
855
        int i, offset;
 
856
        BOOLEAN Cancelled = TRUE;
 
857
 
 
858
        pBeaconSync = pAd->CommonCfg.pBeaconSync;
 
859
        if (pBeaconSync && pBeaconSync->EnableBeacon) {
 
860
                int NumOfBcn;
 
861
 
 
862
                {
 
863
                        NumOfBcn = MAX_MESH_NUM;
 
864
                }
 
865
 
 
866
                RTMPCancelTimer(&pAd->CommonCfg.BeaconUpdateTimer, &Cancelled);
 
867
 
 
868
                for (i = 0; i < NumOfBcn; i++) {
 
869
                        NdisZeroMemory(pBeaconSync->BeaconBuf[i],
 
870
                                       HW_BEACON_OFFSET);
 
871
                        NdisZeroMemory(pBeaconSync->BeaconTxWI[i], TXWI_SIZE);
 
872
 
 
873
                        for (offset = 0; offset < HW_BEACON_OFFSET; offset += 4)
 
874
                                RTMP_IO_WRITE32(pAd,
 
875
                                                pAd->BeaconOffset[i] + offset,
 
876
                                                0x00);
 
877
 
 
878
                        pBeaconSync->CapabilityInfoLocationInBeacon[i] = 0;
 
879
                        pBeaconSync->TimIELocationInBeacon[i] = 0;
 
880
                }
 
881
                pBeaconSync->BeaconBitMap = 0;
 
882
                pBeaconSync->DtimBitOn = 0;
 
883
        }
 
884
}
 
885
 
 
886
void RTUSBBssBeaconStart(struct rt_rtmp_adapter *pAd)
 
887
{
 
888
        int apidx;
 
889
        struct rt_beacon_sync *pBeaconSync;
 
890
/*      LARGE_INTEGER   tsfTime, deltaTime; */
 
891
 
 
892
        pBeaconSync = pAd->CommonCfg.pBeaconSync;
 
893
        if (pBeaconSync && pBeaconSync->EnableBeacon) {
 
894
                int NumOfBcn;
 
895
 
 
896
                {
 
897
                        NumOfBcn = MAX_MESH_NUM;
 
898
                }
 
899
 
 
900
                for (apidx = 0; apidx < NumOfBcn; apidx++) {
 
901
                        u8 CapabilityInfoLocationInBeacon = 0;
 
902
                        u8 TimIELocationInBeacon = 0;
 
903
 
 
904
                        NdisZeroMemory(pBeaconSync->BeaconBuf[apidx],
 
905
                                       HW_BEACON_OFFSET);
 
906
                        pBeaconSync->CapabilityInfoLocationInBeacon[apidx] =
 
907
                            CapabilityInfoLocationInBeacon;
 
908
                        pBeaconSync->TimIELocationInBeacon[apidx] =
 
909
                            TimIELocationInBeacon;
 
910
                        NdisZeroMemory(pBeaconSync->BeaconTxWI[apidx],
 
911
                                       TXWI_SIZE);
 
912
                }
 
913
                pBeaconSync->BeaconBitMap = 0;
 
914
                pBeaconSync->DtimBitOn = 0;
 
915
                pAd->CommonCfg.BeaconUpdateTimer.Repeat = TRUE;
 
916
 
 
917
                pAd->CommonCfg.BeaconAdjust = 0;
 
918
                pAd->CommonCfg.BeaconFactor =
 
919
                    0xffffffff / (pAd->CommonCfg.BeaconPeriod << 10);
 
920
                pAd->CommonCfg.BeaconRemain =
 
921
                    (0xffffffff % (pAd->CommonCfg.BeaconPeriod << 10)) + 1;
 
922
                DBGPRINT(RT_DEBUG_TRACE,
 
923
                         ("RTUSBBssBeaconStart:BeaconFactor=%d, BeaconRemain=%d!\n",
 
924
                          pAd->CommonCfg.BeaconFactor,
 
925
                          pAd->CommonCfg.BeaconRemain));
 
926
                RTMPSetTimer(&pAd->CommonCfg.BeaconUpdateTimer,
 
927
                             10 /*pAd->CommonCfg.BeaconPeriod */ );
 
928
 
 
929
        }
 
930
}
 
931
 
 
932
void RTUSBBssBeaconInit(struct rt_rtmp_adapter *pAd)
 
933
{
 
934
        struct rt_beacon_sync *pBeaconSync;
 
935
        int i;
 
936
 
 
937
        os_alloc_mem(pAd, (u8 **) (&pAd->CommonCfg.pBeaconSync),
 
938
                     sizeof(struct rt_beacon_sync));
 
939
        /*NdisAllocMemory(pAd->CommonCfg.pBeaconSync, sizeof(struct rt_beacon_sync), MEM_ALLOC_FLAG); */
 
940
        if (pAd->CommonCfg.pBeaconSync) {
 
941
                pBeaconSync = pAd->CommonCfg.pBeaconSync;
 
942
                NdisZeroMemory(pBeaconSync, sizeof(struct rt_beacon_sync));
 
943
                for (i = 0; i < HW_BEACON_MAX_COUNT; i++) {
 
944
                        NdisZeroMemory(pBeaconSync->BeaconBuf[i],
 
945
                                       HW_BEACON_OFFSET);
 
946
                        pBeaconSync->CapabilityInfoLocationInBeacon[i] = 0;
 
947
                        pBeaconSync->TimIELocationInBeacon[i] = 0;
 
948
                        NdisZeroMemory(pBeaconSync->BeaconTxWI[i], TXWI_SIZE);
 
949
                }
 
950
                pBeaconSync->BeaconBitMap = 0;
 
951
 
 
952
                /*RTMPInitTimer(pAd, &pAd->CommonCfg.BeaconUpdateTimer, GET_TIMER_FUNCTION(BeaconUpdateExec), pAd, TRUE); */
 
953
                pBeaconSync->EnableBeacon = TRUE;
 
954
        }
 
955
}
 
956
 
 
957
void RTUSBBssBeaconExit(struct rt_rtmp_adapter *pAd)
 
958
{
 
959
        struct rt_beacon_sync *pBeaconSync;
 
960
        BOOLEAN Cancelled = TRUE;
 
961
        int i;
 
962
 
 
963
        if (pAd->CommonCfg.pBeaconSync) {
 
964
                pBeaconSync = pAd->CommonCfg.pBeaconSync;
 
965
                pBeaconSync->EnableBeacon = FALSE;
 
966
                RTMPCancelTimer(&pAd->CommonCfg.BeaconUpdateTimer, &Cancelled);
 
967
                pBeaconSync->BeaconBitMap = 0;
 
968
 
 
969
                for (i = 0; i < HW_BEACON_MAX_COUNT; i++) {
 
970
                        NdisZeroMemory(pBeaconSync->BeaconBuf[i],
 
971
                                       HW_BEACON_OFFSET);
 
972
                        pBeaconSync->CapabilityInfoLocationInBeacon[i] = 0;
 
973
                        pBeaconSync->TimIELocationInBeacon[i] = 0;
 
974
                        NdisZeroMemory(pBeaconSync->BeaconTxWI[i], TXWI_SIZE);
 
975
                }
 
976
 
 
977
                os_free_mem(pAd, pAd->CommonCfg.pBeaconSync);
 
978
                pAd->CommonCfg.pBeaconSync = NULL;
 
979
        }
 
980
}
 
981
 
 
982
/*
 
983
    ========================================================================
 
984
    Routine Description:
 
985
        For device work as AP mode but didn't have TBTT interrupt event, we need a mechanism
 
986
        to update the beacon context in each Beacon interval. Here we use a periodical timer
 
987
        to simulate the TBTT interrupt to handle the beacon context update.
 
988
 
 
989
    Arguments:
 
990
        SystemSpecific1         - Not used.
 
991
        FunctionContext         - Pointer to our Adapter context.
 
992
        SystemSpecific2         - Not used.
 
993
        SystemSpecific3         - Not used.
 
994
 
 
995
    Return Value:
 
996
        None
 
997
 
 
998
    ========================================================================
 
999
*/
 
1000
void BeaconUpdateExec(void *SystemSpecific1,
 
1001
                      void *FunctionContext,
 
1002
                      void *SystemSpecific2, void *SystemSpecific3)
 
1003
{
 
1004
        struct rt_rtmp_adapter *pAd = (struct rt_rtmp_adapter *)FunctionContext;
 
1005
        LARGE_INTEGER tsfTime_a;        /*, tsfTime_b, deltaTime_exp, deltaTime_ab; */
 
1006
        u32 delta, delta2MS, period2US, remain, remain_low, remain_high;
 
1007
/*      BOOLEAN                 positive; */
 
1008
 
 
1009
        if (pAd->CommonCfg.IsUpdateBeacon == TRUE) {
 
1010
                ReSyncBeaconTime(pAd);
 
1011
 
 
1012
        }
 
1013
 
 
1014
        RTMP_IO_READ32(pAd, TSF_TIMER_DW0, &tsfTime_a.u.LowPart);
 
1015
        RTMP_IO_READ32(pAd, TSF_TIMER_DW1, &tsfTime_a.u.HighPart);
 
1016
 
 
1017
        /*positive=getDeltaTime(tsfTime_a, expectedTime, &deltaTime_exp); */
 
1018
        period2US = (pAd->CommonCfg.BeaconPeriod << 10);
 
1019
        remain_high = pAd->CommonCfg.BeaconRemain * tsfTime_a.u.HighPart;
 
1020
        remain_low = tsfTime_a.u.LowPart % (pAd->CommonCfg.BeaconPeriod << 10);
 
1021
        remain =
 
1022
            (remain_high + remain_low) % (pAd->CommonCfg.BeaconPeriod << 10);
 
1023
        delta = (pAd->CommonCfg.BeaconPeriod << 10) - remain;
 
1024
 
 
1025
        delta2MS = (delta >> 10);
 
1026
        if (delta2MS > 150) {
 
1027
                pAd->CommonCfg.BeaconUpdateTimer.TimerValue = 100;
 
1028
                pAd->CommonCfg.IsUpdateBeacon = FALSE;
 
1029
        } else {
 
1030
                pAd->CommonCfg.BeaconUpdateTimer.TimerValue = delta2MS + 10;
 
1031
                pAd->CommonCfg.IsUpdateBeacon = TRUE;
 
1032
        }
 
1033
 
 
1034
}
 
1035
 
 
1036
/********************************************************************
 
1037
  *
 
1038
  *     2870 Radio on/off Related functions.
 
1039
  *
 
1040
  ********************************************************************/
 
1041
void RT28xxUsbMlmeRadioOn(struct rt_rtmp_adapter *pAd)
 
1042
{
 
1043
        struct rt_rtmp_chip_op *pChipOps = &pAd->chipOps;
 
1044
 
 
1045
        DBGPRINT(RT_DEBUG_TRACE, ("RT28xxUsbMlmeRadioOn()\n"));
 
1046
 
 
1047
        if (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_RADIO_OFF))
 
1048
                return;
 
1049
 
 
1050
        {
 
1051
                AsicSendCommandToMcu(pAd, 0x31, 0xff, 0x00, 0x02);
 
1052
                RTMPusecDelay(10000);
 
1053
        }
 
1054
        /*NICResetFromError(pAd); */
 
1055
 
 
1056
        /* Enable Tx/Rx */
 
1057
        RTMPEnableRxTx(pAd);
 
1058
 
 
1059
        if (pChipOps->AsicReverseRfFromSleepMode)
 
1060
                pChipOps->AsicReverseRfFromSleepMode(pAd);
 
1061
 
 
1062
        /* Clear Radio off flag */
 
1063
        RTMP_CLEAR_FLAG(pAd, fRTMP_ADAPTER_RADIO_OFF);
 
1064
 
 
1065
        RTUSBBulkReceive(pAd);
 
1066
 
 
1067
        /* Set LED */
 
1068
        RTMPSetLED(pAd, LED_RADIO_ON);
 
1069
}
 
1070
 
 
1071
void RT28xxUsbMlmeRadioOFF(struct rt_rtmp_adapter *pAd)
 
1072
{
 
1073
        WPDMA_GLO_CFG_STRUC GloCfg;
 
1074
        u32 Value, i;
 
1075
 
 
1076
        DBGPRINT(RT_DEBUG_TRACE, ("RT28xxUsbMlmeRadioOFF()\n"));
 
1077
 
 
1078
        if (RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_RADIO_OFF))
 
1079
                return;
 
1080
 
 
1081
        /* Clear PMKID cache. */
 
1082
        pAd->StaCfg.SavedPMKNum = 0;
 
1083
        RTMPZeroMemory(pAd->StaCfg.SavedPMK, (PMKID_NO * sizeof(struct rt_bssid_info)));
 
1084
 
 
1085
        /* Link down first if any association exists */
 
1086
        if (!RTMP_TEST_FLAG(pAd, fRTMP_ADAPTER_NIC_NOT_EXIST)) {
 
1087
                if (INFRA_ON(pAd) || ADHOC_ON(pAd)) {
 
1088
                        struct rt_mlme_disassoc_req DisReq;
 
1089
                        struct rt_mlme_queue_elem *pMsgElem =
 
1090
                            (struct rt_mlme_queue_elem *)kmalloc(sizeof(struct rt_mlme_queue_elem),
 
1091
                                                        MEM_ALLOC_FLAG);
 
1092
 
 
1093
                        if (pMsgElem) {
 
1094
                                COPY_MAC_ADDR(&DisReq.Addr,
 
1095
                                              pAd->CommonCfg.Bssid);
 
1096
                                DisReq.Reason = REASON_DISASSOC_STA_LEAVING;
 
1097
 
 
1098
                                pMsgElem->Machine = ASSOC_STATE_MACHINE;
 
1099
                                pMsgElem->MsgType = MT2_MLME_DISASSOC_REQ;
 
1100
                                pMsgElem->MsgLen =
 
1101
                                    sizeof(struct rt_mlme_disassoc_req);
 
1102
                                NdisMoveMemory(pMsgElem->Msg, &DisReq,
 
1103
                                               sizeof
 
1104
                                               (struct rt_mlme_disassoc_req));
 
1105
 
 
1106
                                MlmeDisassocReqAction(pAd, pMsgElem);
 
1107
                                kfree(pMsgElem);
 
1108
 
 
1109
                                RTMPusecDelay(1000);
 
1110
                        }
 
1111
                }
 
1112
        }
 
1113
        /* Set Radio off flag */
 
1114
        RTMP_SET_FLAG(pAd, fRTMP_ADAPTER_RADIO_OFF);
 
1115
 
 
1116
        {
 
1117
                /* Link down first if any association exists */
 
1118
                if (INFRA_ON(pAd) || ADHOC_ON(pAd))
 
1119
                        LinkDown(pAd, FALSE);
 
1120
                RTMPusecDelay(10000);
 
1121
 
 
1122
                /*========================================== */
 
1123
                /* Clean up old bss table */
 
1124
                BssTableInit(&pAd->ScanTab);
 
1125
        }
 
1126
 
 
1127
        /* Set LED */
 
1128
        RTMPSetLED(pAd, LED_RADIO_OFF);
 
1129
 
 
1130
        if (pAd->CommonCfg.BBPCurrentBW == BW_40) {
 
1131
                /* Must using 40MHz. */
 
1132
                AsicTurnOffRFClk(pAd, pAd->CommonCfg.CentralChannel);
 
1133
        } else {
 
1134
                /* Must using 20MHz. */
 
1135
                AsicTurnOffRFClk(pAd, pAd->CommonCfg.Channel);
 
1136
        }
 
1137
 
 
1138
        /* Disable Tx/Rx DMA */
 
1139
        RTUSBReadMACRegister(pAd, WPDMA_GLO_CFG, &GloCfg.word); /* disable DMA */
 
1140
        GloCfg.field.EnableTxDMA = 0;
 
1141
        GloCfg.field.EnableRxDMA = 0;
 
1142
        RTUSBWriteMACRegister(pAd, WPDMA_GLO_CFG, GloCfg.word); /* abort all TX rings */
 
1143
 
 
1144
        /* Waiting for DMA idle */
 
1145
        i = 0;
 
1146
        do {
 
1147
                RTMP_IO_READ32(pAd, WPDMA_GLO_CFG, &GloCfg.word);
 
1148
                if ((GloCfg.field.TxDMABusy == 0)
 
1149
                    && (GloCfg.field.RxDMABusy == 0))
 
1150
                        break;
 
1151
 
 
1152
                RTMPusecDelay(1000);
 
1153
        } while (i++ < 100);
 
1154
 
 
1155
        /* Disable MAC Tx/Rx */
 
1156
        RTMP_IO_READ32(pAd, MAC_SYS_CTRL, &Value);
 
1157
        Value &= (0xfffffff3);
 
1158
        RTMP_IO_WRITE32(pAd, MAC_SYS_CTRL, Value);
 
1159
 
 
1160
        {
 
1161
                AsicSendCommandToMcu(pAd, 0x30, 0xff, 0xff, 0x02);
 
1162
        }
 
1163
}
 
1164
 
 
1165
#endif /* RTMP_MAC_USB // */