mds.c

Go to the documentation of this file.

#include "mds_f.h"
#include "mto.h"
#include "wbhal.h"
#include "wb35tx_f.h"

unsigned char
Mds_initial(struct wbsoft_priv *adapter)
{
    struct wb35_mds *pMds = &adapter->Mds;

    pMds->TxPause = false;
    pMds->TxRTSThreshold = DEFAULT_RTSThreshold;
    pMds->TxFragmentThreshold = DEFAULT_FRAGMENT_THRESHOLD;

    return hal_get_tx_buffer(&adapter->sHwData, &pMds->pTxBuffer);
}

static void Mds_DurationSet(struct wbsoft_priv *adapter,  struct wb35_descriptor *pDes,  u8 *buffer)
{
    struct T00_descriptor *pT00;
    struct T01_descriptor *pT01;
    u16 Duration, NextBodyLen, OffsetSize;
    u8  Rate, i;
    unsigned char   CTS_on = false, RTS_on = false;
    struct T00_descriptor *pNextT00;
    u16 BodyLen = 0;
    unsigned char boGroupAddr = false;

    OffsetSize = pDes->FragmentThreshold + 32 + 3;
    OffsetSize &= ~0x03;
    Rate = pDes->TxRate >> 1;
    if (!Rate)
        Rate = 1;

    pT00 = (struct T00_descriptor *)buffer;
    pT01 = (struct T01_descriptor *)(buffer+4);
    pNextT00 = (struct T00_descriptor *)(buffer+OffsetSize);

    if (buffer[DOT_11_DA_OFFSET+8] & 0x1) /* +8 for USB hdr */
        boGroupAddr = true;

    /******************************************
     * Set RTS/CTS mechanism
     ******************************************/
    if (!boGroupAddr) {
        /* NOTE : If the protection mode is enabled and the MSDU will be fragmented,
         *       the tx rates of MPDUs will all be DSSS rates. So it will not use
         *       CTS-to-self in this case. CTS-To-self will only be used when without
         *       fragmentation. -- 20050112 */
        BodyLen = (u16)pT00->T00_frame_length;  /* include 802.11 header */
        BodyLen += 4;   /* CRC */

        if (BodyLen >= CURRENT_RTS_THRESHOLD)
            RTS_on = true; /* Using RTS */
        else {
            if (pT01->T01_modulation_type) { /* Is using OFDM */
                if (CURRENT_PROTECT_MECHANISM) /* Is using protect */
                    CTS_on = true; /* Using CTS */
            }
        }
    }

    if (RTS_on || CTS_on) {
        if (pT01->T01_modulation_type) { /* Is using OFDM */
            /* CTS duration
             *  2 SIFS + DATA transmit time + 1 ACK
             *  ACK Rate : 24 Mega bps
             *  ACK frame length = 14 bytes */
            Duration = 2*DEFAULT_SIFSTIME +
                       2*PREAMBLE_PLUS_SIGNAL_PLUS_SIGNALEXTENSION +
                       ((BodyLen*8 + 22 + Rate*4 - 1)/(Rate*4))*Tsym +
                       ((112 + 22 + 95)/96)*Tsym;
        } else  { /* DSSS */
            /* CTS duration
             *  2 SIFS + DATA transmit time + 1 ACK
             *  Rate : ?? Mega bps
             *  ACK frame length = 14 bytes */
            if (pT01->T01_plcp_header_length) /* long preamble */
                Duration = LONG_PREAMBLE_PLUS_PLCPHEADER_TIME*2;
            else
                Duration = SHORT_PREAMBLE_PLUS_PLCPHEADER_TIME*2;

            Duration += (((BodyLen + 14)*8 + Rate-1) / Rate +
                        DEFAULT_SIFSTIME*2);
        }

        if (RTS_on) {
            if (pT01->T01_modulation_type) { /* Is using OFDM */
                /* CTS + 1 SIFS + CTS duration
                 * CTS Rate : 24 Mega bps
                 * CTS frame length = 14 bytes */
                Duration += (DEFAULT_SIFSTIME +
                                PREAMBLE_PLUS_SIGNAL_PLUS_SIGNALEXTENSION +
                                ((112 + 22 + 95)/96)*Tsym);
            } else {
                /* CTS + 1 SIFS + CTS duration
                 * CTS Rate : ?? Mega bps
                 * CTS frame length = 14 bytes */
                if (pT01->T01_plcp_header_length) /* long preamble */
                    Duration += LONG_PREAMBLE_PLUS_PLCPHEADER_TIME;
                else
                    Duration += SHORT_PREAMBLE_PLUS_PLCPHEADER_TIME;

                Duration += (((112 + Rate-1) / Rate) + DEFAULT_SIFSTIME);
            }
        }

        /* Set the value into USB descriptor */
        pT01->T01_add_rts = RTS_on ? 1 : 0;
        pT01->T01_add_cts = CTS_on ? 1 : 0;
        pT01->T01_rts_cts_duration = Duration;
    }

    /******************************************
     * Fill the more fragment descriptor
     ******************************************/
    if (boGroupAddr)
        Duration = 0;
    else {
        for (i = pDes->FragmentCount-1; i > 0; i--) {
            NextBodyLen = (u16)pNextT00->T00_frame_length;
            NextBodyLen += 4;   /* CRC */

            if (pT01->T01_modulation_type) {
                /* OFDM
                 *  data transmit time + 3 SIFS + 2 ACK
                 *  Rate : ??Mega bps
                 *  ACK frame length = 14 bytes, tx rate = 24M */
                Duration = PREAMBLE_PLUS_SIGNAL_PLUS_SIGNALEXTENSION * 3;
                Duration += (((NextBodyLen*8 + 22 + Rate*4 - 1)/(Rate*4)) * Tsym +
                            (((2*14)*8 + 22 + 95)/96)*Tsym +
                            DEFAULT_SIFSTIME*3);
            } else {
                /* DSSS
                 *  data transmit time + 2 ACK + 3 SIFS
                 *  Rate : ??Mega bps
                 *  ACK frame length = 14 bytes
                 * TODO : */
                if (pT01->T01_plcp_header_length) /* long preamble */
                    Duration = LONG_PREAMBLE_PLUS_PLCPHEADER_TIME*3;
                else
                    Duration = SHORT_PREAMBLE_PLUS_PLCPHEADER_TIME*3;

                Duration += (((NextBodyLen + (2*14))*8 + Rate-1) / Rate +
                            DEFAULT_SIFSTIME*3);
            }

            ((u16 *)buffer)[5] = cpu_to_le16(Duration); /* 4 USHOR for skip 8B USB, 2USHORT=FC + Duration */

            /* ----20061009 add by anson's endian */
            pNextT00->value = cpu_to_le32(pNextT00->value);
            pT01->value = cpu_to_le32(pT01->value);
            /* ----end 20061009 add by anson's endian */

            buffer += OffsetSize;
            pT01 = (struct T01_descriptor *)(buffer+4);
            if (i != 1) /* The last fragment will not have the next fragment */
                pNextT00 = (struct T00_descriptor *)(buffer+OffsetSize);
        }

        /*******************************************
         * Fill the last fragment descriptor
         *******************************************/
        if (pT01->T01_modulation_type) {
            /* OFDM
             *  1 SIFS + 1 ACK
             *  Rate : 24 Mega bps
             * ACK frame length = 14 bytes */
            Duration = PREAMBLE_PLUS_SIGNAL_PLUS_SIGNALEXTENSION;
            /* The Tx rate of ACK use 24M */
            Duration += (((112 + 22 + 95)/96)*Tsym + DEFAULT_SIFSTIME);
        } else {
            /* DSSS
             * 1 ACK + 1 SIFS
             * Rate : ?? Mega bps
             * ACK frame length = 14 bytes(112 bits) */
            if (pT01->T01_plcp_header_length) /* long preamble */
                Duration = LONG_PREAMBLE_PLUS_PLCPHEADER_TIME;
            else
                Duration = SHORT_PREAMBLE_PLUS_PLCPHEADER_TIME;

            Duration += ((112 + Rate-1)/Rate + DEFAULT_SIFSTIME);
        }
    }

    ((u16 *)buffer)[5] = cpu_to_le16(Duration); /* 4 USHOR for skip 8B USB, 2USHORT=FC + Duration */
    pT00->value = cpu_to_le32(pT00->value);
    pT01->value = cpu_to_le32(pT01->value);
    /* --end 20061009 add */

}

