C++程序  |  445行  |  16.96 KB

/*
 * txXfer.c
 *
 * Copyright(c) 1998 - 2009 Texas Instruments. All rights reserved.      
 * All rights reserved.                                                  
 *                                                                       
 * Redistribution and use in source and binary forms, with or without    
 * modification, are permitted provided that the following conditions    
 * are met:                                                              
 *                                                                       
 *  * Redistributions of source code must retain the above copyright     
 *    notice, this list of conditions and the following disclaimer.      
 *  * Redistributions in binary form must reproduce the above copyright  
 *    notice, this list of conditions and the following disclaimer in    
 *    the documentation and/or other materials provided with the         
 *    distribution.                                                      
 *  * Neither the name Texas Instruments nor the names of its            
 *    contributors may be used to endorse or promote products derived    
 *    from this software without specific prior written permission.      
 *                                                                       
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS   
 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT     
 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 
 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT  
 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 
 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT      
 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT   
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 
 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */


/** \file   txXfer.c 
 *  \brief  Handle Tx packets transfer to the firmware. 
 *
 *  This module gets the upper driver's Tx packets after FW resources were
 *    allocated for them, aggregates them if possible, and handles their transfer 
 *    to the FW via the host slave (indirect) interface, using the TwIf Transaction API.
 *  The aggregation processing is completed by the BusDrv where the packets are combined
 *    and sent to the FW in one transaction.
 * 
 *  \see    
 */


#define __FILE_ID__  FILE_ID_108
#include "tidef.h"
#include "osApi.h"
#include "report.h"
#include "TwIf.h"
#include "TWDriver.h"
#include "txXfer_api.h"


#ifdef TI_DBG
#define     DBG_MAX_AGGREG_PKTS     16
#endif

typedef struct 
{
    TTxnStruct              tTxnStruct;
    TI_UINT32               uPktsCntr; 
} TPktsCntrTxn;

/* The TxXfer module object. */
typedef struct 
{
    TI_HANDLE               hOs;
    TI_HANDLE               hReport;
    TI_HANDLE               hTwIf;

    TI_UINT32               uAggregMaxPkts;          /* Max number of packets that may be aggregated */
    TI_UINT32               uAggregMaxLen;           /* Max length in bytes of a single aggregation */ 
    TI_UINT32               uAggregPktsNum;          /* Number of packets in current aggregation */
    TI_UINT32               uAggregPktsLen;          /* Aggregated length of current aggregation */ 
    TTxCtrlBlk *            pAggregFirstPkt;         /* Pointer to the first packet of current aggregation */
    TTxCtrlBlk *            pAggregLastPkt;          /* Pointer to the last packet of current aggregation */
    TSendPacketTranferCb    fSendPacketTransferCb;   /* Upper layer Xfer-Complete callback */
    TI_HANDLE               hSendPacketTransferHndl; /* Upper layer Xfer-Complete callback handle */
    TTxnDoneCb              fXferCompleteLocalCb;    /* TxXfer local CB for pkt transfer completion (NULL is not needed!) */
    TI_UINT32               uPktsCntr;               /* Counts all Tx packets. Written to FW after each packet transaction */
    TI_UINT32               uPktsCntrTxnIndex;       /* The current indext of the aPktsCntrTxn[] used for the counter workaround transactions */
    TPktsCntrTxn            aPktsCntrTxn[CTRL_BLK_ENTRIES_NUM]; /* Transaction structures for sending the packets counter */
#ifdef TI_DBG
    TI_UINT32               aDbgCountPktAggreg[DBG_MAX_AGGREG_PKTS];
#endif

} TTxXferObj;

static ETxnStatus txXfer_SendAggregatedPkts (TTxXferObj *pTxXfer, TI_BOOL bLastPktSentNow);
static void       txXfer_TransferDoneCb     (TI_HANDLE hTxXfer, TTxnStruct *pTxn);


/********************************************************************************
*																				*
*                       PUBLIC  FUNCTIONS  IMPLEMENTATION						*
*																				*
*********************************************************************************/


