drivers/staging/vt6655/wctl.c

   1 /*
   2  * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
   3  * All rights reserved.
   4  *
   5  * This program is free software; you can redistribute it and/or modify
   6  * it under the terms of the GNU General Public License as published by
   7  * the Free Software Foundation; either version 2 of the License, or
   8  * (at your option) any later version.
   9  *
  10  * This program is distributed in the hope that it will be useful,
  11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  * GNU General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License along
  16  * with this program; if not, write to the Free Software Foundation, Inc.,
  17  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  18  *
  19  * File: wctl.c
  20  *
  21  * Purpose: handle WMAC duplicate filter & defragment
  22  *
  23  * Author: Jerry Chen
  24  *
  25  * Date: Jun. 27, 2002
  26  *
  27  * Functions:
  28  *      WCTLbIsDuplicate - Test if duplicate packet
  29  *      WCTLuSearchDFCB - Search DeFragment Control Database
  30  *      WCTLuInsertDFCB - Insert DeFragment Control Database
  31  *      WCTLbHandleFragment - Handle received fragment packet
  32  *
  33  * Revision History:
  34  *
  35  */
  36
  37 #include "wctl.h"
  38 #include "device.h"
  39 #include "card.h"
  40
  41 /*---------------------  Static Definitions -------------------------*/
  42
  43 /*---------------------  Static Classes  ----------------------------*/
  44
  45 /*---------------------  Static Variables  --------------------------*/
  46 // static int          msglevel                =MSG_LEVEL_INFO;
  47 /*---------------------  Static Functions  --------------------------*/
  48
  49 /*---------------------  Export Variables  --------------------------*/
  50
  51 /*
  52  * Description:
  53  *      Scan Rx cache.  Return true if packet is duplicate, else
  54  *      inserts in receive cache and returns false.
  55  *
  56  * Parameters:
  57  *  In:
  58  *      pCache      - Receive packets history
  59  *      pMACHeader  - 802.11 MAC Header of received packet
  60  *  Out:
  61  *      none
  62  *
  63  * Return Value: true if packet duplicate; otherwise false
  64  *
  65  */
  66
  67 bool WCTLbIsDuplicate(PSCache pCache, PS802_11Header pMACHeader)
  68 {
  69         unsigned int uIndex;
  70         unsigned int ii;
  71         PSCacheEntry    pCacheEntry;
  72
  73         if (IS_FC_RETRY(pMACHeader)) {
  74                 uIndex = pCache->uInPtr;
  75                 for (ii = 0; ii < DUPLICATE_RX_CACHE_LENGTH; ii++) {
  76                         pCacheEntry = &(pCache->asCacheEntry[uIndex]);
  77                         if ((pCacheEntry->wFmSequence == pMACHeader->wSeqCtl) &&
  78                             (!compare_ether_addr(&(pCacheEntry->abyAddr2[0]), &(pMACHeader->abyAddr2[0])))
  79 ) {
  80                                 /* Duplicate match */
  81                                 return true;
  82                         }
  83                         ADD_ONE_WITH_WRAP_AROUND(uIndex, DUPLICATE_RX_CACHE_LENGTH);
  84                 }
  85         }
  86         /* Not fount in cache - insert */
  87         pCacheEntry = &pCache->asCacheEntry[pCache->uInPtr];
  88         pCacheEntry->wFmSequence = pMACHeader->wSeqCtl;
  89         memcpy(&(pCacheEntry->abyAddr2[0]), &(pMACHeader->abyAddr2[0]), ETH_ALEN);
  90         ADD_ONE_WITH_WRAP_AROUND(pCache->uInPtr, DUPLICATE_RX_CACHE_LENGTH);
  91         return false;
  92 }
  93
  94 /*
  95  * Description:
  96  *      Found if sequence number of received fragment packet in Defragment Database
  97  *
  98  * Parameters:
  99  *  In:
 100  *      pDevice     - Pointer to adapter
 101  *      pMACHeader  - 802.11 MAC Header of received packet
 102  *  Out:
 103  *      none
 104  *
 105  * Return Value: index number in Defragment Database
 106  *
 107  */
 108 unsigned int WCTLuSearchDFCB(PSDevice pDevice, PS802_11Header pMACHeader)
 109 {
 110         unsigned int ii;
 111
 112         for (ii = 0; ii < pDevice->cbDFCB; ii++) {
 113                 if ((pDevice->sRxDFCB[ii].bInUse == true) &&
 114                     (!compare_ether_addr(&(pDevice->sRxDFCB[ii].abyAddr2[0]), &(pMACHeader->abyAddr2[0])))
 115 ) {
 116                         //
 117                         return ii;
 118                 }
 119         }
 120         return pDevice->cbDFCB;
 121 }
 122
 123 /*
 124  * Description:
 125  *      Insert received fragment packet in Defragment Database
 126  *
 127  * Parameters:
 128  *  In:
 129  *      pDevice     - Pointer to adapter
 130  *      pMACHeader  - 802.11 MAC Header of received packet
 131  *  Out:
 132  *      none
 133  *
 134  * Return Value: index number in Defragment Database
 135  *
 136  */
 137 unsigned int WCTLuInsertDFCB(PSDevice pDevice, PS802_11Header pMACHeader)
 138 {
 139         unsigned int ii;
 140
 141         if (pDevice->cbFreeDFCB == 0)
 142                 return pDevice->cbDFCB;
 143         for (ii = 0; ii < pDevice->cbDFCB; ii++) {
 144                 if (pDevice->sRxDFCB[ii].bInUse == false) {
 145                         pDevice->cbFreeDFCB--;
 146                         pDevice->sRxDFCB[ii].uLifetime = pDevice->dwMaxReceiveLifetime;
 147                         pDevice->sRxDFCB[ii].bInUse = true;
 148                         pDevice->sRxDFCB[ii].wSequence = (pMACHeader->wSeqCtl >> 4);
 149                         pDevice->sRxDFCB[ii].wFragNum = (pMACHeader->wSeqCtl & 0x000F);
 150                         memcpy(&(pDevice->sRxDFCB[ii].abyAddr2[0]), &(pMACHeader->abyAddr2[0]), ETH_ALEN);
 151                         return ii;
 152                 }
 153         }
 154         return pDevice->cbDFCB;
 155 }
 156
 157 /*
 158  * Description:
 159  *      Handle received fragment packet
 160  *
 161  * Parameters:
 162  *  In:
 163  *      pDevice         - Pointer to adapter
 164  *      pMACHeader      - 802.11 MAC Header of received packet
 165  *      cbFrameLength   - Frame length
 166  *      bWEP            - is WEP packet
 167  *  Out:
 168  *      none
 169  *
 170  * Return Value: true if it is valid fragment packet and we have resource to defragment; otherwise false
 171  *
 172  */
 173 bool WCTLbHandleFragment(PSDevice pDevice, PS802_11Header pMACHeader, unsigned int cbFrameLength, bool bWEP, bool bExtIV)
 174 {
 175         unsigned int uHeaderSize;
 176
 177         if (bWEP == true) {
 178                 uHeaderSize = 28;
 179                 if (bExtIV)
 180                         // ExtIV
 181                         uHeaderSize += 4;
 182         } else {
 183                 uHeaderSize = 24;
 184         }
 185
 186         if (IS_FIRST_FRAGMENT_PKT(pMACHeader)) {
 187                 pDevice->uCurrentDFCBIdx = WCTLuSearchDFCB(pDevice, pMACHeader);
 188                 if (pDevice->uCurrentDFCBIdx < pDevice->cbDFCB) {
 189                         // duplicate, we must flush previous DCB
 190                         pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].uLifetime = pDevice->dwMaxReceiveLifetime;
 191                         pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].wSequence = (pMACHeader->wSeqCtl >> 4);
 192                         pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].wFragNum = (pMACHeader->wSeqCtl & 0x000F);
 193                 } else {
 194                         pDevice->uCurrentDFCBIdx = WCTLuInsertDFCB(pDevice, pMACHeader);
 195                         if (pDevice->uCurrentDFCBIdx == pDevice->cbDFCB) {
 196                                 return false;
 197                         }
 198                 }
 199                 // reserve 4 byte to match MAC RX Buffer
 200                 pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].pbyRxBuffer = (unsigned char *)(pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].skb->data + 4);
 201                 memcpy(pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].pbyRxBuffer, pMACHeader, cbFrameLength);
 202                 pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].cbFrameLength = cbFrameLength;
 203                 pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].pbyRxBuffer += cbFrameLength;
 204                 pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].wFragNum++;
 205                 //DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "First pDevice->uCurrentDFCBIdx= %d\n", pDevice->uCurrentDFCBIdx);
 206                 return false;
 207         } else {
 208                 pDevice->uCurrentDFCBIdx = WCTLuSearchDFCB(pDevice, pMACHeader);
 209                 if (pDevice->uCurrentDFCBIdx != pDevice->cbDFCB) {
 210                         if ((pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].wSequence == (pMACHeader->wSeqCtl >> 4)) &&
 211                             (pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].wFragNum == (pMACHeader->wSeqCtl & 0x000F)) &&
 212                             ((pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].cbFrameLength + cbFrameLength - uHeaderSize) < 2346)) {
 213                                 memcpy(pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].pbyRxBuffer, ((unsigned char *)(pMACHeader) + uHeaderSize), (cbFrameLength - uHeaderSize));
 214                                 pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].cbFrameLength += (cbFrameLength - uHeaderSize);
 215                                 pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].pbyRxBuffer += (cbFrameLength - uHeaderSize);
 216                                 pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].wFragNum++;
 217                                 //DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Second pDevice->uCurrentDFCBIdx= %d\n", pDevice->uCurrentDFCBIdx);
 218                         } else {
 219                                 // seq error or frag # error flush DFCB
 220                                 pDevice->cbFreeDFCB++;
 221                                 pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].bInUse = false;
 222                                 return false;
 223                         }
 224                 } else {
 225                         return false;
 226                 }
 227                 if (IS_LAST_FRAGMENT_PKT(pMACHeader)) {
 228                         //enq defragcontrolblock
 229                         pDevice->cbFreeDFCB++;
 230                         pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].bInUse = false;
 231                         //DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Last pDevice->uCurrentDFCBIdx= %d\n", pDevice->uCurrentDFCBIdx);
 232                         return true;
 233                 }
 234                 return false;
 235         }
 236 }