/* The function return the 4n size of usb pk */
static u16 Mds_BodyCopy(struct wbsoft_priv *adapter, struct wb35_descriptor *pDes, u8 *TargetBuffer)
{
    struct T00_descriptor *pT00;
    struct wb35_mds *pMds = &adapter->Mds;
    u8  *buffer;
    u8  *src_buffer;
    u8  *pctmp;
    u16 Size = 0;
    u16 SizeLeft, CopySize, CopyLeft, stmp;
    u8  buf_index, FragmentCount = 0;


    /* Copy fragment body */
    buffer = TargetBuffer; /* shift 8B usb + 24B 802.11 */
    SizeLeft = pDes->buffer_total_size;
    buf_index = pDes->buffer_start_index;

    pT00 = (struct T00_descriptor *)buffer;
    while (SizeLeft) {
        pT00 = (struct T00_descriptor *)buffer;
        CopySize = SizeLeft;
        if (SizeLeft > pDes->FragmentThreshold) {
            CopySize = pDes->FragmentThreshold;
            pT00->T00_frame_length = 24 + CopySize; /* Set USB length */
        } else
            pT00->T00_frame_length = 24 + SizeLeft; /* Set USB length */

        SizeLeft -= CopySize;

        /* 1 Byte operation */
        pctmp = (u8 *)(buffer + 8 + DOT_11_SEQUENCE_OFFSET);
        *pctmp &= 0xf0;
        *pctmp |= FragmentCount; /* 931130.5.m */
        if (!FragmentCount)
            pT00->T00_first_mpdu = 1;

        buffer += 32; /* 8B usb + 24B 802.11 header */
        Size += 32;

        /* Copy into buffer */
        stmp = CopySize + 3;
        stmp &= ~0x03; /* 4n Alignment */
        Size += stmp; /* Current 4n offset of mpdu */

        while (CopySize) {
            /* Copy body */
            src_buffer = pDes->buffer_address[buf_index];
            CopyLeft = CopySize;
            if (CopySize >= pDes->buffer_size[buf_index]) {
                CopyLeft = pDes->buffer_size[buf_index];

                /* Get the next buffer of descriptor */
                buf_index++;
                buf_index %= MAX_DESCRIPTOR_BUFFER_INDEX;
            } else {
                u8  *pctmp = pDes->buffer_address[buf_index];
                pctmp += CopySize;
                pDes->buffer_address[buf_index] = pctmp;
                pDes->buffer_size[buf_index] -= CopySize;
            }

            memcpy(buffer, src_buffer, CopyLeft);
            buffer += CopyLeft;
            CopySize -= CopyLeft;
        }

        /* 931130.5.n */
        if (pMds->MicAdd) {
            if (!SizeLeft) {
                pMds->MicWriteAddress[pMds->MicWriteIndex] = buffer - pMds->MicAdd;
                pMds->MicWriteSize[pMds->MicWriteIndex] = pMds->MicAdd;
                pMds->MicAdd = 0;
            } else if (SizeLeft < 8) { /* 931130.5.p */
                pMds->MicAdd = SizeLeft;
                pMds->MicWriteAddress[pMds->MicWriteIndex] = buffer - (8 - SizeLeft);
                pMds->MicWriteSize[pMds->MicWriteIndex] = 8 - SizeLeft;
                pMds->MicWriteIndex++;
            }
        }

        /* Does it need to generate the new header for next mpdu? */
        if (SizeLeft) {
            buffer = TargetBuffer + Size; /* Get the next 4n start address */
            memcpy(buffer, TargetBuffer, 32); /* Copy 8B USB +24B 802.11 */
            pT00 = (struct T00_descriptor *)buffer;
            pT00->T00_first_mpdu = 0;
        }

        FragmentCount++;
    }

    pT00->T00_last_mpdu = 1;
    pT00->T00_IsLastMpdu = 1;
    buffer = (u8 *)pT00 + 8; /* +8 for USB hdr */
    buffer[1] &= ~0x04; /* Clear more frag bit of 802.11 frame control */
    pDes->FragmentCount = FragmentCount; /* Update the correct fragment number */
    return Size;
}