TI_HANDLE txXfer_Create(TI_HANDLE hOs)
{
    TTxXferObj *pTxXfer;

    pTxXfer = os_memoryAlloc (hOs, sizeof(TTxXferObj));
    if (pTxXfer == NULL)
    {
        return NULL;
    }

    os_memoryZero (hOs, pTxXfer, sizeof(TTxXferObj));

    pTxXfer->hOs = hOs;

    return (TI_HANDLE)pTxXfer;
}


TI_STATUS txXfer_Destroy(TI_HANDLE hTxXfer)
{
    TTxXferObj *pTxXfer = (TTxXferObj *)hTxXfer;

    if (pTxXfer)
    {
        os_memoryFree (pTxXfer->hOs, pTxXfer, sizeof(TTxXferObj));
    }

    return TI_OK;
}


TI_STATUS txXfer_Init (TI_HANDLE hTxXfer, TI_HANDLE hReport, TI_HANDLE hTwIf)
{
    TTxXferObj *pTxXfer = (TTxXferObj *)hTxXfer;
    TTxnStruct *pTxn;
    TI_UINT8    i;

    pTxXfer->hReport = hReport;
    pTxXfer->hTwIf   = hTwIf;
    pTxXfer->fSendPacketTransferCb = NULL;
    pTxXfer->fXferCompleteLocalCb  = NULL;

    for (i = 0; i < CTRL_BLK_ENTRIES_NUM; i++)
    {
        pTxn = &(pTxXfer->aPktsCntrTxn[i].tTxnStruct);
        TXN_PARAM_SET(pTxn, TXN_LOW_PRIORITY, TXN_FUNC_ID_WLAN, TXN_DIRECTION_WRITE, TXN_INC_ADDR)
        BUILD_TTxnStruct(pTxn, HOST_WR_ACCESS_REG, &pTxXfer->aPktsCntrTxn[i].uPktsCntr, REGISTER_SIZE, NULL, NULL)
    }

    return txXfer_Restart(hTxXfer);
}


TI_STATUS txXfer_Restart (TI_HANDLE hTxXfer)
{
    TTxXferObj *pTxXfer = (TTxXferObj *)hTxXfer;

    pTxXfer->uPktsCntr         = 0;
    pTxXfer->uPktsCntrTxnIndex = 0;
    pTxXfer->uAggregPktsNum    = 0;

    return TI_OK;
}


void txXfer_SetDefaults (TI_HANDLE hTxXfer, TTwdInitParams *pInitParams)
{
    TTxXferObj *pTxXfer = (TTxXferObj *)hTxXfer;

    pTxXfer->uAggregMaxPkts = pInitParams->tGeneral.uTxAggregPktsLimit;
}


void txXfer_SetBusParams (TI_HANDLE hTxXfer, TI_UINT32 uDmaBufLen)
{
    TTxXferObj *pTxXfer = (TTxXferObj *)hTxXfer;

    pTxXfer->uAggregMaxLen = uDmaBufLen;
}


void txXfer_RegisterCb (TI_HANDLE hTxXfer, TI_UINT32 CallBackID, void *CBFunc, TI_HANDLE CBObj)
{
    TTxXferObj* pTxXfer = (TTxXferObj*)hTxXfer;

    TRACE3(pTxXfer->hReport, REPORT_SEVERITY_INFORMATION, "txXfer_RegisterCb: CallBackID=%d, CBFunc=0x%x, CBObj=0x%x\n", CallBackID, CBFunc, CBObj);

    switch(CallBackID)
    {
        /* Save upper layers Transfer-Done callback */
        case TWD_INT_SEND_PACKET_TRANSFER:
            pTxXfer->fSendPacketTransferCb   = (TSendPacketTranferCb)CBFunc;
            pTxXfer->hSendPacketTransferHndl = CBObj;
            /* Set also the local CB so we are called upon Async transaction completion to call the upper CB */
            pTxXfer->fXferCompleteLocalCb = (TTxnDoneCb)txXfer_TransferDoneCb;
            break;

        default:
            TRACE0(pTxXfer->hReport, REPORT_SEVERITY_ERROR, " - Illegal value\n");
            break;
    }
}


