[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / staging / vt6656 / wctl.c

/*
 * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
 * All rights reserved.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License along
 * with this program; if not, write to the Free Software Foundation, Inc.,
 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
 *
 * File: wctl.c
 *
 * Purpose: handle WMAC duplicate filter & defragment
 *
 * Author: Jerry Chen
 *
 * Date: Jun. 27, 2002
 *
 * Functions:
 *      WCTLbIsDuplicate - Test if duplicate packet
 *      WCTLuSearchDFCB - Search DeFragment Control Database
 *      WCTLuInsertDFCB - Insert DeFragment Control Database
 *      WCTLbHandleFragment - Handle received fragment packet
 *
 * Revision History:
 *
 */

#include "wctl.h"
#include "device.h"
#include "card.h"
#include "tmacro.h"

/*---------------------  Static Definitions -------------------------*/

/*---------------------  Static Classes  ----------------------------*/

/*---------------------  Static Variables  --------------------------*/
// static int          msglevel                =MSG_LEVEL_INFO;
/*---------------------  Static Functions  --------------------------*/

/*---------------------  Export Variables  --------------------------*/


/*
 * Description:
 *      Scan Rx cache.  Return TRUE if packet is duplicate, else
 *      inserts in receive cache and returns FALSE.
 *
 * Parameters:
 *  In:
 *      pCache      - Receive packets history
 *      pMACHeader  - 802.11 MAC Header of received packet
 *  Out:
 *      none
 *
 * Return Value: TRUE if packet duplicate; otherwise FALSE
 *
 */

BOOL WCTLbIsDuplicate (PSCache pCache, PS802_11Header pMACHeader)
{
    unsigned int            uIndex;
    unsigned int            ii;
    PSCacheEntry    pCacheEntry;

    if (IS_FC_RETRY(pMACHeader)) {

        uIndex = pCache->uInPtr;
        for (ii = 0; ii < DUPLICATE_RX_CACHE_LENGTH; ii++) {
            pCacheEntry = &(pCache->asCacheEntry[uIndex]);
            if ((pCacheEntry->wFmSequence == pMACHeader->wSeqCtl) &&
		(!compare_ether_addr(&(pCacheEntry->abyAddr2[0]),
				     &(pMACHeader->abyAddr2[0]))) &&
                (LOBYTE(pCacheEntry->wFrameCtl) == LOBYTE(pMACHeader->wFrameCtl))
                ) {
                /* Duplicate match */
                return TRUE;
            }
            ADD_ONE_WITH_WRAP_AROUND(uIndex, DUPLICATE_RX_CACHE_LENGTH);
        }
    }
    /* Not found in cache - insert */
    pCacheEntry = &pCache->asCacheEntry[pCache->uInPtr];
    pCacheEntry->wFmSequence = pMACHeader->wSeqCtl;
    memcpy(&(pCacheEntry->abyAddr2[0]), &(pMACHeader->abyAddr2[0]), ETH_ALEN);
    pCacheEntry->wFrameCtl = pMACHeader->wFrameCtl;
    ADD_ONE_WITH_WRAP_AROUND(pCache->uInPtr, DUPLICATE_RX_CACHE_LENGTH);
    return FALSE;
}

/*
 * Description:
 *      Found if sequence number of received fragment packet in Defragment Database
 *
 * Parameters:
 *  In:
 *      pDevice     - Pointer to adapter
 *      pMACHeader  - 802.11 MAC Header of received packet
 *  Out:
 *      none
 *
 * Return Value: index number in Defragment Database
 *
 */

unsigned int WCTLuSearchDFCB(PSDevice pDevice, PS802_11Header pMACHeader)
{
	unsigned int ii;

	for (ii = 0; ii < pDevice->cbDFCB; ii++) {
		if ((pDevice->sRxDFCB[ii].bInUse == TRUE) &&
		    (!compare_ether_addr(&(pDevice->sRxDFCB[ii].abyAddr2[0]),
					  &(pMACHeader->abyAddr2[0])))) {
			return ii;
		}
	}
	return pDevice->cbDFCB;
}

/*
 * Description:
 *      Insert received fragment packet in Defragment Database
 *
 * Parameters:
 *  In:
 *      pDevice     - Pointer to adapter
 *      pMACHeader  - 802.11 MAC Header of received packet
 *  Out:
 *      none
 *
 * Return Value: index number in Defragment Database
 *
 */
unsigned int WCTLuInsertDFCB(PSDevice pDevice, PS802_11Header pMACHeader)
{
	unsigned int ii;

    if (pDevice->cbFreeDFCB == 0)
        return(pDevice->cbDFCB);
    for (ii = 0; ii < pDevice->cbDFCB; ii++) {
        if (pDevice->sRxDFCB[ii].bInUse == FALSE) {
            pDevice->cbFreeDFCB--;
            pDevice->sRxDFCB[ii].uLifetime = pDevice->dwMaxReceiveLifetime;
            pDevice->sRxDFCB[ii].bInUse = TRUE;
            pDevice->sRxDFCB[ii].wSequence = (pMACHeader->wSeqCtl >> 4);
            pDevice->sRxDFCB[ii].wFragNum = (pMACHeader->wSeqCtl & 0x000F);
	    memcpy(&(pDevice->sRxDFCB[ii].abyAddr2[0]),
		   &(pMACHeader->abyAddr2[0]),
		   ETH_ALEN);
            return(ii);
        }
    }
    return(pDevice->cbDFCB);
}


/*
 * Description:
 *      Handle received fragment packet
 *
 * Parameters:
 *  In:
 *      pDevice         - Pointer to adapter
 *      pMACHeader      - 802.11 MAC Header of received packet
 *      cbFrameLength   - Frame length
 *      bWEP            - is WEP packet
 *  Out:
 *      none
 *
 * Return Value: TRUE if it is valid fragment packet and we have resource to defragment; otherwise FALSE
 *
 */
BOOL WCTLbHandleFragment(PSDevice pDevice, PS802_11Header pMACHeader,
			 unsigned int cbFrameLength, BOOL bWEP, BOOL bExtIV)
{
unsigned int            uHeaderSize;


    if (bWEP == TRUE) {
        uHeaderSize = 28;
        if (bExtIV)
        // ExtIV
            uHeaderSize +=4;
    }
    else {
        uHeaderSize = 24;
    }

    if (IS_FIRST_FRAGMENT_PKT(pMACHeader)) {
        pDevice->uCurrentDFCBIdx = WCTLuSearchDFCB(pDevice, pMACHeader);
        if (pDevice->uCurrentDFCBIdx < pDevice->cbDFCB) {
            // duplicate, we must flush previous DCB
            pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].uLifetime = pDevice->dwMaxReceiveLifetime;
            pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].wSequence = (pMACHeader->wSeqCtl >> 4);
            pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].wFragNum = (pMACHeader->wSeqCtl & 0x000F);
        }
        else {
            pDevice->uCurrentDFCBIdx = WCTLuInsertDFCB(pDevice, pMACHeader);
            if (pDevice->uCurrentDFCBIdx == pDevice->cbDFCB) {
                return(FALSE);
            }
        }
        // reserve 8 byte to match MAC RX Buffer
        pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].pbyRxBuffer = (PBYTE) (pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].skb->data + 8);