static void Mds_HeaderCopy(struct wbsoft_priv *adapter, struct wb35_descriptor *pDes, u8 *TargetBuffer)
{
    struct wb35_mds *pMds = &adapter->Mds;
    u8  *src_buffer = pDes->buffer_address[0]; /* 931130.5.g */
    struct T00_descriptor *pT00;
    struct T01_descriptor *pT01;
    u16 stmp;
    u8  i, ctmp1, ctmp2, ctmpf;
    u16 FragmentThreshold = CURRENT_FRAGMENT_THRESHOLD;


    stmp = pDes->buffer_total_size;
    /*
     * Set USB header 8 byte
     */
    pT00 = (struct T00_descriptor *)TargetBuffer;
    TargetBuffer += 4;
    pT01 = (struct T01_descriptor *)TargetBuffer;
    TargetBuffer += 4;

    pT00->value = 0; /* Clear */
    pT01->value = 0; /* Clear */

    pT00->T00_tx_packet_id = pDes->Descriptor_ID; /* Set packet ID */
    pT00->T00_header_length = 24; /* Set header length */
    pT01->T01_retry_abort_ebable = 1; /* 921013 931130.5.h */

    /* Key ID setup */
    pT01->T01_wep_id = 0;

    FragmentThreshold = DEFAULT_FRAGMENT_THRESHOLD; /* Do not fragment */
    /* Copy full data, the 1'st buffer contain all the data 931130.5.j */
    memcpy(TargetBuffer, src_buffer, DOT_11_MAC_HEADER_SIZE); /* Copy header */
    pDes->buffer_address[0] = src_buffer + DOT_11_MAC_HEADER_SIZE;
    pDes->buffer_total_size -= DOT_11_MAC_HEADER_SIZE;
    pDes->buffer_size[0] = pDes->buffer_total_size;

    /* Set fragment threshold */
    FragmentThreshold -= (DOT_11_MAC_HEADER_SIZE + 4);
    pDes->FragmentThreshold = FragmentThreshold;

    /* Set more frag bit */
    TargetBuffer[1] |= 0x04; /* Set more frag bit */

    /*
     * Set tx rate
     */
    stmp = *(u16 *)(TargetBuffer+30); /* 2n alignment address */

    /* Use basic rate */
    ctmp1 = ctmpf = CURRENT_TX_RATE_FOR_MNG;

    pDes->TxRate = ctmp1;
    pr_debug("Tx rate =%x\n", ctmp1);

    pT01->T01_modulation_type = (ctmp1%3) ? 0 : 1;

    for (i = 0; i < 2; i++) {
        if (i == 1)
            ctmp1 = ctmpf;

        pMds->TxRate[pDes->Descriptor_ID][i] = ctmp1; /* backup the ta rate and fall back rate */

        if (ctmp1 == 108)
            ctmp2 = 7;
        else if (ctmp1 == 96)
            ctmp2 = 6; /* Rate convert for USB */
        else if (ctmp1 == 72)
            ctmp2 = 5;
        else if (ctmp1 == 48)
            ctmp2 = 4;
        else if (ctmp1 == 36)
            ctmp2 = 3;
        else if (ctmp1 == 24)
            ctmp2 = 2;
        else if (ctmp1 == 18)
            ctmp2 = 1;
        else if (ctmp1 == 12)
            ctmp2 = 0;
        else if (ctmp1 == 22)
            ctmp2 = 3;
        else if (ctmp1 == 11)
            ctmp2 = 2;
        else if (ctmp1 == 4)
            ctmp2 = 1;
        else
            ctmp2 = 0; /* if( ctmp1 == 2  ) or default */

        if (i == 0)
            pT01->T01_transmit_rate = ctmp2;
        else
            pT01->T01_fall_back_rate = ctmp2;
    }

    /*
     * Set preamble type
     */
    if ((pT01->T01_modulation_type == 0) && (pT01->T01_transmit_rate == 0)) /* RATE_1M */
        pDes->PreambleMode =  WLAN_PREAMBLE_TYPE_LONG;
    else
        pDes->PreambleMode =  CURRENT_PREAMBLE_MODE;
    pT01->T01_plcp_header_length = pDes->PreambleMode;  /* Set preamble */

}