ETxnStatus txXfer_SendPacket (TI_HANDLE hTxXfer, TTxCtrlBlk *pPktCtrlBlk)
{
    TTxXferObj   *pTxXfer = (TTxXferObj *)hTxXfer;
    TI_UINT32    uPktLen  = ENDIAN_HANDLE_WORD(pPktCtrlBlk->tTxDescriptor.length << 2); /* swap back for endianess if needed */
    ETxnStatus   eStatus; 

    /* If starting a new aggregation, prepare it, and send packet if aggregation is disabled. */
    if (pTxXfer->uAggregPktsNum == 0)
    {
        pTxXfer->uAggregPktsNum  = 1;
        pTxXfer->uAggregPktsLen  = uPktLen;
        pTxXfer->pAggregFirstPkt = pPktCtrlBlk;
        pTxXfer->pAggregLastPkt  = pPktCtrlBlk;
        pPktCtrlBlk->pNextAggregEntry = pPktCtrlBlk;  /* First packet points to itself */
        if (pTxXfer->uAggregMaxPkts <= 1)
        {
            eStatus = txXfer_SendAggregatedPkts (pTxXfer, TI_TRUE);
            pTxXfer->uAggregPktsNum = 0;
        }
        else 
        {
            eStatus = TXN_STATUS_PENDING;
        }
    }

    /* Else, if new packet can be added to aggregation, add it and set status as Pending. */
    else if ((pTxXfer->uAggregPktsNum + 1 <= pTxXfer->uAggregMaxPkts)  && 
             (pTxXfer->uAggregPktsLen + uPktLen <= pTxXfer->uAggregMaxLen))
    {
        pTxXfer->uAggregPktsNum++;
        pTxXfer->uAggregPktsLen += uPktLen;
        pTxXfer->pAggregLastPkt->pNextAggregEntry = pPktCtrlBlk;  /* Link new packet to last */
        pTxXfer->pAggregLastPkt = pPktCtrlBlk;                    /* Save new packet as last */
        pPktCtrlBlk->pNextAggregEntry = pTxXfer->pAggregFirstPkt; /* Point from last to first */
        eStatus = TXN_STATUS_PENDING;
    }

    /* Else, we can't add the new packet, so send current aggregation and start a new one */
    else 
    {
        txXfer_SendAggregatedPkts (pTxXfer, TI_FALSE);
        eStatus = TXN_STATUS_PENDING;  /* The current packet is not sent yet so return Pending */
        pTxXfer->uAggregPktsNum  = 1;
        pTxXfer->uAggregPktsLen  = uPktLen;
        pTxXfer->pAggregFirstPkt = pPktCtrlBlk;
        pTxXfer->pAggregLastPkt  = pPktCtrlBlk;
        pPktCtrlBlk->pNextAggregEntry = pPktCtrlBlk;  /* First packet points to itself */
    }


    /* Return the Txn result - COMPLETE or PENDING. */
    /* Note: For PENDING, a callback function will be called only if registered (needed for WHA) */
    return eStatus;
}


void txXfer_EndOfBurst (TI_HANDLE hTxXfer)
{
    TTxXferObj   *pTxXfer = (TTxXferObj *)hTxXfer;

    if (pTxXfer->uAggregPktsNum > 0) 
    {
        /* No more packets from TxDataQ so send any aggregated packets and clear aggregation */
        txXfer_SendAggregatedPkts (pTxXfer, TI_FALSE);
        pTxXfer->uAggregPktsNum = 0;
    }
}


/********************************************************************************
*																				*
*                       INTERNAL  FUNCTIONS  IMPLEMENTATION						*
*																				*
*********************************************************************************/

/** 
 * \fn     txXfer_SendAggregatedPkts
 * \brief  Send aggregated Tx packets to bus Txn layer
 * 
 * Send aggregated Tx packets to bus Txn layer one by one.
 * Increase the packets counter by the number of packets and send it to the FW (generates an interrupt).
 * If xfer completion CB is registered and status is Complete, call CB for all packets (except last one if inseted now).
 * 
 * \note   The BusDrv combines the packets and sends them in one transaction.
 * \param  pTxXfer         - The module's object
 * \param  bLastPktSentNow - If TRUE, last packet in the aggregation was inserted in current call to txXfer_SendPacket.
 * \return COMPLETE if transaction completed in this context, PENDING if not, ERROR if failed
 * \sa     
 */ 
