ks_rate.c

MICREL 网卡驱动 FOR CE 5.0

/* ---------------------------------------------------------------------------
          Copyright (c) 2004-2006 Micrel, Inc.  All rights reserved.
   ---------------------------------------------------------------------------

    ks_rate.c - KS884X switch rate limit functions.

    Author  Date      Version  Description
    PCD     06/28/06  1.0.4    Enable Switch Ports broacast storm protection at 10% percent rate.
    THa     02/28/06           Do not use HW_WRITE_BYTE because of limitation of
                               some hardware platforms.
    THa     02/23/06           Removed KS884X_HW conditional.
    THa     10/11/04           Updated with latest specs.
    THa     09/29/04           Updated for PCI version.
    THa     02/13/04           Created file.
   ---------------------------------------------------------------------------
*/


#ifdef DEF_KS8842
#include "target.h"
#include "hardware.h"


/* -------------------------------------------------------------------------- */
extern int hwread ( unsigned char, unsigned long, unsigned char );

/* 148,800 frames * 67 ms / 100 */
#define BROADCAST_STORM_VALUE  9969

/*
    SwitchConfigBroadcastStorm

    Description:
        This routine configures the broadcast storm threshold of the switch.

    Parameters:
        PHARDWARE pHardware
            Pointer to hardware instance.

        int percent
            Broadcast storm threshold in percent of transmit rate.

    Return (None):
*/

static
void SwitchConfigBroadcastStorm (
    PHARDWARE pHardware,
    UCHAR       percent )
{
    USHORT usData;
    ULONG    value = (ULONG)((ULONG)BROADCAST_STORM_VALUE * (ULONG)percent / 100); 


    if ( value > BROADCAST_STORM_RATE )
        value = BROADCAST_STORM_RATE;

#ifdef KS_ISA_BUS
    HardwareSelectBank( pHardware, REG_SWITCH_CTRL_BANK );
#endif
    HW_READ_WORD( pHardware, REG_SWITCH_CTRL_3_OFFSET, &usData );

    usData &= ~(( BROADCAST_STORM_RATE_LO << 8 ) | BROADCAST_STORM_RATE_HI );
    usData |= (( value & 0x00FF ) << 8 ) | (( value & 0xFF00 ) >> 8 );

    HW_WRITE_WORD( pHardware, REG_SWITCH_CTRL_3_OFFSET, usData );
}  /* SwitchConfigBroadcastStorm */


/*
    SwitchGetBroadcastStorm

    Description:
        This routine retrieves the broadcast storm threshold of the switch.

    Parameters:
        PHARDWARE pHardware
            Pointer to hardware instance.

        int* percent
            Buffer to store the broadcast storm threshold percent.

    Return (None):
*/

static
void SwitchGetBroadcastStorm (
    PHARDWARE pHardware,
    UCHAR *pnPercent )
{
    int   Data;
    UCHAR bData;
    ULONG percent;

#ifdef KS_ISA_BUS
    HardwareSelectBank( pHardware, REG_SWITCH_CTRL_BANK );
#endif
    HW_READ_BYTE( pHardware, REG_SWITCH_CTRL_3_OFFSET, &bData );

    Data = ( bData & BROADCAST_STORM_RATE_HI );
    Data <<= 8;

    HW_READ_BYTE( pHardware, REG_SWITCH_CTRL_3_HI_OFFSET, &bData );
    Data |= ( bData & BROADCAST_STORM_RATE_LO );
    percent = (ULONG)( ((ULONG) (Data+1) * 100 ) / (ULONG)BROADCAST_STORM_VALUE);

    *(UCHAR *)pnPercent = ( UCHAR ) percent;

}  /* SwitchGetBroadcastStorm */


/*
    SwitchDisableBroadcastStorm

    Description:
        This routine disables the broadcast storm limit function of the switch.

    Parameters:
        PHARDWARE pHardware
            Pointer to hardware instance.

        UCHAR bPort
            The port index.

    Return (None):
*/

#ifdef KS_PCI_BUS
void SwitchDisableBroadcastStorm_PCI
#else
void SwitchDisableBroadcastStorm_ISA
#endif
(
    PHARDWARE pHardware,
    UCHAR     bPort )
{

    ASSERT( pHardware->m_bAcquire );

    PortConfigBroadcastStorm( pHardware, bPort, FALSE );

}  /* SwitchDisableBroadcastStorm */


/*
    SwitchEnableBroadcastStorm

    Description:
        This routine enables the broadcast storm limit function of the switch.

    Parameters:
        PHARDWARE pHardware
            Pointer to hardware instance.

        UCHAR bPort
            The port index.

    Return (None):
*/

