440 lines
12 KiB
C
440 lines
12 KiB
C
|
/******************************************************************************/
|
||
|
|
/* */
|
||
|
|
/* Broadcom BCM5700 Linux Network Driver, Copyright (c) 2001 Broadcom */
|
||
|
|
/* Corporation. */
|
||
|
|
/* 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, located in the file LICENSE. */
|
||
|
|
/* */
|
||
|
|
/* History: */
|
||
|
|
/******************************************************************************/
|
||
|
|
#if !defined(CONFIG_NET_MULTI)
|
||
|
|
#if INCLUDE_TBI_SUPPORT
|
||
|
|
#include "bcm570x_autoneg.h"
|
||
|
|
#include "bcm570x_mm.h"
|
||
|
|
|
||
|
|
|
||
|
|
/******************************************************************************/
|
||
|
|
/* Description: */
|
||
|
|
/* */
|
||
|
|
/* Return: */
|
||
|
|
/******************************************************************************/
|
||
|
|
void
|
||
|
|
MM_AnTxConfig(
|
||
|
|
PAN_STATE_INFO pAnInfo)
|
||
|
|
{
|
||
|
|
PLM_DEVICE_BLOCK pDevice;
|
||
|
|
|
||
|
|
pDevice = (PLM_DEVICE_BLOCK) pAnInfo->pContext;
|
||
|
|
|
||
|
|
REG_WR(pDevice, MacCtrl.TxAutoNeg, (LM_UINT32) pAnInfo->TxConfig.AsUSHORT);
|
||
|
|
|
||
|
|
pDevice->MacMode |= MAC_MODE_SEND_CONFIGS;
|
||
|
|
REG_WR(pDevice, MacCtrl.Mode, pDevice->MacMode);
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
/******************************************************************************/
|
||
|
|
/* Description: */
|
||
|
|
/* */
|
||
|
|
/* Return: */
|
||
|
|
/******************************************************************************/
|
||
|
|
void
|
||
|
|
MM_AnTxIdle(
|
||
|
|
PAN_STATE_INFO pAnInfo)
|
||
|
|
{
|
||
|
|
PLM_DEVICE_BLOCK pDevice;
|
||
|
|
|
||
|
|
pDevice = (PLM_DEVICE_BLOCK) pAnInfo->pContext;
|
||
|
|
|
||
|
|
pDevice->MacMode &= ~MAC_MODE_SEND_CONFIGS;
|
||
|
|
REG_WR(pDevice, MacCtrl.Mode, pDevice->MacMode);
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
/******************************************************************************/
|
||
|
|
/* Description: */
|
||
|
|
/* */
|
||
|
|
/* Return: */
|
||
|
|
/******************************************************************************/
|
||
|
|
char
|
||
|
|
MM_AnRxConfig(
|
||
|
|
PAN_STATE_INFO pAnInfo,
|
||
|
|
unsigned short *pRxConfig)
|
||
|
|
{
|
||
|
|
PLM_DEVICE_BLOCK pDevice;
|
||
|
|
LM_UINT32 Value32;
|
||
|
|
char Retcode;
|
||
|
|
|
||
|
|
Retcode = AN_FALSE;
|
||
|
|
|
||
|
|
pDevice = (PLM_DEVICE_BLOCK) pAnInfo->pContext;
|
||
|
|
|
||
|
|
Value32 = REG_RD(pDevice, MacCtrl.Status);
|
||
|
|
if(Value32 & MAC_STATUS_RECEIVING_CFG)
|
||
|
|
{
|
||
|
|
Value32 = REG_RD(pDevice, MacCtrl.RxAutoNeg);
|
||
|
|
*pRxConfig = (unsigned short) Value32;
|
||
|
|
|
||
|
|
Retcode = AN_TRUE;
|
||
|
|
}
|
||
|
|
|
||
|
|
return Retcode;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
/******************************************************************************/
|
||
|
|
/* Description: */
|
||
|
|
/* */
|
||
|
|
/* Return: */
|
||
|
|
/******************************************************************************/
|
||
|
|
void
|
||
|
|
AutonegInit(
|
||
|
|
PAN_STATE_INFO pAnInfo)
|
||
|
|
{
|
||
|
|
unsigned long j;
|
||
|
|
|
||
|
|
for(j = 0; j < sizeof(AN_STATE_INFO); j++)
|
||
|
|
{
|
||
|
|
((unsigned char *) pAnInfo)[j] = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Initialize the default advertisement register. */
|
||
|
|
pAnInfo->mr_adv_full_duplex = 1;
|
||
|
|
pAnInfo->mr_adv_sym_pause = 1;
|
||
|
|
pAnInfo->mr_adv_asym_pause = 1;
|
||
|
|
pAnInfo->mr_an_enable = 1;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
/******************************************************************************/
|
||
|
|
/* Description: */
|
||
|
|
/* */
|
||
|
|
/* Return: */
|
||
|
|
/******************************************************************************/
|
||
|
|
AUTONEG_STATUS
|
||
|
|
Autoneg8023z(
|
||
|
|
PAN_STATE_INFO pAnInfo)
|
||
|
|
{
|
||
|
|
unsigned short RxConfig;
|
||
|
|
unsigned long Delta_us;
|
||
|
|
AUTONEG_STATUS AnRet;
|
||
|
|
|
||
|
|
/* Get the current time. */
|
||
|
|
if(pAnInfo->State == AN_STATE_UNKNOWN)
|
||
|
|
{
|
||
|
|
pAnInfo->RxConfig.AsUSHORT = 0;
|
||
|
|
pAnInfo->CurrentTime_us = 0;
|
||
|
|
pAnInfo->LinkTime_us = 0;
|
||
|
|
pAnInfo->AbilityMatchCfg = 0;
|
||
|
|
pAnInfo->AbilityMatchCnt = 0;
|
||
|
|
pAnInfo->AbilityMatch = AN_FALSE;
|
||
|
|
pAnInfo->IdleMatch = AN_FALSE;
|
||
|
|
pAnInfo->AckMatch = AN_FALSE;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Increment the timer tick. This function is called every microsecon. */
|
||
|
|
/* pAnInfo->CurrentTime_us++; */
|
||
|
|
|
||
|
|
/* Set the AbilityMatch, IdleMatch, and AckMatch flags if their */
|
||
|
|
/* corresponding conditions are satisfied. */
|
||
|
|
if(MM_AnRxConfig(pAnInfo, &RxConfig))
|
||
|
|
{
|
||
|
|
if(RxConfig != pAnInfo->AbilityMatchCfg)
|
||
|
|
{
|
||
|
|
pAnInfo->AbilityMatchCfg = RxConfig;
|
||
|
|
pAnInfo->AbilityMatch = AN_FALSE;
|
||
|
|
pAnInfo->AbilityMatchCnt = 0;
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
pAnInfo->AbilityMatchCnt++;
|
||
|
|
if(pAnInfo->AbilityMatchCnt > 1)
|
||
|
|
{
|
||
|
|
pAnInfo->AbilityMatch = AN_TRUE;
|
||
|
|
pAnInfo->AbilityMatchCfg = RxConfig;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
if(RxConfig & AN_CONFIG_ACK)
|
||
|
|
{
|
||
|
|
pAnInfo->AckMatch = AN_TRUE;
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
pAnInfo->AckMatch = AN_FALSE;
|
||
|
|
}
|
||
|
|
|
||
|
|
pAnInfo->IdleMatch = AN_FALSE;
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
pAnInfo->IdleMatch = AN_TRUE;
|
||
|
|
|
||
|
|
pAnInfo->AbilityMatchCfg = 0;
|
||
|
|
pAnInfo->AbilityMatchCnt = 0;
|
||
|
|
pAnInfo->AbilityMatch = AN_FALSE;
|
||
|
|
pAnInfo->AckMatch = AN_FALSE;
|
||
|
|
|
||
|
|
RxConfig = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Save the last Config. */
|
||
|
|
pAnInfo->RxConfig.AsUSHORT = RxConfig;
|
||
|
|
|
||
|
|
/* Default return code. */
|
||
|
|
AnRet = AUTONEG_STATUS_OK;
|
||
|
|
|
||
|
|
/* Autoneg state machine as defined in 802.3z section 37.3.1.5. */
|
||
|
|
switch(pAnInfo->State)
|
||
|
|
{
|
||
|
|
case AN_STATE_UNKNOWN:
|
||
|
|
if(pAnInfo->mr_an_enable || pAnInfo->mr_restart_an)
|
||
|
|
{
|
||
|
|
pAnInfo->CurrentTime_us = 0;
|
||
|
|
pAnInfo->State = AN_STATE_AN_ENABLE;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Fall through.*/
|
||
|
|
|
||
|
|
case AN_STATE_AN_ENABLE:
|
||
|
|
pAnInfo->mr_an_complete = AN_FALSE;
|
||
|
|
pAnInfo->mr_page_rx = AN_FALSE;
|
||
|
|
|
||
|
|
if(pAnInfo->mr_an_enable)
|
||
|
|
{
|
||
|
|
pAnInfo->LinkTime_us = 0;
|
||
|
|
pAnInfo->AbilityMatchCfg = 0;
|
||
|
|
pAnInfo->AbilityMatchCnt = 0;
|
||
|
|
pAnInfo->AbilityMatch = AN_FALSE;
|
||
|
|
pAnInfo->IdleMatch = AN_FALSE;
|
||
|
|
pAnInfo->AckMatch = AN_FALSE;
|
||
|
|
|
||
|
|
pAnInfo->State = AN_STATE_AN_RESTART_INIT;
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
pAnInfo->State = AN_STATE_DISABLE_LINK_OK;
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
|
||
|
|
case AN_STATE_AN_RESTART_INIT:
|
||
|
|
pAnInfo->LinkTime_us = pAnInfo->CurrentTime_us;
|
||
|
|
pAnInfo->mr_np_loaded = AN_FALSE;
|
||
|
|
|
||
|
|
pAnInfo->TxConfig.AsUSHORT = 0;
|
||
|
|
MM_AnTxConfig(pAnInfo);
|
||
|
|
|
||
|
|
AnRet = AUTONEG_STATUS_TIMER_ENABLED;
|
||
|
|
|
||
|
|
pAnInfo->State = AN_STATE_AN_RESTART;
|
||
|
|
|
||
|
|
/* Fall through.*/
|
||
|
|
|
||
|
|
case AN_STATE_AN_RESTART:
|
||
|
|
/* Get the current time and compute the delta with the saved */
|
||
|
|
/* link timer. */
|
||
|
|
Delta_us = pAnInfo->CurrentTime_us - pAnInfo->LinkTime_us;
|
||
|
|
if(Delta_us > AN_LINK_TIMER_INTERVAL_US)
|
||
|
|
{
|
||
|
|
pAnInfo->State = AN_STATE_ABILITY_DETECT_INIT;
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
AnRet = AUTONEG_STATUS_TIMER_ENABLED;
|
||
|
|
}
|
||
|
|
break;
|
||
|
|
|
||
|
|
case AN_STATE_DISABLE_LINK_OK:
|
||
|
|
AnRet = AUTONEG_STATUS_DONE;
|
||
|
|
break;
|
||
|
|
|
||
|
|
case AN_STATE_ABILITY_DETECT_INIT:
|
||
|
|
/* Note: in the state diagram, this variable is set to */
|
||
|
|
/* mr_adv_ability<12>. Is this right?. */
|
||
|
|
pAnInfo->mr_toggle_tx = AN_FALSE;
|
||
|
|
|
||
|
|
/* Send the config as advertised in the advertisement register. */
|
||
|
|
pAnInfo->TxConfig.AsUSHORT = 0;
|
||
|
|
pAnInfo->TxConfig.D5_FD = pAnInfo->mr_adv_full_duplex;
|
||
|
|
pAnInfo->TxConfig.D6_HD = pAnInfo->mr_adv_half_duplex;
|
||
|
|
pAnInfo->TxConfig.D7_PS1 = pAnInfo->mr_adv_sym_pause;
|
||
|
|
pAnInfo->TxConfig.D8_PS2 = pAnInfo->mr_adv_asym_pause;
|
||
|
|
pAnInfo->TxConfig.D12_RF1 = pAnInfo->mr_adv_remote_fault1;
|
||
|
|
pAnInfo->TxConfig.D13_RF2 = pAnInfo->mr_adv_remote_fault2;
|
||
|
|
pAnInfo->TxConfig.D15_NP = pAnInfo->mr_adv_next_page;
|
||
|
|
|
||
|
|
MM_AnTxConfig(pAnInfo);
|
||
|
|
|
||
|
|
pAnInfo->State = AN_STATE_ABILITY_DETECT;
|
||
|
|
|
||
|
|
break;
|
||
|
|
|
||
|
|
case AN_STATE_ABILITY_DETECT:
|
||
|
|
if(pAnInfo->AbilityMatch == AN_TRUE &&
|
||
|
|
pAnInfo->RxConfig.AsUSHORT != 0)
|
||
|
|
{
|
||
|
|
pAnInfo->State = AN_STATE_ACK_DETECT_INIT;
|
||
|
|
}
|
||
|
|
|
||
|
|
break;
|
||
|
|
|
||
|
|
case AN_STATE_ACK_DETECT_INIT:
|
||
|
|
pAnInfo->TxConfig.D14_ACK = 1;
|
||
|
|
MM_AnTxConfig(pAnInfo);
|
||
|
|
|
||
|
|
pAnInfo->State = AN_STATE_ACK_DETECT;
|
||
|
|
|
||
|
|
/* Fall through. */
|
||
|
|
|
||
|
|
case AN_STATE_ACK_DETECT:
|
||
|
|
if(pAnInfo->AckMatch == AN_TRUE)
|
||
|
|
{
|
||
|
|
if((pAnInfo->RxConfig.AsUSHORT & ~AN_CONFIG_ACK) ==
|
||
|
|
(pAnInfo->AbilityMatchCfg & ~AN_CONFIG_ACK))
|
||
|
|
{
|
||
|
|
pAnInfo->State = AN_STATE_COMPLETE_ACK_INIT;
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
pAnInfo->State = AN_STATE_AN_ENABLE;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
else if(pAnInfo->AbilityMatch == AN_TRUE &&
|
||
|
|
pAnInfo->RxConfig.AsUSHORT == 0)
|
||
|
|
{
|
||
|
|
pAnInfo->State = AN_STATE_AN_ENABLE;
|
||
|
|
}
|
||
|
|
|
||
|
|
break;
|
||
|
|
|
||
|
|
case AN_STATE_COMPLETE_ACK_INIT:
|
||
|
|
/* Make sure invalid bits are not set. */
|
||
|
|
if(pAnInfo->RxConfig.bits.D0 || pAnInfo->RxConfig.bits.D1 ||
|
||
|
|
pAnInfo->RxConfig.bits.D2 || pAnInfo->RxConfig.bits.D3 ||
|
||
|
|
pAnInfo->RxConfig.bits.D4 || pAnInfo->RxConfig.bits.D9 ||
|
||
|
|
pAnInfo->RxConfig.bits.D10 || pAnInfo->RxConfig.bits.D11)
|
||
|
|
{
|
||
|
|
AnRet = AUTONEG_STATUS_FAILED;
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Set up the link partner advertisement register. */
|
||
|
|
pAnInfo->mr_lp_adv_full_duplex = pAnInfo->RxConfig.D5_FD;
|
||
|
|
pAnInfo->mr_lp_adv_half_duplex = pAnInfo->RxConfig.D6_HD;
|
||
|
|
pAnInfo->mr_lp_adv_sym_pause = pAnInfo->RxConfig.D7_PS1;
|
||
|
|
pAnInfo->mr_lp_adv_asym_pause = pAnInfo->RxConfig.D8_PS2;
|
||
|
|
pAnInfo->mr_lp_adv_remote_fault1 = pAnInfo->RxConfig.D12_RF1;
|
||
|
|
pAnInfo->mr_lp_adv_remote_fault2 = pAnInfo->RxConfig.D13_RF2;
|
||
|
|
pAnInfo->mr_lp_adv_next_page = pAnInfo->RxConfig.D15_NP;
|
||
|
|
|
||
|
|
pAnInfo->LinkTime_us = pAnInfo->CurrentTime_us;
|
||
|
|
|
||
|
|
pAnInfo->mr_toggle_tx = !pAnInfo->mr_toggle_tx;
|
||
|
|
pAnInfo->mr_toggle_rx = pAnInfo->RxConfig.bits.D11;
|
||
|
|
pAnInfo->mr_np_rx = pAnInfo->RxConfig.D15_NP;
|
||
|
|
pAnInfo->mr_page_rx = AN_TRUE;
|
||
|
|
|
||
|
|
pAnInfo->State = AN_STATE_COMPLETE_ACK;
|
||
|
|
AnRet = AUTONEG_STATUS_TIMER_ENABLED;
|
||
|
|
|
||
|
|
break;
|
||
|
|
|
||
|
|
case AN_STATE_COMPLETE_ACK:
|
||
|
|
if(pAnInfo->AbilityMatch == AN_TRUE &&
|
||
|
|
pAnInfo->RxConfig.AsUSHORT == 0)
|
||
|
|
{
|
||
|
|
pAnInfo->State = AN_STATE_AN_ENABLE;
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
|
||
|
|
Delta_us = pAnInfo->CurrentTime_us - pAnInfo->LinkTime_us;
|
||
|
|
|
||
|
|
if(Delta_us > AN_LINK_TIMER_INTERVAL_US)
|
||
|
|
{
|
||
|
|
if(pAnInfo->mr_adv_next_page == 0 ||
|
||
|
|
pAnInfo->mr_lp_adv_next_page == 0)
|
||
|
|
{
|
||
|
|
pAnInfo->State = AN_STATE_IDLE_DETECT_INIT;
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
if(pAnInfo->TxConfig.bits.D15 == 0 &&
|
||
|
|
pAnInfo->mr_np_rx == 0)
|
||
|
|
{
|
||
|
|
pAnInfo->State = AN_STATE_IDLE_DETECT_INIT;
|
||
|
|
}
|
||
|
|
else
|
||
|
|
{
|
||
|
|
AnRet = AUTONEG_STATUS_FAILED;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
break;
|
||
|
|
|
||
|
|
case AN_STATE_IDLE_DETECT_INIT:
|
||
|
|
pAnInfo->LinkTime_us = pAnInfo->CurrentTime_us;
|
||
|
|
|
||
|
|
MM_AnTxIdle(pAnInfo);
|
||
|
|
|
||
|
|
pAnInfo->State = AN_STATE_IDLE_DETECT;
|
||
|
|
|
||
|
|
AnRet = AUTONEG_STATUS_TIMER_ENABLED;
|
||
|
|
|
||
|
|
break;
|
||
|
|
|
||
|
|
case AN_STATE_IDLE_DETECT:
|
||
|
|
if(pAnInfo->AbilityMatch == AN_TRUE &&
|
||
|
|
pAnInfo->RxConfig.AsUSHORT == 0)
|
||
|
|
{
|
||
|
|
pAnInfo->State = AN_STATE_AN_ENABLE;
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
|
||
|
|
Delta_us = pAnInfo->CurrentTime_us - pAnInfo->LinkTime_us;
|
||
|
|
if(Delta_us > AN_LINK_TIMER_INTERVAL_US)
|
||
|
|
{
|
||
|
|
#if 0
|
||
|
|
/* if(pAnInfo->IdleMatch == AN_TRUE) */
|
||
|
|
/* { */
|
||
|
|
#endif
|
||
|
|
pAnInfo->State = AN_STATE_LINK_OK;
|
||
|
|
#if 0
|
||
|
|
/* } */
|
||
|
|
/* else */
|
||
|
|
/* { */
|
||
|
|
/* AnRet = AUTONEG_STATUS_FAILED; */
|
||
|
|
/* break; */
|
||
|
|
/* } */
|
||
|
|
#endif
|
||
|
|
}
|
||
|
|
|
||
|
|
break;
|
||
|
|
|
||
|
|
case AN_STATE_LINK_OK:
|
||
|
|
pAnInfo->mr_an_complete = AN_TRUE;
|
||
|
|
pAnInfo->mr_link_ok = AN_TRUE;
|
||
|
|
AnRet = AUTONEG_STATUS_DONE;
|
||
|
|
|
||
|
|
break;
|
||
|
|
|
||
|
|
case AN_STATE_NEXT_PAGE_WAIT_INIT:
|
||
|
|
break;
|
||
|
|
|
||
|
|
case AN_STATE_NEXT_PAGE_WAIT:
|
||
|
|
break;
|
||
|
|
|
||
|
|
default:
|
||
|
|
AnRet = AUTONEG_STATUS_FAILED;
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
|
||
|
|
return AnRet;
|
||
|
|
}
|
||
|
|
#endif /* INCLUDE_TBI_SUPPORT */
|
||
|
|
|
||
|
|
#endif /* !defined(CONFIG_NET_MULTI) */
|