LXR linux/drivers/staging/vt6656/mib.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: mib.c
  20 *
  21 * Purpose: Implement MIB Data Structure
  22 *
  23 * Author: Tevin Chen
  24 *
  25 * Date: May 21, 1996
  26 *
  27 * Functions:
  28 *      STAvUpdateIstStatCounter - Update ISR statistic counter
  29 *      STAvUpdateRDStatCounter - Update Rx statistic counter
  30 *      STAvUpdateTDStatCounter - Update Tx statistic counter
  31 *      STAvUpdateTDStatCounterEx - Update Tx statistic counter and copy tx data
  32 *      STAvUpdate802_11Counter - Update 802.11 mib counter
  33 *
  34 * Revision History:
  35 *
  36 */
  37
  38#include "mac.h"
  39#include "tether.h"
  40#include "mib.h"
  41#include "wctl.h"
  42#include "baseband.h"
  43
  44static int          msglevel                =MSG_LEVEL_INFO;
  45
  46/*
  47 * Description: Update Isr Statistic Counter
  48 *
  49 * Parameters:
  50 *  In:
  51 *      pStatistic  - Pointer to Statistic Counter Data Structure
  52 *      wisr        - Interrupt status
  53 *  Out:
  54 *      none
  55 *
  56 * Return Value: none
  57 *
  58 */
  59void STAvUpdateIsrStatCounter (PSStatCounter pStatistic, u8 byIsr0, u8 byIsr1)
  60{
  61    /**********************/
  62    /* ABNORMAL interrupt */
  63    /**********************/
  64    // not any IMR bit invoke irq
  65    if (byIsr0 == 0) {
  66        pStatistic->ISRStat.dwIsrUnknown++;
  67        return;
  68    }
  69
  70    if (byIsr0 & ISR_ACTX)              // ISR, bit0
  71        pStatistic->ISRStat.dwIsrTx0OK++;           // TXDMA0 successful
  72
  73    if (byIsr0 & ISR_BNTX)              // ISR, bit2
  74        pStatistic->ISRStat.dwIsrBeaconTxOK++;      // BeaconTx successful
  75
  76    if (byIsr0 & ISR_RXDMA0)            // ISR, bit3
  77        pStatistic->ISRStat.dwIsrRx0OK++;           // Rx0 successful
  78
  79    if (byIsr0 & ISR_TBTT)              // ISR, bit4
  80        pStatistic->ISRStat.dwIsrTBTTInt++;         // TBTT successful
  81
  82    if (byIsr0 & ISR_SOFTTIMER)         // ISR, bit6
  83        pStatistic->ISRStat.dwIsrSTIMERInt++;
  84
  85    if (byIsr0 & ISR_WATCHDOG)          // ISR, bit7
  86        pStatistic->ISRStat.dwIsrWatchDog++;
  87
  88    if (byIsr1 & ISR_FETALERR)              // ISR, bit8
  89        pStatistic->ISRStat.dwIsrUnrecoverableError++;
  90
  91    if (byIsr1 & ISR_SOFTINT)               // ISR, bit9
  92        pStatistic->ISRStat.dwIsrSoftInterrupt++;       // software interrupt
  93
  94    if (byIsr1 & ISR_MIBNEARFULL)           // ISR, bit10
  95        pStatistic->ISRStat.dwIsrMIBNearfull++;
  96
  97    if (byIsr1 & ISR_RXNOBUF)               // ISR, bit11
  98        pStatistic->ISRStat.dwIsrRxNoBuf++;             // Rx No Buff
  99
 100}
 101
 102/*
 103 * Description: Update Rx Statistic Counter
 104 *
 105 * Parameters:
 106 *  In:
 107 *      pStatistic      - Pointer to Statistic Counter Data Structure
 108 *      byRSR           - Rx Status
 109 *      byNewRSR        - Rx Status
 110 *      pbyBuffer       - Rx Buffer
 111 *      cbFrameLength   - Rx Length
 112 *  Out:
 113 *      none
 114 *
 115 * Return Value: none
 116 *
 117 */
 118void STAvUpdateRDStatCounter(PSStatCounter pStatistic,
 119                             u8 byRSR, u8 byNewRSR,
 120                             u8 byRxSts, u8 byRxRate,
 121                             u8 * pbyBuffer, unsigned int cbFrameLength)
 122{
 123        /* need change */
 124        struct ieee80211_hdr *pHeader = (struct ieee80211_hdr *)pbyBuffer;
 125
 126        if (byRSR & RSR_ADDROK)
 127                pStatistic->dwRsrADDROk++;
 128        if (byRSR & RSR_CRCOK) {
 129                pStatistic->dwRsrCRCOk++;
 130                pStatistic->ullRsrOK++;
 131
 132                if (cbFrameLength >= ETH_ALEN) {
 133                        /* update counters in case of successful transmission */
 134            if (byRSR & RSR_ADDRBROAD) {
 135                pStatistic->ullRxBroadcastFrames++;
 136                pStatistic->ullRxBroadcastBytes +=
 137                  (unsigned long long) cbFrameLength;
 138            }
 139            else if (byRSR & RSR_ADDRMULTI) {
 140                pStatistic->ullRxMulticastFrames++;
 141                pStatistic->ullRxMulticastBytes +=
 142                  (unsigned long long) cbFrameLength;
 143            }
 144            else {
 145                pStatistic->ullRxDirectedFrames++;
 146                pStatistic->ullRxDirectedBytes +=
 147                  (unsigned long long) cbFrameLength;
 148            }
 149        }
 150    }
 151
 152    if(byRxRate==22) {
 153        pStatistic->CustomStat.ullRsr11M++;
 154        if(byRSR & RSR_CRCOK) {
 155            pStatistic->CustomStat.ullRsr11MCRCOk++;
 156        }
 157        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "11M: ALL[%d], OK[%d]:[%02x]\n",
 158                (signed int) pStatistic->CustomStat.ullRsr11M,
 159                (signed int) pStatistic->CustomStat.ullRsr11MCRCOk, byRSR);
 160    }
 161    else if(byRxRate==11) {
 162        pStatistic->CustomStat.ullRsr5M++;
 163        if(byRSR & RSR_CRCOK) {
 164            pStatistic->CustomStat.ullRsr5MCRCOk++;
 165        }
 166        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " 5M: ALL[%d], OK[%d]:[%02x]\n",
 167                (signed int) pStatistic->CustomStat.ullRsr5M,
 168                (signed int) pStatistic->CustomStat.ullRsr5MCRCOk, byRSR);
 169    }
 170    else if(byRxRate==4) {
 171        pStatistic->CustomStat.ullRsr2M++;
 172        if(byRSR & RSR_CRCOK) {
 173            pStatistic->CustomStat.ullRsr2MCRCOk++;
 174        }
 175        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " 2M: ALL[%d], OK[%d]:[%02x]\n",
 176                (signed int) pStatistic->CustomStat.ullRsr2M,
 177                (signed int) pStatistic->CustomStat.ullRsr2MCRCOk, byRSR);
 178    }
 179    else if(byRxRate==2){
 180        pStatistic->CustomStat.ullRsr1M++;
 181        if(byRSR & RSR_CRCOK) {
 182            pStatistic->CustomStat.ullRsr1MCRCOk++;
 183        }
 184        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " 1M: ALL[%d], OK[%d]:[%02x]\n",
 185                (signed int) pStatistic->CustomStat.ullRsr1M,
 186                (signed int) pStatistic->CustomStat.ullRsr1MCRCOk, byRSR);
 187    }
 188    else if(byRxRate==12){
 189        pStatistic->CustomStat.ullRsr6M++;
 190        if(byRSR & RSR_CRCOK) {
 191            pStatistic->CustomStat.ullRsr6MCRCOk++;
 192        }
 193        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " 6M: ALL[%d], OK[%d]\n",
 194                (signed int) pStatistic->CustomStat.ullRsr6M,
 195                (signed int) pStatistic->CustomStat.ullRsr6MCRCOk);
 196    }
 197    else if(byRxRate==18){
 198        pStatistic->CustomStat.ullRsr9M++;
 199        if(byRSR & RSR_CRCOK) {
 200            pStatistic->CustomStat.ullRsr9MCRCOk++;
 201        }
 202        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO " 9M: ALL[%d], OK[%d]\n",
 203                (signed int) pStatistic->CustomStat.ullRsr9M,
 204                (signed int) pStatistic->CustomStat.ullRsr9MCRCOk);
 205    }
 206    else if(byRxRate==24){
 207        pStatistic->CustomStat.ullRsr12M++;
 208        if(byRSR & RSR_CRCOK) {
 209            pStatistic->CustomStat.ullRsr12MCRCOk++;
 210        }
 211        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "12M: ALL[%d], OK[%d]\n",
 212                (signed int) pStatistic->CustomStat.ullRsr12M,
 213                (signed int) pStatistic->CustomStat.ullRsr12MCRCOk);
 214    }
 215    else if(byRxRate==36){
 216        pStatistic->CustomStat.ullRsr18M++;
 217        if(byRSR & RSR_CRCOK) {
 218            pStatistic->CustomStat.ullRsr18MCRCOk++;
 219        }
 220        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "18M: ALL[%d], OK[%d]\n",
 221                (signed int) pStatistic->CustomStat.ullRsr18M,
 222                (signed int) pStatistic->CustomStat.ullRsr18MCRCOk);
 223    }
 224    else if(byRxRate==48){
 225        pStatistic->CustomStat.ullRsr24M++;
 226        if(byRSR & RSR_CRCOK) {
 227            pStatistic->CustomStat.ullRsr24MCRCOk++;
 228        }
 229        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "24M: ALL[%d], OK[%d]\n",
 230                (signed int) pStatistic->CustomStat.ullRsr24M,
 231                (signed int) pStatistic->CustomStat.ullRsr24MCRCOk);
 232    }
 233    else if(byRxRate==72){
 234        pStatistic->CustomStat.ullRsr36M++;
 235        if(byRSR & RSR_CRCOK) {
 236            pStatistic->CustomStat.ullRsr36MCRCOk++;
 237        }
 238        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "36M: ALL[%d], OK[%d]\n",
 239                (signed int) pStatistic->CustomStat.ullRsr36M,
 240                (signed int) pStatistic->CustomStat.ullRsr36MCRCOk);
 241    }
 242    else if(byRxRate==96){
 243        pStatistic->CustomStat.ullRsr48M++;
 244        if(byRSR & RSR_CRCOK) {
 245            pStatistic->CustomStat.ullRsr48MCRCOk++;
 246        }
 247        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "48M: ALL[%d], OK[%d]\n",
 248                (signed int) pStatistic->CustomStat.ullRsr48M,
 249                (signed int) pStatistic->CustomStat.ullRsr48MCRCOk);
 250    }
 251    else if(byRxRate==108){
 252        pStatistic->CustomStat.ullRsr54M++;
 253        if(byRSR & RSR_CRCOK) {
 254            pStatistic->CustomStat.ullRsr54MCRCOk++;
 255        }
 256        DBG_PRT(MSG_LEVEL_DEBUG, KERN_INFO "54M: ALL[%d], OK[%d]\n",
 257                (signed int) pStatistic->CustomStat.ullRsr54M,
 258                (signed int) pStatistic->CustomStat.ullRsr54MCRCOk);
 259    }
 260    else {
 261            DBG_PRT(MSG_LEVEL_DEBUG,
 262                    KERN_INFO "Unknown: Total[%d], CRCOK[%d]\n",
 263                    (signed int) pStatistic->dwRsrRxPacket+1,
 264                    (signed int)pStatistic->dwRsrCRCOk);
 265    }
 266
 267    if (byRSR & RSR_BSSIDOK)
 268        pStatistic->dwRsrBSSIDOk++;
 269
 270    if (byRSR & RSR_BCNSSIDOK)
 271        pStatistic->dwRsrBCNSSIDOk++;
 272    if (byRSR & RSR_IVLDLEN)  //invalid len (> 2312 byte)
 273        pStatistic->dwRsrLENErr++;
 274    if (byRSR & RSR_IVLDTYP)  //invalid packet type
 275        pStatistic->dwRsrTYPErr++;
 276    if ((byRSR & (RSR_IVLDTYP | RSR_IVLDLEN)) || !(byRSR & RSR_CRCOK))
 277        pStatistic->dwRsrErr++;
 278
 279    if (byNewRSR & NEWRSR_DECRYPTOK)
 280        pStatistic->dwNewRsrDECRYPTOK++;
 281    if (byNewRSR & NEWRSR_CFPIND)
 282        pStatistic->dwNewRsrCFP++;
 283    if (byNewRSR & NEWRSR_HWUTSF)
 284        pStatistic->dwNewRsrUTSF++;
 285    if (byNewRSR & NEWRSR_BCNHITAID)
 286        pStatistic->dwNewRsrHITAID++;
 287    if (byNewRSR & NEWRSR_BCNHITAID0)
 288        pStatistic->dwNewRsrHITAID0++;
 289
 290    // increase rx packet count
 291    pStatistic->dwRsrRxPacket++;
 292    pStatistic->dwRsrRxOctet += cbFrameLength;
 293
 294    if (IS_TYPE_DATA(pbyBuffer)) {
 295        pStatistic->dwRsrRxData++;
 296    } else if (IS_TYPE_MGMT(pbyBuffer)){
 297        pStatistic->dwRsrRxManage++;
 298    } else if (IS_TYPE_CONTROL(pbyBuffer)){
 299        pStatistic->dwRsrRxControl++;
 300    }
 301
 302    if (byRSR & RSR_ADDRBROAD)
 303        pStatistic->dwRsrBroadcast++;
 304    else if (byRSR & RSR_ADDRMULTI)
 305        pStatistic->dwRsrMulticast++;
 306    else
 307        pStatistic->dwRsrDirected++;
 308
 309    if (WLAN_GET_FC_MOREFRAG(pHeader->frame_control))
 310        pStatistic->dwRsrRxFragment++;
 311
 312    if (cbFrameLength < ETH_ZLEN + 4) {
 313        pStatistic->dwRsrRunt++;
 314    } else if (cbFrameLength == ETH_ZLEN + 4) {
 315        pStatistic->dwRsrRxFrmLen64++;
 316    }
 317    else if ((65 <= cbFrameLength) && (cbFrameLength <= 127)) {
 318        pStatistic->dwRsrRxFrmLen65_127++;
 319    }
 320    else if ((128 <= cbFrameLength) && (cbFrameLength <= 255)) {
 321        pStatistic->dwRsrRxFrmLen128_255++;
 322    }
 323    else if ((256 <= cbFrameLength) && (cbFrameLength <= 511)) {
 324        pStatistic->dwRsrRxFrmLen256_511++;
 325    }
 326    else if ((512 <= cbFrameLength) && (cbFrameLength <= 1023)) {
 327        pStatistic->dwRsrRxFrmLen512_1023++;
 328    } else if ((1024 <= cbFrameLength) &&
 329               (cbFrameLength <= ETH_FRAME_LEN + 4)) {
 330        pStatistic->dwRsrRxFrmLen1024_1518++;
 331    } else if (cbFrameLength > ETH_FRAME_LEN + 4) {
 332        pStatistic->dwRsrLong++;
 333    }
 334}
 335
 336/*
 337 * Description: Update Tx Statistic Counter
 338 *
 339 * Parameters:
 340 *  In:
 341 *      pStatistic      - Pointer to Statistic Counter Data Structure
 342 *      byTSR0          - Tx Status
 343 *      byTSR1          - Tx Status
 344 *      pbyBuffer       - Tx Buffer
 345 *      cbFrameLength   - Tx Length
 346 *      uIdx            - Index of Tx DMA
 347 *  Out:
 348 *      none
 349 *
 350 * Return Value: none
 351 *
 352 */
 353void
 354STAvUpdateTDStatCounter (
 355    PSStatCounter   pStatistic,
 356    u8            byPktNum,
 357    u8            byRate,
 358    u8            byTSR
 359    )
 360{
 361    u8    byRetyCnt;
 362    // increase tx packet count
 363    pStatistic->dwTsrTxPacket++;
 364
 365    byRetyCnt = (byTSR & 0xF0) >> 4;
 366    if (byRetyCnt != 0) {
 367        pStatistic->dwTsrRetry++;
 368        pStatistic->dwTsrTotalRetry += byRetyCnt;
 369        pStatistic->dwTxFail[byRate]+= byRetyCnt;
 370        pStatistic->dwTxFail[MAX_RATE] += byRetyCnt;
 371
 372        if ( byRetyCnt == 0x1)
 373            pStatistic->dwTsrOnceRetry++;
 374        else
 375            pStatistic->dwTsrMoreThanOnceRetry++;
 376
 377        if (byRetyCnt <= 8)
 378            pStatistic->dwTxRetryCount[byRetyCnt-1]++;
 379
 380    }
 381    if ( !(byTSR & (TSR_TMO | TSR_RETRYTMO))) {
 382
 383   if (byRetyCnt < 2)
 384        pStatistic->TxNoRetryOkCount ++;
 385   else
 386        pStatistic->TxRetryOkCount ++;
 387
 388        pStatistic->ullTsrOK++;
 389        pStatistic->CustomStat.ullTsrAllOK++;
 390        // update counters in case that successful transmit
 391        pStatistic->dwTxOk[byRate]++;
 392        pStatistic->dwTxOk[MAX_RATE]++;
 393
 394        if ( pStatistic->abyTxPktInfo[byPktNum].byBroadMultiUni == TX_PKT_BROAD )  {
 395            pStatistic->ullTxBroadcastFrames++;
 396            pStatistic->ullTxBroadcastBytes += pStatistic->abyTxPktInfo[byPktNum].wLength;
 397        } else if ( pStatistic->abyTxPktInfo[byPktNum].byBroadMultiUni == TX_PKT_MULTI ) {
 398            pStatistic->ullTxMulticastFrames++;
 399            pStatistic->ullTxMulticastBytes += pStatistic->abyTxPktInfo[byPktNum].wLength;
 400        } else if ( pStatistic->abyTxPktInfo[byPktNum].byBroadMultiUni == TX_PKT_UNI ) {
 401            pStatistic->ullTxDirectedFrames++;
 402            pStatistic->ullTxDirectedBytes += pStatistic->abyTxPktInfo[byPktNum].wLength;
 403        }
 404    }
 405    else {
 406
 407        pStatistic->TxFailCount ++;
 408
 409        pStatistic->dwTsrErr++;
 410        if (byTSR & TSR_RETRYTMO)
 411            pStatistic->dwTsrRetryTimeout++;
 412        if (byTSR & TSR_TMO)
 413            pStatistic->dwTsrTransmitTimeout++;
 414    }
 415
 416    if ( pStatistic->abyTxPktInfo[byPktNum].byBroadMultiUni == TX_PKT_BROAD )  {
 417        pStatistic->dwTsrBroadcast++;
 418    } else if ( pStatistic->abyTxPktInfo[byPktNum].byBroadMultiUni == TX_PKT_MULTI ) {
 419        pStatistic->dwTsrMulticast++;
 420    } else if ( pStatistic->abyTxPktInfo[byPktNum].byBroadMultiUni == TX_PKT_UNI ) {
 421        pStatistic->dwTsrDirected++;
 422    }
 423}
 424
 425/*
 426 * Description: Update 802.11 mib counter
 427 *
 428 * Parameters:
 429 *  In:
 430 *      p802_11Counter  - Pointer to 802.11 mib counter
 431 *      pStatistic      - Pointer to Statistic Counter Data Structure
 432 *      dwCounter       - hardware counter for 802.11 mib
 433 *  Out:
 434 *      none
 435 *
 436 * Return Value: none
 437 *
 438 */
 439void
 440STAvUpdate802_11Counter(
 441    PSDot11Counters         p802_11Counter,
 442    PSStatCounter           pStatistic,
 443    u8                    byRTSSuccess,
 444    u8                    byRTSFail,
 445    u8                    byACKFail,
 446    u8                    byFCSErr
 447    )
 448{
 449    //p802_11Counter->TransmittedFragmentCount
 450    p802_11Counter->MulticastTransmittedFrameCount =
 451      (unsigned long long) (pStatistic->dwTsrBroadcast +
 452                            pStatistic->dwTsrMulticast);
 453    p802_11Counter->FailedCount = (unsigned long long) (pStatistic->dwTsrErr);
 454    p802_11Counter->RetryCount = (unsigned long long) (pStatistic->dwTsrRetry);
 455    p802_11Counter->MultipleRetryCount =
 456      (unsigned long long) (pStatistic->dwTsrMoreThanOnceRetry);
 457    //p802_11Counter->FrameDuplicateCount
 458    p802_11Counter->RTSSuccessCount += (unsigned long long) byRTSSuccess;
 459    p802_11Counter->RTSFailureCount += (unsigned long long) byRTSFail;
 460    p802_11Counter->ACKFailureCount += (unsigned long long) byACKFail;
 461    p802_11Counter->FCSErrorCount +=   (unsigned long long) byFCSErr;
 462    //p802_11Counter->ReceivedFragmentCount
 463    p802_11Counter->MulticastReceivedFrameCount =
 464      (unsigned long long) (pStatistic->dwRsrBroadcast +
 465                            pStatistic->dwRsrMulticast);
 466}
 467
 468/*
 469 * Description: Clear 802.11 mib counter
 470 *
 471 * Parameters:
 472 *  In:
 473 *      pUsbCounter  - Pointer to USB mib counter
 474 *      ntStatus - URB status
 475 *  Out:
 476 *      none
 477 *
 478 * Return Value: none
 479 *
 480 */
 481
 482void STAvUpdateUSBCounter(PSUSBCounter pUsbCounter, int ntStatus)
 483{
 484
 485//    if ( ntStatus == USBD_STATUS_CRC ) {
 486        pUsbCounter->dwCrc++;
 487//    }
 488
 489}
 490