static ETxnStatus txXfer_SendAggregatedPkts (TTxXferObj *pTxXfer, TI_BOOL bLastPktSentNow)
{
    TTxCtrlBlk   *pCurrPkt;
    TTxnStruct   *pTxn;
    TPktsCntrTxn *pPktsCntrTxn; 
    ETxnStatus   eStatus = TXN_STATUS_COMPLETE; 
    TI_UINT32    i;

    /* Prepare and send all aggregated packets (combined and sent in one transaction by the BusDrv) */
    pCurrPkt = pTxXfer->pAggregFirstPkt;
    for (i = 0; i < pTxXfer->uAggregPktsNum; i++)
    {
        pTxn = (TTxnStruct *)pCurrPkt;

        /* If not last packet, set aggregation flag, clear completion CB and progress to next packet */
        if (i < pTxXfer->uAggregPktsNum - 1)
        {
            TXN_PARAM_SET_AGGREGATE(pTxn, TXN_AGGREGATE_ON);
            pTxn->fTxnDoneCb = NULL;
            pCurrPkt = pCurrPkt->pNextAggregEntry;
        }
        /* If last packet, clear aggregation flag and set completion CB (exist only if registered) */
        else 
        {
            TXN_PARAM_SET_AGGREGATE(pTxn, TXN_AGGREGATE_OFF);
            pTxn->fTxnDoneCb = pTxXfer->fXferCompleteLocalCb;
            pTxn->hCbHandle  = (TI_HANDLE)pTxXfer;
        }

        /* Send packet */
        pTxn->uHwAddr = SLV_MEM_DATA;
        eStatus = twIf_Transact (pTxXfer->hTwIf, pTxn);
    }

#ifdef TI_DBG
    pTxXfer->aDbgCountPktAggreg[pTxXfer->uAggregPktsNum]++;
    TRACE5(pTxXfer->hReport, REPORT_SEVERITY_INFORMATION, "txXfer_SendAggregatedPkts: Status=%d, NumPkts=%d, AggregLen=%d, pFirstPkt=0x%x, pLastPkt=0x%x\n", eStatus, pTxXfer->uAggregPktsNum, pTxXfer->uAggregPktsLen, pTxXfer->pAggregFirstPkt, pTxXfer->pAggregLastPkt);
    if (eStatus == TXN_STATUS_ERROR)
    {
        TRACE5(pTxXfer->hReport, REPORT_SEVERITY_ERROR, "txXfer_SendAggregatedPkts: Status=%d, NumPkts=%d, AggregLen=%d, pFirstPkt=0x%x, pLastPkt=0x%x\n", eStatus, pTxXfer->uAggregPktsNum, pTxXfer->uAggregPktsLen, pTxXfer->pAggregFirstPkt, pTxXfer->pAggregLastPkt);
        return eStatus;
    }
#endif  /* TI_DBG */

    /* Write packet counter to FW (generates an interrupt). 
       Note: This may be removed once the host-slave HW counter functionality is verified */
    pTxXfer->uPktsCntr += pTxXfer->uAggregPktsNum;
    pTxXfer->uPktsCntrTxnIndex++;
    if (pTxXfer->uPktsCntrTxnIndex == CTRL_BLK_ENTRIES_NUM) 
    {
        pTxXfer->uPktsCntrTxnIndex = 0;
    }
    pPktsCntrTxn = &(pTxXfer->aPktsCntrTxn[pTxXfer->uPktsCntrTxnIndex]);
    pPktsCntrTxn->uPktsCntr = ENDIAN_HANDLE_LONG(pTxXfer->uPktsCntr);
    pPktsCntrTxn->tTxnStruct.uHwAddr = HOST_WR_ACCESS_REG;
    twIf_Transact(pTxXfer->hTwIf, &pPktsCntrTxn->tTxnStruct);

    /* If xfer completion CB is registered and last packet status is Complete, call the CB for all 
     *     packets except the input one (covered by the return code). 
     */
    if (pTxXfer->fSendPacketTransferCb && (eStatus == TXN_STATUS_COMPLETE)) 
    {
        /* Don't call CB for last packet if inserted in current Tx */
        TI_UINT32 uNumCbCalls = bLastPktSentNow ? (pTxXfer->uAggregPktsNum - 1) : pTxXfer->uAggregPktsNum;

        pCurrPkt = pTxXfer->pAggregFirstPkt;
        for (i = 0; i < uNumCbCalls; i++)
        {
            pTxXfer->fSendPacketTransferCb (pTxXfer->hSendPacketTransferHndl, pCurrPkt);
            pCurrPkt = pCurrPkt->pNextAggregEntry;
        }
    }

    /* Return the Txn result - COMPLETE or PENDING. */
    /* Note: For PENDING, a callback function will be called only if registered (needed for WHA) */
    return eStatus;
}