static void MLME_GetNextPacket(struct wbsoft_priv *adapter, struct wb35_descriptor *desc)
{
    desc->InternalUsed = desc->buffer_start_index + desc->buffer_number;
    desc->InternalUsed %= MAX_DESCRIPTOR_BUFFER_INDEX;
    desc->buffer_address[desc->InternalUsed] = adapter->sMlmeFrame.pMMPDU;
    desc->buffer_size[desc->InternalUsed] = adapter->sMlmeFrame.len;
    desc->buffer_total_size += adapter->sMlmeFrame.len;
    desc->buffer_number++;
    desc->Type = adapter->sMlmeFrame.DataType;
}

static void MLMEfreeMMPDUBuffer(struct wbsoft_priv *adapter, s8 *pData)
{
    int i;

    /* Reclaim the data buffer */
    for (i = 0; i < MAX_NUM_TX_MMPDU; i++) {
        if (pData == (s8 *)&(adapter->sMlmeFrame.TxMMPDU[i]))
            break;
    }
    if (adapter->sMlmeFrame.TxMMPDUInUse[i])
        adapter->sMlmeFrame.TxMMPDUInUse[i] = false;
    else  {
        /* Something wrong
         PD43 Add debug code here??? */
    }
}

static void MLME_SendComplete(struct wbsoft_priv *adapter, u8 PacketID, unsigned char SendOK)
{
    /* Reclaim the data buffer */
    adapter->sMlmeFrame.len = 0;
    MLMEfreeMMPDUBuffer(adapter, adapter->sMlmeFrame.pMMPDU);

    /* Return resource */
    adapter->sMlmeFrame.IsInUsed = PACKET_FREE_TO_USE;
}