//        pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].pbyRxBuffer = (PBYTE) (pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].skb->data + 4);
        memcpy(pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].pbyRxBuffer, pMACHeader, cbFrameLength);
        pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].cbFrameLength = cbFrameLength;
        pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].pbyRxBuffer += cbFrameLength;
        pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].wFragNum++;
        //DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "First pDevice->uCurrentDFCBIdx= %d\n", pDevice->uCurrentDFCBIdx);
        return(FALSE);
    }
    else {
        pDevice->uCurrentDFCBIdx = WCTLuSearchDFCB(pDevice, pMACHeader);
        if (pDevice->uCurrentDFCBIdx != pDevice->cbDFCB) {
            if ((pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].wSequence == (pMACHeader->wSeqCtl >> 4)) &&
                (pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].wFragNum == (pMACHeader->wSeqCtl & 0x000F)) &&
                ((pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].cbFrameLength + cbFrameLength - uHeaderSize) < 2346)) {

                memcpy(pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].pbyRxBuffer, ((PBYTE) (pMACHeader) + uHeaderSize), (cbFrameLength - uHeaderSize));
                pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].cbFrameLength += (cbFrameLength - uHeaderSize);
                pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].pbyRxBuffer += (cbFrameLength - uHeaderSize);
                pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].wFragNum++;
                //DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Second pDevice->uCurrentDFCBIdx= %d\n", pDevice->uCurrentDFCBIdx);
            }
            else {
                // seq error or frag # error flush DFCB
                pDevice->cbFreeDFCB++;
                pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].bInUse = FALSE;
                return(FALSE);
            }
        }
        else {
            return(FALSE);
        }
        if (IS_LAST_FRAGMENT_PKT(pMACHeader)) {
            //enq defragcontrolblock
            pDevice->cbFreeDFCB++;
            pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].bInUse = FALSE;
            //DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Last pDevice->uCurrentDFCBIdx= %d\n", pDevice->uCurrentDFCBIdx);
            return(TRUE);
        }
        return(FALSE);
    }
}
Commit	Line	Data
92b96797 FB	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
92b96797	37	#include "wctl.h"
92b96797	38	#include "device.h"
92b96797	39	#include "card.h"
92b96797	40	#include "tmacro.h"
92b96797 FB	41
	42	/--------------------- Static Definitions -------------------------/
	43
	44	/--------------------- Static Classes ----------------------------/
	45
	46	/--------------------- Static Variables --------------------------/
	47	// static int msglevel =MSG_LEVEL_INFO;
	48	/--------------------- Static Functions --------------------------/
	49
	50	/--------------------- Export Variables --------------------------/
	51
	52
	53
	54	/*
	55	* Description:
	56	* Scan Rx cache. Return TRUE if packet is duplicate, else
	57	* inserts in receive cache and returns FALSE.
	58	*
	59	* Parameters:
	60	* In:
	61	* pCache - Receive packets history
	62	* pMACHeader - 802.11 MAC Header of received packet
	63	* Out:
	64	* none
	65	*
	66	* Return Value: TRUE if packet duplicate; otherwise FALSE
	67	*
	68	*/
	69
	70	BOOL WCTLbIsDuplicate (PSCache pCache, PS802_11Header pMACHeader)
	71	{
cc856e61 AM	72	unsigned int uIndex;
cc856e61 AM	73	unsigned int ii;
92b96797 FB	74	PSCacheEntry pCacheEntry;
	75
	76	if (IS_FC_RETRY(pMACHeader)) {
	77
	78	uIndex = pCache->uInPtr;
	79	for (ii = 0; ii < DUPLICATE_RX_CACHE_LENGTH; ii++) {
	80	pCacheEntry = &(pCache->asCacheEntry[uIndex]);
	81	if ((pCacheEntry->wFmSequence == pMACHeader->wSeqCtl) &&
4722a26c AM	82	(!compare_ether_addr(&(pCacheEntry->abyAddr2[0]),
4722a26c AM	83	&(pMACHeader->abyAddr2[0]))) &&
92b96797 FB	84	(LOBYTE(pCacheEntry->wFrameCtl) == LOBYTE(pMACHeader->wFrameCtl))
	85	) {
	86	/* Duplicate match */
	87	return TRUE;
	88	}
	89	ADD_ONE_WITH_WRAP_AROUND(uIndex, DUPLICATE_RX_CACHE_LENGTH);
	90	}
	91	}
a0a1f61a	92	/* Not found in cache - insert */
92b96797 FB	93	pCacheEntry = &pCache->asCacheEntry[pCache->uInPtr];
92b96797 FB	94	pCacheEntry->wFmSequence = pMACHeader->wSeqCtl;
9a0e756c	95	memcpy(&(pCacheEntry->abyAddr2[0]), &(pMACHeader->abyAddr2[0]), ETH_ALEN);
92b96797 FB	96	pCacheEntry->wFrameCtl = pMACHeader->wFrameCtl;
	97	ADD_ONE_WITH_WRAP_AROUND(pCache->uInPtr, DUPLICATE_RX_CACHE_LENGTH);
	98	return FALSE;
	99	}
	100
	101	/*
	102	* Description:
	103	* Found if sequence number of received fragment packet in Defragment Database
	104	*
	105	* Parameters:
	106	* In:
	107	* pDevice - Pointer to adapter
	108	* pMACHeader - 802.11 MAC Header of received packet
	109	* Out:
	110	* none
	111	*
	112	* Return Value: index number in Defragment Database
	113	*
	114	*/