/** 
 * \fn     txXfer_TransferDoneCb
 * \brief  Send aggregated Tx packets to bus Txn layer
 * 
 * Call the upper layers TranferDone CB for all packets of the completed aggregation
 * This function is called only if the upper layers registered their CB (used only by WHA)
 * 
 * \note   
 * \param  pTxXfer - The module's object
 * \return COMPLETE if completed in this context, PENDING if not, ERROR if failed
 * \sa     
 */ 
static void txXfer_TransferDoneCb (TI_HANDLE hTxXfer, TTxnStruct *pTxn)
{
    TTxXferObj *pTxXfer   = (TTxXferObj*)hTxXfer;
    TTxCtrlBlk *pInputPkt = (TTxCtrlBlk *)pTxn; /* This is the last packet of the aggregation */
    TTxCtrlBlk *pCurrPkt;
    TI_UINT32   i;

    /* Call the upper layers TranferDone CB for all packets of the completed aggregation */
    /* Note: If this CB was called it means that the upper CB exists */
    pCurrPkt = pInputPkt->pNextAggregEntry;  /* The last packet of the aggregation point to the first one */
    for (i = 0; i < pTxXfer->uAggregMaxPkts; i++)
    {
        pTxXfer->fSendPacketTransferCb (pTxXfer->hSendPacketTransferHndl, pCurrPkt);

        /* If we got back to the input packet we went over all the aggregation */
        if (pCurrPkt == pInputPkt)
        {
            break;   
        }

        pCurrPkt = pCurrPkt->pNextAggregEntry;
    }

    TRACE3(pTxXfer->hReport, REPORT_SEVERITY_INFORMATION, "txXfer_TransferDoneCb: NumPkts=%d, pInputPkt=0x%x, pCurrPkt=0x%x\n", i + 1, pInputPkt, pCurrPkt);
}


#ifdef TI_DBG

void txXfer_ClearStats (TI_HANDLE hTxXfer)
{
    TTxXferObj *pTxXfer = (TTxXferObj*)hTxXfer;

    os_memoryZero (pTxXfer->hOs, &pTxXfer->aDbgCountPktAggreg, sizeof(pTxXfer->aDbgCountPktAggreg));
}

void txXfer_PrintStats (TI_HANDLE hTxXfer)
{
#ifdef REPORT_LOG
    TTxXferObj *pTxXfer = (TTxXferObj*)hTxXfer;
    TI_UINT32   i;
    
    WLAN_OS_REPORT(("Print Tx Xfer module info\n"));
    WLAN_OS_REPORT(("=========================\n"));
    WLAN_OS_REPORT(("uAggregMaxPkts     = %d\n", pTxXfer->uAggregMaxPkts));
    WLAN_OS_REPORT(("uAggregMaxLen      = %d\n", pTxXfer->uAggregMaxLen));
    WLAN_OS_REPORT(("uAggregPktsNum     = %d\n", pTxXfer->uAggregPktsNum));
    WLAN_OS_REPORT(("uAggregPktsLen     = %d\n", pTxXfer->uAggregPktsLen));
    WLAN_OS_REPORT(("uPktsCntr          = %d\n", pTxXfer->uPktsCntr));
    WLAN_OS_REPORT(("uPktsCntrTxnIndex  = %d\n", pTxXfer->uPktsCntrTxnIndex));
    for (i = 1; i < DBG_MAX_AGGREG_PKTS; i++)
    {
        WLAN_OS_REPORT(("uCountPktAggreg-%2d = %d\n", i, pTxXfer->aDbgCountPktAggreg[i]));
    }
#endif
}

#endif /* TI_DBG */