void
Mds_Tx(struct wbsoft_priv *adapter)
{
    struct hw_data *pHwData = &adapter->sHwData;
    struct wb35_mds *pMds = &adapter->Mds;
    struct wb35_descriptor  TxDes;
    struct wb35_descriptor *pTxDes = &TxDes;
    u8      *XmitBufAddress;
    u16     XmitBufSize, PacketSize, stmp, CurrentSize, FragmentThreshold;
    u8      FillIndex, TxDesIndex, FragmentCount, FillCount;
    unsigned char   BufferFilled = false;


    if (pMds->TxPause)
        return;
    if (!hal_driver_init_OK(pHwData))
        return;

    /* Only one thread can be run here */
    if (atomic_inc_return(&pMds->TxThreadCount) != 1)
        goto cleanup;

    /* Start to fill the data */
    do {
        FillIndex = pMds->TxFillIndex;
        if (pMds->TxOwner[FillIndex]) { /* Is owned by software 0:Yes 1:No */
            pr_debug("[Mds_Tx] Tx Owner is H/W.\n");
            break;
        }

        XmitBufAddress = pMds->pTxBuffer + (MAX_USB_TX_BUFFER * FillIndex); /* Get buffer */
        XmitBufSize = 0;
        FillCount = 0;
        do {
            PacketSize = adapter->sMlmeFrame.len;
            if (!PacketSize)
                break;

            /* For Check the buffer resource */
            FragmentThreshold = CURRENT_FRAGMENT_THRESHOLD;
            /* 931130.5.b */
            FragmentCount = PacketSize/FragmentThreshold + 1;
            stmp = PacketSize + FragmentCount*32 + 8; /* 931130.5.c 8:MIC */
            if ((XmitBufSize + stmp) >= MAX_USB_TX_BUFFER) {
                printk("[Mds_Tx] Excess max tx buffer.\n");
                break; /* buffer is not enough */
            }


            /*
             * Start transmitting
             */
            BufferFilled = true;

            /* Leaves first u8 intact */
            memset((u8 *)pTxDes + 1, 0, sizeof(struct wb35_descriptor) - 1);

            TxDesIndex = pMds->TxDesIndex; /* Get the current ID */
            pTxDes->Descriptor_ID = TxDesIndex;
            pMds->TxDesFrom[TxDesIndex] = 2; /* Storing the information of source coming from */
            pMds->TxDesIndex++;
            pMds->TxDesIndex %= MAX_USB_TX_DESCRIPTOR;

            MLME_GetNextPacket(adapter, pTxDes);

            /* Copy header. 8byte USB + 24byte 802.11Hdr. Set TxRate, Preamble type */
            Mds_HeaderCopy(adapter, pTxDes, XmitBufAddress);

            /* For speed up Key setting */
            if (pTxDes->EapFix) {
                pr_debug("35: EPA 4th frame detected. Size = %d\n", PacketSize);
                pHwData->IsKeyPreSet = 1;
            }

            /* Copy (fragment) frame body, and set USB, 802.11 hdr flag */
            CurrentSize = Mds_BodyCopy(adapter, pTxDes, XmitBufAddress);

            /* Set RTS/CTS and Normal duration field into buffer */
            Mds_DurationSet(adapter, pTxDes, XmitBufAddress);

            /* Shift to the next address */
            XmitBufSize += CurrentSize;
            XmitBufAddress += CurrentSize;

            /* Get packet to transmit completed, 1:TESTSTA 2:MLME 3: Ndis data */
            MLME_SendComplete(adapter, 0, true);

            /* Software TSC count 20060214 */
            pMds->TxTsc++;
            if (pMds->TxTsc == 0)
                pMds->TxTsc_2++;

            FillCount++; /* 20060928 */
        } while (HAL_USB_MODE_BURST(pHwData)); /* End of multiple MSDU copy loop. false = single true = multiple sending  */

        /* Move to the next one, if necessary */
        if (BufferFilled) {
            /* size setting */
            pMds->TxBufferSize[FillIndex] = XmitBufSize;

            /* 20060928 set Tx count */
            pMds->TxCountInBuffer[FillIndex] = FillCount;

            /* Set owner flag */
            pMds->TxOwner[FillIndex] = 1;

            pMds->TxFillIndex++;
            pMds->TxFillIndex %= MAX_USB_TX_BUFFER_NUMBER;
            BufferFilled = false;
        } else
            break;

        if (!PacketSize) /* No more pk for transmitting */
            break;

    } while (true);

    /*
     * Start to send by lower module
     */
    if (!pHwData->IsKeyPreSet)
        Wb35Tx_start(adapter);

cleanup:
        atomic_dec(&pMds->TxThreadCount);
}