33d33e42	115
cc856e61	116	unsigned int WCTLuSearchDFCB(PSDevice pDevice, PS802_11Header pMACHeader)
92b96797	117	{
cc856e61	118	unsigned int ii;
92b96797	119
33d33e42 AM	120	for (ii = 0; ii < pDevice->cbDFCB; ii++) {
33d33e42 AM	121	if ((pDevice->sRxDFCB[ii].bInUse == TRUE) &&
4722a26c	122	(!compare_ether_addr(&(pDevice->sRxDFCB[ii].abyAddr2[0]),
33d33e42 AM	123	&(pMACHeader->abyAddr2[0])))) {
	124	return ii;
	125	}
	126	}
	127	return pDevice->cbDFCB;
92b96797 FB	128	}
92b96797 FB	129
92b96797 FB	130	/*
	131	* Description:
	132	* Insert received fragment packet in Defragment Database
	133	*
	134	* Parameters:
	135	* In:
	136	* pDevice - Pointer to adapter
	137	* pMACHeader - 802.11 MAC Header of received packet
	138	* Out:
	139	* none
	140	*
	141	* Return Value: index number in Defragment Database
	142	*
	143	*/
cc856e61	144	unsigned int WCTLuInsertDFCB(PSDevice pDevice, PS802_11Header pMACHeader)
92b96797	145	{
cc856e61	146	unsigned int ii;
92b96797 FB	147
	148	if (pDevice->cbFreeDFCB == 0)
	149	return(pDevice->cbDFCB);
33d33e42	150	for (ii = 0; ii < pDevice->cbDFCB; ii++) {
92b96797 FB	151	if (pDevice->sRxDFCB[ii].bInUse == FALSE) {
	152	pDevice->cbFreeDFCB--;
	153	pDevice->sRxDFCB[ii].uLifetime = pDevice->dwMaxReceiveLifetime;
	154	pDevice->sRxDFCB[ii].bInUse = TRUE;
	155	pDevice->sRxDFCB[ii].wSequence = (pMACHeader->wSeqCtl >> 4);
	156	pDevice->sRxDFCB[ii].wFragNum = (pMACHeader->wSeqCtl & 0x000F);
9a0e756c AM	157	memcpy(&(pDevice->sRxDFCB[ii].abyAddr2[0]),
	158	&(pMACHeader->abyAddr2[0]),
	159	ETH_ALEN);
92b96797 FB	160	return(ii);
	161	}
	162	}
	163	return(pDevice->cbDFCB);
	164	}
	165
	166
	167	/*
	168	* Description:
	169	* Handle received fragment packet
	170	*
	171	* Parameters:
	172	* In:
	173	* pDevice - Pointer to adapter
	174	* pMACHeader - 802.11 MAC Header of received packet
	175	* cbFrameLength - Frame length
	176	* bWEP - is WEP packet
	177	* Out:
	178	* none
	179	*
	180	* Return Value: TRUE if it is valid fragment packet and we have resource to defragment; otherwise FALSE
	181	*
	182	*/