#ifdef KS_PCI_BUS
void SwitchEnableBroadcastStorm_PCI
#else
void SwitchEnableBroadcastStorm_ISA
#endif
(
    PHARDWARE pHardware,
    UCHAR     bPort
)
{

    ASSERT( pHardware->m_bAcquire );

    SwitchConfigBroadcastStorm( pHardware, pHardware->m_bBroadcastPercent );
    PortConfigBroadcastStorm( pHardware, bPort, TRUE );
    SwitchConfigSet( pHardware, REG_SWITCH_CTRL_2_OFFSET,
        MULTICAST_STORM_DISABLE, TRUE );
}  /* SwitchEnableBroadcastStorm */


#if defined( KS_ISA_BUS )  ||  !defined( KS_ISA )
/*
    SwitchInitBroadcastStorm

    Description:
        This routine initializes the broadcast storm limit function of the
        switch.

    Parameters:
        PHARDWARE pHardware
            Pointer to hardware instance.

    Return (None):
*/

void SwitchInitBroadcastStorm (
    PHARDWARE pHardware )
{
    UCHAR bPort;

    pHardware->m_bBroadcastPercent = 1;
    SwitchConfigBroadcastStorm( pHardware, pHardware->m_bBroadcastPercent );
    for ( bPort = 0; bPort < TOTAL_PORT_NUM; bPort++ )
    {
        SwitchDisableBroadcastStorm( pHardware, bPort );
    }
}  /* SwitchInitBroadcastStorm */
#endif


/*
    HardwareConfigBroadcastStorm

    Description:
        This routine configures the broadcast storm threshold of the switch.
        It is called by user functions.  The hardware should be acquired first.

    Parameters:
        PHARDWARE pHardware
            Pointer to hardware instance.

        int percent
            Broadcast storm threshold in percent of transmit rate.

    Return (None):
*/

#ifdef KS_PCI_BUS
void HardwareConfigBroadcastStorm_PCI
#else
void HardwareConfigBroadcastStorm_ISA
#endif
(
    PHARDWARE pHardware,
    UCHAR     percent 
)
{
    ASSERT( pHardware->m_bAcquire );

    if ( percent > 100 )
        percent = 100;

    SwitchConfigBroadcastStorm( pHardware, percent );
    SwitchGetBroadcastStorm( pHardware, &percent );
    pHardware->m_bBroadcastPercent = ( UCHAR ) percent;
}  /* HardwareConfigBroadcastStorm */

/* -------------------------------------------------------------------------- */

#define RATE_LIMIT_TABLE_ENTRY   15

typedef struct rateToRegValue
{
      ULONG    rate ;
      UCHAR    regValue ;

} RATETOREGVALUE ;

RATETOREGVALUE rateToRegValueTable[] =
{
    {   64,   0x01 },   /*  64Kbps */
    {   128,  0x02 },   /* 128Kbps */
    {   256,  0x03 },   /* 256Kbps */
    {   512,  0x04 },   /* 512Kbps */
    {  1024,  0x05 },   /*   1Mbps */
    {  2048,  0x06 },   /*   2Mbps */
    {  4096,  0x07 },   /*   4Mbps */
    {  8192,  0x08 },   /*   8Mbps */
    { 16384,  0x09 },   /*  16Mbps */
    { 32768,  0x0A },   /*  32Mbps */
    { 49152,  0x0B },   /*  48Mbps */
    { 65536,  0x0C },   /*  64Mbps */
    { 73728,  0x0D },   /*  72Mbps */
    { 81920,  0x0E },   /*  80Mbps */
    { 90112,  0x0F }    /*  88Mbps */
} ;


/*
    getRateToRegValue

    Description:
        This routine configures the priority rate of the port.

    Parameters:
        ULONG dwRate
            The priority rate in number of Kbps.

    Return
       Register value for this Rate limiting.
*/

static
int getRateToRegValue (
    ULONG     dwRate )
{
    UCHAR   factor = 0;
    UCHAR   i;


    for (i=0; i < (RATE_LIMIT_TABLE_ENTRY-1); i++)
    {
        if ( ( dwRate >= rateToRegValueTable[i].rate ) &&
             ( dwRate < rateToRegValueTable[i+1].rate ) )
        {
            return (rateToRegValueTable[i].regValue);
        }
    }

    if ( dwRate >= rateToRegValueTable[i].rate )
         return (rateToRegValueTable[i].regValue);
    else
         return (factor);
}


/*
    getRegValueToRate

    Description:
        This routine configures the priority rate of the port.

    Parameters:
        ULONG dwRate
            The priority rate in number of Kbps.

    Return
       Register value for this Rate limiting.
*/

static
ULONG getRegValueToRate (
    UCHAR   bRegValue )
{
    ULONG   rate = 0;
    UCHAR   i;


    for (i=0; i < RATE_LIMIT_TABLE_ENTRY; i++)
    {
        if ( bRegValue == rateToRegValueTable[i].regValue )
        {
            return (rateToRegValueTable[i].rate);
        }
    }

    /* not set, return zero (not rate limit) */
    return (rate);
}


/*