drivers/usb/net/Zydas/zdbuf.c

   1 #ifndef __ZDBUF_C__
   2 #define __ZDBUF_C__
   3
   4 #include "zd80211.h"
   5 #include <linux/vmalloc.h>
   6
   7
   8 #define MAX_SIGNAL_NUM          64
   9
  10 SignalQ_t mgtQ, txQ, awakeQ, psQ[MAX_RECORD];
  11 SignalQ_t *pMgtQ = &mgtQ, *pTxQ, *pAwakeQ, *pPsQ[MAX_RECORD];
  12
  13 Signal_t *FreeSignalList;
  14 Signal_t *SignalBuf[MAX_SIGNAL_NUM];
  15 U32 freeSignalCount;
  16
  17 FrmDesc_t *FreeFdescList;
  18 FrmDesc_t *FdescBuf[MAX_SIGNAL_NUM];
  19 U32 freeFdescCount = MAX_SIGNAL_NUM;
  20
  21 U32 allocCnt = 0;
  22 U32 freeCnt = 0;
  23
  24 void initSigQue(SignalQ_t *Q)
  25 {
  26         U32 flags;
  27
  28         flags = pdot11Obj->EnterCS();
  29         Q->first = NULL;
  30         Q->last = NULL;
  31         Q->cnt = 0;
  32         pdot11Obj->ExitCS(flags);
  33 }
  34
  35 void releaseSignalBuf(void)
  36 {
  37         int i;
  38
  39         for (i=0; i<MAX_SIGNAL_NUM; i++)
  40                 vfree((void *)SignalBuf[i]);
  41
  42         /*  Point the the FreeSignalList to NULL */
  43         FreeSignalList = NULL;
  44 }
  45
  46 void initSignalBuf(void)
  47 {
  48         int i;
  49         U32 flags;
  50
  51         initSigQue(pMgtQ);
  52         FreeSignalList = NULL;
  53         freeSignalCount = MAX_SIGNAL_NUM;
  54
  55         for (i=0; i<MAX_SIGNAL_NUM; i++){
  56                 SignalBuf[i] = (Signal_t *)vmalloc(sizeof(Signal_t));  //can't use for DMA operation
  57
  58                 if (!SignalBuf[i]){
  59                         FPRINT("80211: initSignalBuf failed");
  60                         //pdot11Obj->ExitCS(flags);
  61                         return;
  62                 }
  63                 flags = pdot11Obj->EnterCS();
  64                 SignalBuf[i]->pNext = FreeSignalList;
  65                 FreeSignalList = SignalBuf[i];
  66                 pdot11Obj->ExitCS(flags);
  67         }
  68 }
  69
  70
  71 Signal_t *allocSignal(void)
  72 {
  73         U32 flags;
  74         Signal_t *signal = NULL;
  75
  76         flags = pdot11Obj->EnterCS();
  77         if (FreeSignalList != NULL){
  78                 signal = FreeSignalList;
  79                 FreeSignalList = FreeSignalList->pNext;
  80                 signal->pNext = NULL;
  81                 signal->buf = NULL;
  82                 signal->frmInfo.frmDesc = NULL;
  83                 freeSignalCount-- ;
  84         }
  85
  86         pdot11Obj->ExitCS(flags);
  87         return signal;
  88 }
  89
  90 void freeSignal(Signal_t *signal)
  91 {
  92         U32 flags;
  93
  94         if (!signal){
  95                 FPRINT("Free NULL signal");
  96                 return;
  97         }
  98
  99         flags = pdot11Obj->EnterCS();
 100         signal->buf = NULL;
 101         signal->vapId=0;
 102
 103         signal->frmInfo.frmDesc = NULL;
 104         signal->pNext = FreeSignalList;
 105         FreeSignalList = signal;
 106         freeSignalCount++;
 107         pdot11Obj->ExitCS(flags);
 108 }
 109
 110 void re_initFdescBuf(void) {
 111         int i;
 112     for (i=0; i<MAX_SIGNAL_NUM; i++)
 113         freeFdesc(FdescBuf[i]);
 114     freeFdescCount = MAX_SIGNAL_NUM;
 115
 116 }
 117
 118 void initFdescBuf(void)
 119 {
 120         int i;
 121         U32 flags;
 122     //FrmDesc_t *pFrmDesc;
 123
 124         flags = pdot11Obj->EnterCS();
 125         FreeFdescList = NULL;
 126
 127         for (i=0; i<MAX_SIGNAL_NUM; i++){
 128                 FdescBuf[i] = (FrmDesc_t *) kmalloc(sizeof (FrmDesc_t), GFP_ATOMIC);  //may use for DMA operation
 129
 130                 if (!FdescBuf[i]){
 131                         FPRINT("80211: initFdescBuf failed");
 132                         pdot11Obj->ExitCS(flags);
 133                         return;
 134                 }
 135
 136                 FdescBuf[i]->pNext = FreeFdescList;
 137                 FreeFdescList = FdescBuf[i];
 138         }
 139
 140 #if 0
 141         FPRINT_V("FreeFdescList", FreeFdescList);
 142         pFrmDesc =  FreeFdescList;
 143         for (i=0; i<MAX_SIGNAL_NUM; i++){
 144                 FPRINT_V("pFrmDesc", pFrmDesc);
 145                 FPRINT_V("pFrmDesc->pNext", pFrmDesc->pNext);
 146                 pFrmDesc = pFrmDesc->pNext;
 147         }
 148 #endif
 149
 150         pdot11Obj->ExitCS(flags);
 151 }
 152
 153
 154 void releaseFdescBuf(void)
 155 {
 156         int i;
 157
 158         for (i=0; i<MAX_SIGNAL_NUM; i++)
 159                 kfree((void *)FdescBuf[i]);
 160
 161         /*  Point the the FreeFdescList to NULL */
 162         FreeFdescList = NULL;
 163 }
 164
 165
 166 FrmDesc_t *allocFdesc(void)
 167 {
 168         U32 flags;
 169         FrmDesc_t *pfrmDesc = NULL;
 170
 171         flags = pdot11Obj->EnterCS();
 172
 173         if (FreeFdescList != NULL){
 174                 pfrmDesc = FreeFdescList;
 175                 FreeFdescList = FreeFdescList->pNext;
 176                 //memset(pfrmDesc,0,sizeof(FrmDesc_t));
 177                 //memset(pfrmDesc->mpdu,0,sizeof(Frame_t)*MAX_FRAG_NUM);
 178                 pfrmDesc->pNext = NULL;
 179                 pfrmDesc->ConfigSet = 0;
 180                 //pfrmDesc->bDataFrm = 0;
 181                 pfrmDesc->pHash = NULL;
 182                 pfrmDesc->bValid = TRUE;
 183         memset(pfrmDesc->CalMIC,0,sizeof(pfrmDesc->CalMIC));
 184                 freeFdescCount--;
 185                 allocCnt++;
 186
 187                 if (FreeFdescList == NULL){
 188                         FPRINT("FreeFdescList == NULL");
 189                         FPRINT_V("freeFdescCount", (U32)freeFdescCount);
 190                         FPRINT_V("Cnt of MgtQ", pMgtQ->cnt);
 191                 }
 192         }
 193
 194         pdot11Obj->ExitCS(flags);
 195         //FPRINT_V("alloc pfrmDesc", (U32)pfrmDesc);
 196         //FPRINT_V("FreeFdescList", (U32)FreeFdescList);
 197
 198         return pfrmDesc;
 199 }
 200
 201
 202 void freeFdesc(FrmDesc_t *pfrmDesc)
 203 {
 204         U32 flags;
 205         FrmDesc_t *pOldFdesc;
 206
 207         if (!pfrmDesc){
 208                 FPRINT("Free NULL pfrmDesc");
 209                 return;
 210         }
 211
 212         flags = pdot11Obj->EnterCS();
 213 #if 0
 214         if (!pfrmDesc->bValid){
 215                 FPRINT_V("pfrmDesc->bValid", pfrmDesc->bValid);
 216                 pdot11Obj->ExitCS(flags);
 217                 return;
 218         }
 219 #endif
 220
 221         //FPRINT_V("FreeFdescList", (U32)FreeFdescList);
 222         pOldFdesc =  FreeFdescList;
 223         pfrmDesc->ConfigSet = 0;
 224         //pfrmDesc->bDataFrm = 0;
 225         pfrmDesc->pHash = NULL;
 226         pfrmDesc->pNext = FreeFdescList;
 227         FreeFdescList = pfrmDesc;
 228         pfrmDesc->bValid = FALSE;
 229         freeFdescCount++;
 230         freeCnt++;
 231         //FPRINT_V("free pfrmDesc", (U32)pfrmDesc);
 232
 233 #if 0
 234         if (FreeFdescList == 0){
 235                 FPRINT("xxxxxxxxxx");
 236                 FPRINT_V("free pfrmDesc", (U32)pfrmDesc);
 237                 FPRINT_V("freeFdescCount", (U32)freeFdescCount);
 238         }
 239
 240         if (pfrmDesc == pfrmDesc->pNext){
 241                 FPRINT("ooooooooooo");
 242                 FPRINT_V("pOldFdesc", (U32)pOldFdesc);
 243                 FPRINT_V("free pfrmDesc", (U32)pfrmDesc);
 244                 FPRINT_V("freeFdescCount", (U32)freeFdescCount);
 245         }
 246 #endif
 247         pdot11Obj->ExitCS(flags);
 248 }
 249
 250
 251 Signal_t *sigDeque(SignalQ_t *Q)
 252 {
 253         U32 flags;
 254         Signal_t *signal = NULL;
 255
 256         flags = pdot11Obj->EnterCS();
 257         if (Q->first != NULL){
 258                 Q->cnt--;
 259                 signal = Q->first;
 260                 Q->first = (Q->first)->pNext;
 261                 if (Q->first == NULL)
 262                         Q->last = NULL;
 263         }
 264         pdot11Obj->ExitCS(flags);
 265         return signal;
 266 }
 267
 268
 269 void sigEnque(SignalQ_t *Q, Signal_t *signal)
 270 {
 271         U32 flags;
 272
 273         flags = pdot11Obj->EnterCS();
 274         signal->pNext = NULL;
 275         if (Q->last == NULL){
 276                 Q->first = signal;
 277                 Q->last = signal;
 278         }
 279         else{
 280                 Q->last->pNext = signal;
 281                 Q->last = signal;
 282         }
 283         Q->cnt++;
 284
 285         if (Q == pMgtQ)
 286                 pdot11Obj->QueueFlag |= MGT_QUEUE_SET;
 287         else if (Q == pTxQ)
 288                 pdot11Obj->QueueFlag |= TX_QUEUE_SET;
 289         else if (Q == pAwakeQ)
 290                 pdot11Obj->QueueFlag |= AWAKE_QUEUE_SET;
 291
 292         pdot11Obj->ExitCS(flags);
 293 }
 294
 295
 296 void sigEnqueFirst(SignalQ_t *Q, Signal_t *signal)
 297 {
 298         int i_state;
 299
 300         FPRINT("sigEnqueFirst");
 301
 302         i_state = pdot11Obj->EnterCS();
 303         signal->pNext = Q->first;
 304
 305         if (Q->last == NULL){
 306                 Q->last = signal;
 307         }
 308
 309         Q->first = signal;
 310         Q->cnt++;
 311
 312         pdot11Obj->ExitCS(i_state);
 313 }
 314
 315 #endif
 316