cc856e61 AM	183	BOOL WCTLbHandleFragment(PSDevice pDevice, PS802_11Header pMACHeader,
cc856e61 AM	184	unsigned int cbFrameLength, BOOL bWEP, BOOL bExtIV)
92b96797	185	{
cc856e61	186	unsigned int uHeaderSize;
92b96797 FB	187
	188
	189	if (bWEP == TRUE) {
	190	uHeaderSize = 28;
	191	if (bExtIV)
	192	// ExtIV
	193	uHeaderSize +=4;
	194	}
	195	else {
	196	uHeaderSize = 24;
	197	}
	198
	199	if (IS_FIRST_FRAGMENT_PKT(pMACHeader)) {
	200	pDevice->uCurrentDFCBIdx = WCTLuSearchDFCB(pDevice, pMACHeader);
	201	if (pDevice->uCurrentDFCBIdx < pDevice->cbDFCB) {
	202	// duplicate, we must flush previous DCB
	203	pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].uLifetime = pDevice->dwMaxReceiveLifetime;
	204	pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].wSequence = (pMACHeader->wSeqCtl >> 4);
	205	pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].wFragNum = (pMACHeader->wSeqCtl & 0x000F);
	206	}
	207	else {
	208	pDevice->uCurrentDFCBIdx = WCTLuInsertDFCB(pDevice, pMACHeader);
	209	if (pDevice->uCurrentDFCBIdx == pDevice->cbDFCB) {
	210	return(FALSE);
	211	}
	212	}
	213	// reserve 8 byte to match MAC RX Buffer
	214	pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].pbyRxBuffer = (PBYTE) (pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].skb->data + 8);
	215	// pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].pbyRxBuffer = (PBYTE) (pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].skb->data + 4);
	216	memcpy(pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].pbyRxBuffer, pMACHeader, cbFrameLength);
	217	pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].cbFrameLength = cbFrameLength;
	218	pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].pbyRxBuffer += cbFrameLength;
	219	pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].wFragNum++;
	220	//DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "First pDevice->uCurrentDFCBIdx= %d\n", pDevice->uCurrentDFCBIdx);
	221	return(FALSE);
	222	}
	223	else {
	224	pDevice->uCurrentDFCBIdx = WCTLuSearchDFCB(pDevice, pMACHeader);
	225	if (pDevice->uCurrentDFCBIdx != pDevice->cbDFCB) {
	226	if ((pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].wSequence == (pMACHeader->wSeqCtl >> 4)) &&
	227	(pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].wFragNum == (pMACHeader->wSeqCtl & 0x000F)) &&
	228	((pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].cbFrameLength + cbFrameLength - uHeaderSize) < 2346)) {
	229
	230	memcpy(pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].pbyRxBuffer, ((PBYTE) (pMACHeader) + uHeaderSize), (cbFrameLength - uHeaderSize));
	231	pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].cbFrameLength += (cbFrameLength - uHeaderSize);
	232	pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].pbyRxBuffer += (cbFrameLength - uHeaderSize);
	233	pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].wFragNum++;
	234	//DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Second pDevice->uCurrentDFCBIdx= %d\n", pDevice->uCurrentDFCBIdx);
	235	}
	236	else {
	237	// seq error or frag # error flush DFCB
	238	pDevice->cbFreeDFCB++;
	239	pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].bInUse = FALSE;
	240	return(FALSE);
	241	}
	242	}
	243	else {
	244	return(FALSE);
	245	}
	246	if (IS_LAST_FRAGMENT_PKT(pMACHeader)) {
	247	//enq defragcontrolblock
	248	pDevice->cbFreeDFCB++;
	249	pDevice->sRxDFCB[pDevice->uCurrentDFCBIdx].bInUse = FALSE;
	250	//DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "Last pDevice->uCurrentDFCBIdx= %d\n", pDevice->uCurrentDFCBIdx);
251	return(TRUE);
252	}
253	return(FALSE);
254	}
255	}
256
257