void
Mds_SendComplete(struct wbsoft_priv *adapter, struct T02_descriptor *pT02)
{
    struct wb35_mds *pMds = &adapter->Mds;
    struct hw_data *pHwData = &adapter->sHwData;
    u8  PacketId = (u8)pT02->T02_Tx_PktID;
    unsigned char   SendOK = true;
    u8  RetryCount, TxRate;

    if (pT02->T02_IgnoreResult) /* Don't care about the result */
        return;
    if (pT02->T02_IsLastMpdu) {
        /* TODO: DTO -- get the retry count and fragment count */
        /* Tx rate */
        TxRate = pMds->TxRate[PacketId][0];
        RetryCount = (u8)pT02->T02_MPDU_Cnt;
        if (pT02->value & FLAG_ERROR_TX_MASK) {
            SendOK = false;

            if (pT02->T02_transmit_abort || pT02->T02_out_of_MaxTxMSDULiftTime) {
                /* retry error */
                pHwData->dto_tx_retry_count += (RetryCount+1);
                /* [for tx debug] */
                if (RetryCount < 7)
                    pHwData->tx_retry_count[RetryCount] += RetryCount;
                else
                    pHwData->tx_retry_count[7] += RetryCount;
                pr_debug("dto_tx_retry_count =%d\n", pHwData->dto_tx_retry_count);
                MTO_SetTxCount(adapter, TxRate, RetryCount);
            }
            pHwData->dto_tx_frag_count += (RetryCount+1);

            /* [for tx debug] */
            if (pT02->T02_transmit_abort_due_to_TBTT)
                pHwData->tx_TBTT_start_count++;
            if (pT02->T02_transmit_without_encryption_due_to_wep_on_false)
                pHwData->tx_WepOn_false_count++;
            if (pT02->T02_discard_due_to_null_wep_key)
                pHwData->tx_Null_key_count++;
        } else {
            if (pT02->T02_effective_transmission_rate)
                pHwData->tx_ETR_count++;
            MTO_SetTxCount(adapter, TxRate, RetryCount);
        }

        /* Clear send result buffer */
        pMds->TxResult[PacketId] = 0;
    } else
        pMds->TxResult[PacketId] |= ((u16)(pT02->value & 0x0ffff));
}