6201 lines
174 KiB
C
6201 lines
174 KiB
C
|
/******************************************************************************/
|
||
|
/* */
|
||
|
/* Broadcom BCM5700 Linux Network Driver, Copyright (c) 2000 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: */
|
||
|
/******************************************************************************/
|
||
|
#include <common.h>
|
||
|
#include <asm/types.h>
|
||
|
#if (CONFIG_COMMANDS & CFG_CMD_NET) && !defined(CONFIG_NET_MULTI) && \
|
||
|
defined(CONFIG_TIGON3)
|
||
|
#ifdef CONFIG_BMW
|
||
|
#include <mpc824x.h>
|
||
|
#endif
|
||
|
#include <malloc.h>
|
||
|
#include <linux/byteorder/big_endian.h>
|
||
|
#include "bcm570x_mm.h"
|
||
|
|
||
|
#define EMBEDDED 1
|
||
|
/******************************************************************************/
|
||
|
/* Local functions. */
|
||
|
/******************************************************************************/
|
||
|
|
||
|
LM_STATUS LM_Abort(PLM_DEVICE_BLOCK pDevice);
|
||
|
LM_STATUS LM_QueueRxPackets(PLM_DEVICE_BLOCK pDevice);
|
||
|
|
||
|
static LM_STATUS LM_TranslateRequestedMediaType(
|
||
|
LM_REQUESTED_MEDIA_TYPE RequestedMediaType,
|
||
|
PLM_MEDIA_TYPE pMediaType, PLM_LINE_SPEED pLineSpeed,
|
||
|
PLM_DUPLEX_MODE pDuplexMode);
|
||
|
|
||
|
static LM_STATUS LM_InitBcm540xPhy(PLM_DEVICE_BLOCK pDevice);
|
||
|
|
||
|
__inline static LM_VOID LM_ServiceRxInterrupt(PLM_DEVICE_BLOCK pDevice);
|
||
|
__inline static LM_VOID LM_ServiceTxInterrupt(PLM_DEVICE_BLOCK pDevice);
|
||
|
|
||
|
static LM_STATUS LM_ForceAutoNegBcm540xPhy(PLM_DEVICE_BLOCK pDevice,
|
||
|
LM_REQUESTED_MEDIA_TYPE RequestedMediaType);
|
||
|
static LM_STATUS LM_ForceAutoNeg(PLM_DEVICE_BLOCK pDevice,
|
||
|
LM_REQUESTED_MEDIA_TYPE RequestedMediaType);
|
||
|
static LM_UINT32 GetPhyAdFlowCntrlSettings(PLM_DEVICE_BLOCK pDevice);
|
||
|
STATIC LM_STATUS LM_SetFlowControl(PLM_DEVICE_BLOCK pDevice,
|
||
|
LM_UINT32 LocalPhyAd, LM_UINT32 RemotePhyAd);
|
||
|
#if INCLUDE_TBI_SUPPORT
|
||
|
STATIC LM_STATUS LM_SetupFiberPhy(PLM_DEVICE_BLOCK pDevice);
|
||
|
STATIC LM_STATUS LM_InitBcm800xPhy(PLM_DEVICE_BLOCK pDevice);
|
||
|
#endif
|
||
|
STATIC LM_STATUS LM_SetupCopperPhy(PLM_DEVICE_BLOCK pDevice);
|
||
|
STATIC PLM_ADAPTER_INFO LM_GetAdapterInfoBySsid(LM_UINT16 Svid, LM_UINT16 Ssid);
|
||
|
STATIC LM_STATUS LM_DmaTest(PLM_DEVICE_BLOCK pDevice, PLM_UINT8 pBufferVirt,
|
||
|
LM_PHYSICAL_ADDRESS BufferPhy, LM_UINT32 BufferSize);
|
||
|
STATIC LM_STATUS LM_HaltCpu(PLM_DEVICE_BLOCK pDevice,LM_UINT32 cpu_number);
|
||
|
STATIC LM_STATUS LM_ResetChip(PLM_DEVICE_BLOCK pDevice);
|
||
|
STATIC LM_STATUS LM_Test4GBoundary(PLM_DEVICE_BLOCK pDevice, PLM_PACKET pPacket,
|
||
|
PT3_SND_BD pSendBd);
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* External functions. */
|
||
|
/******************************************************************************/
|
||
|
|
||
|
LM_STATUS LM_LoadRlsFirmware(PLM_DEVICE_BLOCK pDevice);
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
LM_UINT32
|
||
|
LM_RegRdInd(
|
||
|
PLM_DEVICE_BLOCK pDevice,
|
||
|
LM_UINT32 Register) {
|
||
|
LM_UINT32 Value32;
|
||
|
|
||
|
#if PCIX_TARGET_WORKAROUND
|
||
|
MM_ACQUIRE_UNDI_LOCK(pDevice);
|
||
|
#endif
|
||
|
MM_WriteConfig32(pDevice, T3_PCI_REG_ADDR_REG, Register);
|
||
|
MM_ReadConfig32(pDevice, T3_PCI_REG_DATA_REG, &Value32);
|
||
|
#if PCIX_TARGET_WORKAROUND
|
||
|
MM_RELEASE_UNDI_LOCK(pDevice);
|
||
|
#endif
|
||
|
|
||
|
return Value32;
|
||
|
} /* LM_RegRdInd */
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
LM_VOID
|
||
|
LM_RegWrInd(
|
||
|
PLM_DEVICE_BLOCK pDevice,
|
||
|
LM_UINT32 Register,
|
||
|
LM_UINT32 Value32) {
|
||
|
|
||
|
#if PCIX_TARGET_WORKAROUND
|
||
|
MM_ACQUIRE_UNDI_LOCK(pDevice);
|
||
|
#endif
|
||
|
MM_WriteConfig32(pDevice, T3_PCI_REG_ADDR_REG, Register);
|
||
|
MM_WriteConfig32(pDevice, T3_PCI_REG_DATA_REG, Value32);
|
||
|
#if PCIX_TARGET_WORKAROUND
|
||
|
MM_RELEASE_UNDI_LOCK(pDevice);
|
||
|
#endif
|
||
|
} /* LM_RegWrInd */
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
LM_UINT32
|
||
|
LM_MemRdInd(
|
||
|
PLM_DEVICE_BLOCK pDevice,
|
||
|
LM_UINT32 MemAddr) {
|
||
|
LM_UINT32 Value32;
|
||
|
|
||
|
MM_ACQUIRE_UNDI_LOCK(pDevice);
|
||
|
#ifdef BIG_ENDIAN_HOST
|
||
|
MM_WriteConfig32(pDevice, T3_PCI_MEM_WIN_ADDR_REG, MemAddr);
|
||
|
Value32 = REG_RD(pDevice, PciCfg.MemWindowData);
|
||
|
/* Value32 = REG_RD(pDevice,uIntMem.Mbuf[(MemAddr & 0x7fff)/4]); */
|
||
|
#else
|
||
|
MM_WriteConfig32(pDevice, T3_PCI_MEM_WIN_ADDR_REG, MemAddr);
|
||
|
MM_ReadConfig32(pDevice, T3_PCI_MEM_WIN_DATA_REG, &Value32);
|
||
|
#endif
|
||
|
MM_RELEASE_UNDI_LOCK(pDevice);
|
||
|
|
||
|
return Value32;
|
||
|
} /* LM_MemRdInd */
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
LM_VOID
|
||
|
LM_MemWrInd(
|
||
|
PLM_DEVICE_BLOCK pDevice,
|
||
|
LM_UINT32 MemAddr,
|
||
|
LM_UINT32 Value32) {
|
||
|
MM_ACQUIRE_UNDI_LOCK(pDevice);
|
||
|
#ifdef BIG_ENDIAN_HOST
|
||
|
REG_WR(pDevice,PciCfg.MemWindowBaseAddr,MemAddr);
|
||
|
REG_WR(pDevice,uIntMem.Mbuf[(MemAddr & 0x7fff)/4],Value32);
|
||
|
#else
|
||
|
MM_WriteConfig32(pDevice, T3_PCI_MEM_WIN_ADDR_REG, MemAddr);
|
||
|
MM_WriteConfig32(pDevice, T3_PCI_MEM_WIN_DATA_REG, Value32);
|
||
|
#endif
|
||
|
MM_RELEASE_UNDI_LOCK(pDevice);
|
||
|
} /* LM_MemWrInd */
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
LM_STATUS
|
||
|
LM_QueueRxPackets(
|
||
|
PLM_DEVICE_BLOCK pDevice) {
|
||
|
LM_STATUS Lmstatus;
|
||
|
PLM_PACKET pPacket;
|
||
|
PT3_RCV_BD pRcvBd;
|
||
|
LM_UINT32 StdBdAdded = 0;
|
||
|
#if T3_JUMBO_RCV_RCB_ENTRY_COUNT
|
||
|
LM_UINT32 JumboBdAdded = 0;
|
||
|
#endif /* T3_JUMBO_RCV_RCB_ENTRY_COUNT */
|
||
|
|
||
|
Lmstatus = LM_STATUS_SUCCESS;
|
||
|
|
||
|
pPacket = (PLM_PACKET) QQ_PopHead(&pDevice->RxPacketFreeQ.Container);
|
||
|
while(pPacket) {
|
||
|
switch(pPacket->u.Rx.RcvProdRing) {
|
||
|
#if T3_JUMBO_RCV_RCB_ENTRY_COUNT
|
||
|
case T3_JUMBO_RCV_PROD_RING: /* Jumbo Receive Ring. */
|
||
|
/* Initialize the buffer descriptor. */
|
||
|
pRcvBd =
|
||
|
&pDevice->pRxJumboBdVirt[pDevice->RxJumboProdIdx];
|
||
|
pRcvBd->Flags = RCV_BD_FLAG_END | RCV_BD_FLAG_JUMBO_RING;
|
||
|
pRcvBd->Len = (LM_UINT16) pDevice->RxJumboBufferSize;
|
||
|
|
||
|
/* Initialize the receive buffer pointer */
|
||
|
#if 0 /* Jimmy, deleted in new */
|
||
|
pRcvBd->HostAddr.Low = pPacket->u.Rx.RxBufferPhy.Low;
|
||
|
pRcvBd->HostAddr.High = pPacket->u.Rx.RxBufferPhy.High;
|
||
|
#endif
|
||
|
MM_MapRxDma(pDevice, pPacket, &pRcvBd->HostAddr);
|
||
|
|
||
|
/* The opaque field may point to an offset from a fix addr. */
|
||
|
pRcvBd->Opaque = (LM_UINT32) (MM_UINT_PTR(pPacket) -
|
||
|
MM_UINT_PTR(pDevice->pPacketDescBase));
|
||
|
|
||
|
/* Update the producer index. */
|
||
|
pDevice->RxJumboProdIdx = (pDevice->RxJumboProdIdx + 1) &
|
||
|
T3_JUMBO_RCV_RCB_ENTRY_COUNT_MASK;
|
||
|
|
||
|
JumboBdAdded++;
|
||
|
break;
|
||
|
#endif /* T3_JUMBO_RCV_RCB_ENTRY_COUNT */
|
||
|
|
||
|
case T3_STD_RCV_PROD_RING: /* Standard Receive Ring. */
|
||
|
/* Initialize the buffer descriptor. */
|
||
|
pRcvBd = &pDevice->pRxStdBdVirt[pDevice->RxStdProdIdx];
|
||
|
pRcvBd->Flags = RCV_BD_FLAG_END;
|
||
|
pRcvBd->Len = MAX_STD_RCV_BUFFER_SIZE;
|
||
|
|
||
|
/* Initialize the receive buffer pointer */
|
||
|
#if 0 /* Jimmy, deleted in new replaced with MM_MapRxDma */
|
||
|
pRcvBd->HostAddr.Low = pPacket->u.Rx.RxBufferPhy.Low;
|
||
|
pRcvBd->HostAddr.High = pPacket->u.Rx.RxBufferPhy.High;
|
||
|
#endif
|
||
|
MM_MapRxDma(pDevice, pPacket, &pRcvBd->HostAddr);
|
||
|
|
||
|
/* The opaque field may point to an offset from a fix addr. */
|
||
|
pRcvBd->Opaque = (LM_UINT32) (MM_UINT_PTR(pPacket) -
|
||
|
MM_UINT_PTR(pDevice->pPacketDescBase));
|
||
|
|
||
|
/* Update the producer index. */
|
||
|
pDevice->RxStdProdIdx = (pDevice->RxStdProdIdx + 1) &
|
||
|
T3_STD_RCV_RCB_ENTRY_COUNT_MASK;
|
||
|
|
||
|
StdBdAdded++;
|
||
|
break;
|
||
|
|
||
|
case T3_UNKNOWN_RCV_PROD_RING:
|
||
|
default:
|
||
|
Lmstatus = LM_STATUS_FAILURE;
|
||
|
break;
|
||
|
} /* switch */
|
||
|
|
||
|
/* Bail out if there is any error. */
|
||
|
if(Lmstatus != LM_STATUS_SUCCESS)
|
||
|
{
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
pPacket = (PLM_PACKET) QQ_PopHead(&pDevice->RxPacketFreeQ.Container);
|
||
|
} /* while */
|
||
|
|
||
|
wmb();
|
||
|
/* Update the procedure index. */
|
||
|
if(StdBdAdded)
|
||
|
{
|
||
|
MB_REG_WR(pDevice, Mailbox.RcvStdProdIdx.Low, pDevice->RxStdProdIdx);
|
||
|
}
|
||
|
#if T3_JUMBO_RCV_RCB_ENTRY_COUNT
|
||
|
if(JumboBdAdded)
|
||
|
{
|
||
|
MB_REG_WR(pDevice, Mailbox.RcvJumboProdIdx.Low,
|
||
|
pDevice->RxJumboProdIdx);
|
||
|
}
|
||
|
#endif /* T3_JUMBO_RCV_RCB_ENTRY_COUNT */
|
||
|
|
||
|
return Lmstatus;
|
||
|
} /* LM_QueueRxPackets */
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
STATIC LM_VOID
|
||
|
LM_NvramInit(
|
||
|
PLM_DEVICE_BLOCK pDevice)
|
||
|
{
|
||
|
LM_UINT32 Value32;
|
||
|
LM_UINT32 j;
|
||
|
|
||
|
/* Intialize clock period and state machine. */
|
||
|
Value32 = SEEPROM_ADDR_CLK_PERD(SEEPROM_CLOCK_PERIOD) |
|
||
|
SEEPROM_ADDR_FSM_RESET;
|
||
|
REG_WR(pDevice, Grc.EepromAddr, Value32);
|
||
|
|
||
|
for(j = 0; j < 100; j++)
|
||
|
{
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
|
||
|
/* Serial eeprom access using the Grc.EepromAddr/EepromData registers. */
|
||
|
Value32 = REG_RD(pDevice, Grc.LocalCtrl);
|
||
|
REG_WR(pDevice, Grc.LocalCtrl, Value32 | GRC_MISC_LOCAL_CTRL_AUTO_SEEPROM);
|
||
|
|
||
|
/* Set the 5701 compatibility mode if we are using EEPROM. */
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) != T3_ASIC_REV_5700 &&
|
||
|
T3_ASIC_REV(pDevice->ChipRevId) != T3_ASIC_REV_5701)
|
||
|
{
|
||
|
Value32 = REG_RD(pDevice, Nvram.Config1);
|
||
|
if((Value32 & FLASH_INTERFACE_ENABLE) == 0)
|
||
|
{
|
||
|
/* Use the new interface to read EEPROM. */
|
||
|
Value32 &= ~FLASH_COMPAT_BYPASS;
|
||
|
|
||
|
REG_WR(pDevice, Nvram.Config1, Value32);
|
||
|
}
|
||
|
}
|
||
|
} /* LM_NvRamInit */
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
STATIC LM_STATUS
|
||
|
LM_EepromRead(
|
||
|
PLM_DEVICE_BLOCK pDevice,
|
||
|
LM_UINT32 Offset,
|
||
|
LM_UINT32 *pData)
|
||
|
{
|
||
|
LM_UINT32 Value32;
|
||
|
LM_UINT32 Addr;
|
||
|
LM_UINT32 Dev;
|
||
|
LM_UINT32 j;
|
||
|
|
||
|
if(Offset > SEEPROM_CHIP_SIZE)
|
||
|
{
|
||
|
return LM_STATUS_FAILURE;
|
||
|
}
|
||
|
|
||
|
Dev = Offset / SEEPROM_CHIP_SIZE;
|
||
|
Addr = Offset % SEEPROM_CHIP_SIZE;
|
||
|
|
||
|
Value32 = REG_RD(pDevice, Grc.EepromAddr);
|
||
|
Value32 &= ~(SEEPROM_ADDR_ADDRESS_MASK | SEEPROM_ADDR_DEV_ID_MASK |
|
||
|
SEEPROM_ADDR_RW_MASK);
|
||
|
REG_WR(pDevice, Grc.EepromAddr, Value32 | SEEPROM_ADDR_DEV_ID(Dev) |
|
||
|
SEEPROM_ADDR_ADDRESS(Addr) | SEEPROM_ADDR_START | SEEPROM_ADDR_READ);
|
||
|
|
||
|
for(j = 0; j < 1000; j++)
|
||
|
{
|
||
|
Value32 = REG_RD(pDevice, Grc.EepromAddr);
|
||
|
if(Value32 & SEEPROM_ADDR_COMPLETE)
|
||
|
{
|
||
|
break;
|
||
|
}
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
|
||
|
if(Value32 & SEEPROM_ADDR_COMPLETE)
|
||
|
{
|
||
|
Value32 = REG_RD(pDevice, Grc.EepromData);
|
||
|
*pData = Value32;
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
}
|
||
|
|
||
|
return LM_STATUS_FAILURE;
|
||
|
} /* LM_EepromRead */
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
STATIC LM_STATUS
|
||
|
LM_NvramRead(
|
||
|
PLM_DEVICE_BLOCK pDevice,
|
||
|
LM_UINT32 Offset,
|
||
|
LM_UINT32 *pData)
|
||
|
{
|
||
|
LM_UINT32 Value32;
|
||
|
LM_STATUS Status;
|
||
|
LM_UINT32 j;
|
||
|
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700 ||
|
||
|
T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5701)
|
||
|
{
|
||
|
Status = LM_EepromRead(pDevice, Offset, pData);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
/* Determine if we have flash or EEPROM. */
|
||
|
Value32 = REG_RD(pDevice, Nvram.Config1);
|
||
|
if(Value32 & FLASH_INTERFACE_ENABLE)
|
||
|
{
|
||
|
if(Value32 & FLASH_SSRAM_BUFFERRED_MODE)
|
||
|
{
|
||
|
Offset = ((Offset/BUFFERED_FLASH_PAGE_SIZE) <<
|
||
|
BUFFERED_FLASH_PAGE_POS) +
|
||
|
(Offset % BUFFERED_FLASH_PAGE_SIZE);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
REG_WR(pDevice, Nvram.SwArb, SW_ARB_REQ_SET1);
|
||
|
for (j = 0; j < 1000; j++)
|
||
|
{
|
||
|
if (REG_RD(pDevice, Nvram.SwArb) & SW_ARB_GNT1)
|
||
|
{
|
||
|
break;
|
||
|
}
|
||
|
MM_Wait(20);
|
||
|
}
|
||
|
if (j == 1000)
|
||
|
{
|
||
|
return LM_STATUS_FAILURE;
|
||
|
}
|
||
|
|
||
|
/* Read from flash or EEPROM with the new 5703/02 interface. */
|
||
|
REG_WR(pDevice, Nvram.Addr, Offset & NVRAM_ADDRESS_MASK);
|
||
|
|
||
|
REG_WR(pDevice, Nvram.Cmd, NVRAM_CMD_RD | NVRAM_CMD_DO_IT |
|
||
|
NVRAM_CMD_FIRST | NVRAM_CMD_LAST | NVRAM_CMD_DONE);
|
||
|
|
||
|
/* Wait for the done bit to clear. */
|
||
|
for(j = 0; j < 500; j++)
|
||
|
{
|
||
|
MM_Wait(10);
|
||
|
|
||
|
Value32 = REG_RD(pDevice, Nvram.Cmd);
|
||
|
if(!(Value32 & NVRAM_CMD_DONE))
|
||
|
{
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Wait for the done bit. */
|
||
|
if(!(Value32 & NVRAM_CMD_DONE))
|
||
|
{
|
||
|
for(j = 0; j < 500; j++)
|
||
|
{
|
||
|
MM_Wait(10);
|
||
|
|
||
|
Value32 = REG_RD(pDevice, Nvram.Cmd);
|
||
|
if(Value32 & NVRAM_CMD_DONE)
|
||
|
{
|
||
|
MM_Wait(10);
|
||
|
|
||
|
*pData = REG_RD(pDevice, Nvram.ReadData);
|
||
|
|
||
|
/* Change the endianess. */
|
||
|
*pData = ((*pData & 0xff) << 24)| ((*pData & 0xff00) << 8)|
|
||
|
((*pData & 0xff0000) >> 8) | ((*pData >> 24) & 0xff);
|
||
|
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
REG_WR(pDevice, Nvram.SwArb, SW_ARB_REQ_CLR1);
|
||
|
if(Value32 & NVRAM_CMD_DONE)
|
||
|
{
|
||
|
Status = LM_STATUS_SUCCESS;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
Status = LM_STATUS_FAILURE;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return Status;
|
||
|
} /* LM_NvramRead */
|
||
|
|
||
|
|
||
|
STATIC void
|
||
|
LM_ReadVPD(PLM_DEVICE_BLOCK pDevice)
|
||
|
{
|
||
|
LM_UINT32 Vpd_arr[256/4];
|
||
|
LM_UINT8 *Vpd = (LM_UINT8 *) &Vpd_arr[0];
|
||
|
LM_UINT32 *Vpd_dptr = &Vpd_arr[0];
|
||
|
LM_UINT32 Value32;
|
||
|
unsigned int j;
|
||
|
|
||
|
/* Read PN from VPD */
|
||
|
for (j = 0; j < 256; j += 4, Vpd_dptr++ )
|
||
|
{
|
||
|
if (LM_NvramRead(pDevice, 0x100 + j, &Value32) != LM_STATUS_SUCCESS) {
|
||
|
printf("BCM570x: LM_ReadVPD: VPD read failed"
|
||
|
" (no EEPROM onboard)\n");
|
||
|
return;
|
||
|
}
|
||
|
*Vpd_dptr = cpu_to_le32(Value32);
|
||
|
}
|
||
|
for (j = 0; j < 256; )
|
||
|
{
|
||
|
unsigned int Vpd_r_len;
|
||
|
unsigned int Vpd_r_end;
|
||
|
|
||
|
if ((Vpd[j] == 0x82) || (Vpd[j] == 0x91))
|
||
|
{
|
||
|
j = j + 3 + Vpd[j + 1] + (Vpd[j + 2] << 8);
|
||
|
}
|
||
|
else if (Vpd[j] == 0x90)
|
||
|
{
|
||
|
Vpd_r_len = Vpd[j + 1] + (Vpd[j + 2] << 8);
|
||
|
j += 3;
|
||
|
Vpd_r_end = Vpd_r_len + j;
|
||
|
while (j < Vpd_r_end)
|
||
|
{
|
||
|
if ((Vpd[j] == 'P') && (Vpd[j + 1] == 'N'))
|
||
|
{
|
||
|
unsigned int len = Vpd[j + 2];
|
||
|
|
||
|
if (len <= 24)
|
||
|
{
|
||
|
memcpy(pDevice->PartNo, &Vpd[j + 3], len);
|
||
|
}
|
||
|
break;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if (Vpd[j + 2] == 0)
|
||
|
{
|
||
|
break;
|
||
|
}
|
||
|
j = j + Vpd[j + 2];
|
||
|
}
|
||
|
}
|
||
|
break;
|
||
|
}
|
||
|
else {
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
STATIC void
|
||
|
LM_ReadBootCodeVersion(PLM_DEVICE_BLOCK pDevice)
|
||
|
{
|
||
|
LM_UINT32 Value32, offset, ver_offset;
|
||
|
int i;
|
||
|
|
||
|
if (LM_NvramRead(pDevice, 0x0, &Value32) != LM_STATUS_SUCCESS)
|
||
|
return;
|
||
|
if (Value32 != 0xaa559966)
|
||
|
return;
|
||
|
if (LM_NvramRead(pDevice, 0xc, &offset) != LM_STATUS_SUCCESS)
|
||
|
return;
|
||
|
|
||
|
offset = ((offset & 0xff) << 24)| ((offset & 0xff00) << 8)|
|
||
|
((offset & 0xff0000) >> 8) | ((offset >> 24) & 0xff);
|
||
|
if (LM_NvramRead(pDevice, offset, &Value32) != LM_STATUS_SUCCESS)
|
||
|
return;
|
||
|
if ((Value32 == 0x0300000e) &&
|
||
|
(LM_NvramRead(pDevice, offset + 4, &Value32) == LM_STATUS_SUCCESS) &&
|
||
|
(Value32 == 0)) {
|
||
|
|
||
|
if (LM_NvramRead(pDevice, offset + 8, &ver_offset) != LM_STATUS_SUCCESS)
|
||
|
return;
|
||
|
ver_offset = ((ver_offset & 0xff0000) >> 8) |
|
||
|
((ver_offset >> 24) & 0xff);
|
||
|
for (i = 0; i < 16; i += 4) {
|
||
|
if (LM_NvramRead(pDevice, offset + ver_offset + i, &Value32) !=
|
||
|
LM_STATUS_SUCCESS)
|
||
|
{
|
||
|
return;
|
||
|
}
|
||
|
*((LM_UINT32 *) &pDevice->BootCodeVer[i]) = cpu_to_le32(Value32);
|
||
|
}
|
||
|
}
|
||
|
else {
|
||
|
char c;
|
||
|
|
||
|
if (LM_NvramRead(pDevice, 0x94, &Value32) != LM_STATUS_SUCCESS)
|
||
|
return;
|
||
|
|
||
|
i = 0;
|
||
|
c = ((Value32 & 0xff0000) >> 16);
|
||
|
|
||
|
if (c < 10) {
|
||
|
pDevice->BootCodeVer[i++] = c + '0';
|
||
|
}
|
||
|
else {
|
||
|
pDevice->BootCodeVer[i++] = (c / 10) + '0';
|
||
|
pDevice->BootCodeVer[i++] = (c % 10) + '0';
|
||
|
}
|
||
|
pDevice->BootCodeVer[i++] = '.';
|
||
|
c = (Value32 & 0xff000000) >> 24;
|
||
|
if (c < 10) {
|
||
|
pDevice->BootCodeVer[i++] = c + '0';
|
||
|
}
|
||
|
else {
|
||
|
pDevice->BootCodeVer[i++] = (c / 10) + '0';
|
||
|
pDevice->BootCodeVer[i++] = (c % 10) + '0';
|
||
|
}
|
||
|
pDevice->BootCodeVer[i] = 0;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
STATIC void
|
||
|
LM_GetBusSpeed(PLM_DEVICE_BLOCK pDevice)
|
||
|
{
|
||
|
LM_UINT32 PciState = pDevice->PciState;
|
||
|
LM_UINT32 ClockCtrl;
|
||
|
char *SpeedStr = "";
|
||
|
|
||
|
if (PciState & T3_PCI_STATE_32BIT_PCI_BUS)
|
||
|
{
|
||
|
strcpy(pDevice->BusSpeedStr, "32-bit ");
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
strcpy(pDevice->BusSpeedStr, "64-bit ");
|
||
|
}
|
||
|
if (PciState & T3_PCI_STATE_CONVENTIONAL_PCI_MODE)
|
||
|
{
|
||
|
strcat(pDevice->BusSpeedStr, "PCI ");
|
||
|
if (PciState & T3_PCI_STATE_HIGH_BUS_SPEED)
|
||
|
{
|
||
|
SpeedStr = "66MHz";
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
SpeedStr = "33MHz";
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
strcat(pDevice->BusSpeedStr, "PCIX ");
|
||
|
if (pDevice->BondId == GRC_MISC_BD_ID_5704CIOBE)
|
||
|
{
|
||
|
SpeedStr = "133MHz";
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
ClockCtrl = REG_RD(pDevice, PciCfg.ClockCtrl) & 0x1f;
|
||
|
switch (ClockCtrl)
|
||
|
{
|
||
|
case 0:
|
||
|
SpeedStr = "33MHz";
|
||
|
break;
|
||
|
|
||
|
case 2:
|
||
|
SpeedStr = "50MHz";
|
||
|
break;
|
||
|
|
||
|
case 4:
|
||
|
SpeedStr = "66MHz";
|
||
|
break;
|
||
|
|
||
|
case 6:
|
||
|
SpeedStr = "100MHz";
|
||
|
break;
|
||
|
|
||
|
case 7:
|
||
|
SpeedStr = "133MHz";
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
strcat(pDevice->BusSpeedStr, SpeedStr);
|
||
|
}
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* This routine initializes default parameters and reads the PCI */
|
||
|
/* configurations. */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/* LM_STATUS_SUCCESS */
|
||
|
/******************************************************************************/
|
||
|
LM_STATUS
|
||
|
LM_GetAdapterInfo(
|
||
|
PLM_DEVICE_BLOCK pDevice)
|
||
|
{
|
||
|
PLM_ADAPTER_INFO pAdapterInfo;
|
||
|
LM_UINT32 Value32;
|
||
|
LM_STATUS Status;
|
||
|
LM_UINT32 j;
|
||
|
LM_UINT32 EeSigFound;
|
||
|
LM_UINT32 EePhyTypeSerdes = 0;
|
||
|
LM_UINT32 EePhyLedMode = 0;
|
||
|
LM_UINT32 EePhyId = 0;
|
||
|
|
||
|
/* Get Device Id and Vendor Id */
|
||
|
Status = MM_ReadConfig32(pDevice, PCI_VENDOR_ID_REG, &Value32);
|
||
|
if(Status != LM_STATUS_SUCCESS)
|
||
|
{
|
||
|
return Status;
|
||
|
}
|
||
|
pDevice->PciVendorId = (LM_UINT16) Value32;
|
||
|
pDevice->PciDeviceId = (LM_UINT16) (Value32 >> 16);
|
||
|
|
||
|
/* If we are not getting the write adapter, exit. */
|
||
|
if((Value32 != T3_PCI_ID_BCM5700) &&
|
||
|
(Value32 != T3_PCI_ID_BCM5701) &&
|
||
|
(Value32 != T3_PCI_ID_BCM5702) &&
|
||
|
(Value32 != T3_PCI_ID_BCM5702x) &&
|
||
|
(Value32 != T3_PCI_ID_BCM5702FE) &&
|
||
|
(Value32 != T3_PCI_ID_BCM5703) &&
|
||
|
(Value32 != T3_PCI_ID_BCM5703x) &&
|
||
|
(Value32 != T3_PCI_ID_BCM5704))
|
||
|
{
|
||
|
return LM_STATUS_FAILURE;
|
||
|
}
|
||
|
|
||
|
Status = MM_ReadConfig32(pDevice, PCI_REV_ID_REG, &Value32);
|
||
|
if(Status != LM_STATUS_SUCCESS)
|
||
|
{
|
||
|
return Status;
|
||
|
}
|
||
|
pDevice->PciRevId = (LM_UINT8) Value32;
|
||
|
|
||
|
/* Get IRQ. */
|
||
|
Status = MM_ReadConfig32(pDevice, PCI_INT_LINE_REG, &Value32);
|
||
|
if(Status != LM_STATUS_SUCCESS)
|
||
|
{
|
||
|
return Status;
|
||
|
}
|
||
|
pDevice->Irq = (LM_UINT8) Value32;
|
||
|
|
||
|
/* Get interrupt pin. */
|
||
|
pDevice->IntPin = (LM_UINT8) (Value32 >> 8);
|
||
|
|
||
|
/* Get chip revision id. */
|
||
|
Status = MM_ReadConfig32(pDevice, T3_PCI_MISC_HOST_CTRL_REG, &Value32);
|
||
|
pDevice->ChipRevId = Value32 >> 16;
|
||
|
|
||
|
/* Get subsystem vendor. */
|
||
|
Status = MM_ReadConfig32(pDevice, PCI_SUBSYSTEM_VENDOR_ID_REG, &Value32);
|
||
|
if(Status != LM_STATUS_SUCCESS)
|
||
|
{
|
||
|
return Status;
|
||
|
}
|
||
|
pDevice->SubsystemVendorId = (LM_UINT16) Value32;
|
||
|
|
||
|
/* Get PCI subsystem id. */
|
||
|
pDevice->SubsystemId = (LM_UINT16) (Value32 >> 16);
|
||
|
|
||
|
/* Get the cache line size. */
|
||
|
MM_ReadConfig32(pDevice, PCI_CACHE_LINE_SIZE_REG, &Value32);
|
||
|
pDevice->CacheLineSize = (LM_UINT8) Value32;
|
||
|
pDevice->SavedCacheLineReg = Value32;
|
||
|
|
||
|
if(pDevice->ChipRevId != T3_CHIP_ID_5703_A1 &&
|
||
|
pDevice->ChipRevId != T3_CHIP_ID_5703_A2 &&
|
||
|
pDevice->ChipRevId != T3_CHIP_ID_5704_A0)
|
||
|
{
|
||
|
pDevice->UndiFix = FALSE;
|
||
|
}
|
||
|
#if !PCIX_TARGET_WORKAROUND
|
||
|
pDevice->UndiFix = FALSE;
|
||
|
#endif
|
||
|
/* Map the memory base to system address space. */
|
||
|
if (!pDevice->UndiFix)
|
||
|
{
|
||
|
Status = MM_MapMemBase(pDevice);
|
||
|
if(Status != LM_STATUS_SUCCESS)
|
||
|
{
|
||
|
return Status;
|
||
|
}
|
||
|
/* Initialize the memory view pointer. */
|
||
|
pDevice->pMemView = (PT3_STD_MEM_MAP) pDevice->pMappedMemBase;
|
||
|
}
|
||
|
|
||
|
#if PCIX_TARGET_WORKAROUND
|
||
|
/* store whether we are in PCI are PCI-X mode */
|
||
|
pDevice->EnablePciXFix = FALSE;
|
||
|
|
||
|
MM_ReadConfig32(pDevice, T3_PCI_STATE_REG, &Value32);
|
||
|
if((Value32 & T3_PCI_STATE_CONVENTIONAL_PCI_MODE) == 0)
|
||
|
{
|
||
|
/* Enable PCI-X workaround only if we are running on 5700 BX. */
|
||
|
if(T3_CHIP_REV(pDevice->ChipRevId) == T3_CHIP_REV_5700_BX)
|
||
|
{
|
||
|
pDevice->EnablePciXFix = TRUE;
|
||
|
}
|
||
|
}
|
||
|
if (pDevice->UndiFix)
|
||
|
{
|
||
|
pDevice->EnablePciXFix = TRUE;
|
||
|
}
|
||
|
#endif
|
||
|
/* Bx bug: due to the "byte_enable bug" in PCI-X mode, the power */
|
||
|
/* management register may be clobbered which may cause the */
|
||
|
/* BCM5700 to go into D3 state. While in this state, we will */
|
||
|
/* not have memory mapped register access. As a workaround, we */
|
||
|
/* need to restore the device to D0 state. */
|
||
|
MM_ReadConfig32(pDevice, T3_PCI_PM_STATUS_CTRL_REG, &Value32);
|
||
|
Value32 |= T3_PM_PME_ASSERTED;
|
||
|
Value32 &= ~T3_PM_POWER_STATE_MASK;
|
||
|
Value32 |= T3_PM_POWER_STATE_D0;
|
||
|
MM_WriteConfig32(pDevice, T3_PCI_PM_STATUS_CTRL_REG, Value32);
|
||
|
|
||
|
/* read the current PCI command word */
|
||
|
MM_ReadConfig32(pDevice, PCI_COMMAND_REG, &Value32);
|
||
|
|
||
|
/* Make sure bus-mastering is enabled. */
|
||
|
Value32 |= PCI_BUSMASTER_ENABLE;
|
||
|
|
||
|
#if PCIX_TARGET_WORKAROUND
|
||
|
/* if we are in PCI-X mode, also make sure mem-mapping and SERR#/PERR#
|
||
|
are enabled */
|
||
|
if (pDevice->EnablePciXFix == TRUE) {
|
||
|
Value32 |= (PCI_MEM_SPACE_ENABLE | PCI_SYSTEM_ERROR_ENABLE |
|
||
|
PCI_PARITY_ERROR_ENABLE);
|
||
|
}
|
||
|
if (pDevice->UndiFix)
|
||
|
{
|
||
|
Value32 &= ~PCI_MEM_SPACE_ENABLE;
|
||
|
}
|
||
|
|
||
|
#endif
|
||
|
|
||
|
if(pDevice->EnableMWI)
|
||
|
{
|
||
|
Value32 |= PCI_MEMORY_WRITE_INVALIDATE;
|
||
|
}
|
||
|
else {
|
||
|
Value32 &= (~PCI_MEMORY_WRITE_INVALIDATE);
|
||
|
}
|
||
|
|
||
|
/* Error out if mem-mapping is NOT enabled for PCI systems */
|
||
|
if (!(Value32 | PCI_MEM_SPACE_ENABLE))
|
||
|
{
|
||
|
return LM_STATUS_FAILURE;
|
||
|
}
|
||
|
|
||
|
/* save the value we are going to write into the PCI command word */
|
||
|
pDevice->PciCommandStatusWords = Value32;
|
||
|
|
||
|
Status = MM_WriteConfig32(pDevice, PCI_COMMAND_REG, Value32);
|
||
|
if(Status != LM_STATUS_SUCCESS)
|
||
|
{
|
||
|
return Status;
|
||
|
}
|
||
|
|
||
|
/* Set power state to D0. */
|
||
|
LM_SetPowerState(pDevice, LM_POWER_STATE_D0);
|
||
|
|
||
|
#ifdef BIG_ENDIAN_PCI
|
||
|
pDevice->MiscHostCtrl =
|
||
|
MISC_HOST_CTRL_MASK_PCI_INT |
|
||
|
MISC_HOST_CTRL_ENABLE_INDIRECT_ACCESS |
|
||
|
MISC_HOST_CTRL_ENABLE_ENDIAN_WORD_SWAP |
|
||
|
MISC_HOST_CTRL_ENABLE_PCI_STATE_REG_RW;
|
||
|
#else /* No CPU Swap modes for PCI IO */
|
||
|
|
||
|
/* Setup the mode registers. */
|
||
|
pDevice->MiscHostCtrl =
|
||
|
MISC_HOST_CTRL_MASK_PCI_INT |
|
||
|
MISC_HOST_CTRL_ENABLE_ENDIAN_WORD_SWAP |
|
||
|
#ifdef BIG_ENDIAN_HOST
|
||
|
MISC_HOST_CTRL_ENABLE_ENDIAN_BYTE_SWAP |
|
||
|
#endif /* BIG_ENDIAN_HOST */
|
||
|
MISC_HOST_CTRL_ENABLE_INDIRECT_ACCESS |
|
||
|
MISC_HOST_CTRL_ENABLE_PCI_STATE_REG_RW;
|
||
|
#endif /* !BIG_ENDIAN_PCI */
|
||
|
|
||
|
/* write to PCI misc host ctr first in order to enable indirect accesses */
|
||
|
MM_WriteConfig32(pDevice, T3_PCI_MISC_HOST_CTRL_REG, pDevice->MiscHostCtrl);
|
||
|
|
||
|
REG_WR(pDevice, PciCfg.MiscHostCtrl, pDevice->MiscHostCtrl);
|
||
|
|
||
|
#ifdef BIG_ENDIAN_PCI
|
||
|
Value32 = GRC_MODE_WORD_SWAP_DATA|
|
||
|
GRC_MODE_WORD_SWAP_NON_FRAME_DATA;
|
||
|
#else
|
||
|
/* No CPU Swap modes for PCI IO */
|
||
|
#ifdef BIG_ENDIAN_HOST
|
||
|
Value32 = GRC_MODE_BYTE_SWAP_NON_FRAME_DATA |
|
||
|
GRC_MODE_WORD_SWAP_NON_FRAME_DATA;
|
||
|
#else
|
||
|
Value32 = GRC_MODE_BYTE_SWAP_NON_FRAME_DATA | GRC_MODE_BYTE_SWAP_DATA;
|
||
|
#endif
|
||
|
#endif /* !BIG_ENDIAN_PCI */
|
||
|
|
||
|
REG_WR(pDevice, Grc.Mode, Value32);
|
||
|
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700)
|
||
|
{
|
||
|
REG_WR(pDevice, Grc.LocalCtrl, GRC_MISC_LOCAL_CTRL_GPIO_OUTPUT1 |
|
||
|
GRC_MISC_LOCAL_CTRL_GPIO_OE1);
|
||
|
}
|
||
|
MM_Wait(40);
|
||
|
|
||
|
/* Enable indirect memory access */
|
||
|
REG_WR(pDevice, MemArbiter.Mode, T3_MEM_ARBITER_MODE_ENABLE);
|
||
|
|
||
|
if (REG_RD(pDevice, PciCfg.ClockCtrl) & T3_PCI_44MHZ_CORE_CLOCK)
|
||
|
{
|
||
|
REG_WR(pDevice, PciCfg.ClockCtrl, T3_PCI_44MHZ_CORE_CLOCK |
|
||
|
T3_PCI_SELECT_ALTERNATE_CLOCK);
|
||
|
REG_WR(pDevice, PciCfg.ClockCtrl, T3_PCI_SELECT_ALTERNATE_CLOCK);
|
||
|
MM_Wait(40); /* required delay is 27usec */
|
||
|
}
|
||
|
REG_WR(pDevice, PciCfg.ClockCtrl, 0);
|
||
|
REG_WR(pDevice, PciCfg.MemWindowBaseAddr, 0);
|
||
|
|
||
|
#if PCIX_TARGET_WORKAROUND
|
||
|
MM_ReadConfig32(pDevice, T3_PCI_STATE_REG, &Value32);
|
||
|
if ((pDevice->EnablePciXFix == FALSE) &&
|
||
|
((Value32 & T3_PCI_STATE_CONVENTIONAL_PCI_MODE) == 0))
|
||
|
{
|
||
|
if (pDevice->ChipRevId == T3_CHIP_ID_5701_A0 ||
|
||
|
pDevice->ChipRevId == T3_CHIP_ID_5701_B0 ||
|
||
|
pDevice->ChipRevId == T3_CHIP_ID_5701_B2 ||
|
||
|
pDevice->ChipRevId == T3_CHIP_ID_5701_B5)
|
||
|
{
|
||
|
__raw_writel(0, &(pDevice->pMemView->uIntMem.MemBlock32K[0x300]));
|
||
|
__raw_writel(0, &(pDevice->pMemView->uIntMem.MemBlock32K[0x301]));
|
||
|
__raw_writel(0xffffffff, &(pDevice->pMemView->uIntMem.MemBlock32K[0x301]));
|
||
|
if (__raw_readl(&(pDevice->pMemView->uIntMem.MemBlock32K[0x300])))
|
||
|
{
|
||
|
pDevice->EnablePciXFix = TRUE;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
#endif
|
||
|
#if 1
|
||
|
/*
|
||
|
* This code was at the beginning of else block below, but that's
|
||
|
* a bug if node address in shared memory.
|
||
|
*/
|
||
|
MM_Wait(50);
|
||
|
LM_NvramInit(pDevice);
|
||
|
#endif
|
||
|
/* Get the node address. First try to get in from the shared memory. */
|
||
|
/* If the signature is not present, then get it from the NVRAM. */
|
||
|
Value32 = MEM_RD_OFFSET(pDevice, T3_MAC_ADDR_HIGH_MAILBOX);
|
||
|
if((Value32 >> 16) == 0x484b)
|
||
|
{
|
||
|
|
||
|
pDevice->NodeAddress[0] = (LM_UINT8) (Value32 >> 8);
|
||
|
pDevice->NodeAddress[1] = (LM_UINT8) Value32;
|
||
|
|
||
|
Value32 = MEM_RD_OFFSET(pDevice, T3_MAC_ADDR_LOW_MAILBOX);
|
||
|
|
||
|
pDevice->NodeAddress[2] = (LM_UINT8) (Value32 >> 24);
|
||
|
pDevice->NodeAddress[3] = (LM_UINT8) (Value32 >> 16);
|
||
|
pDevice->NodeAddress[4] = (LM_UINT8) (Value32 >> 8);
|
||
|
pDevice->NodeAddress[5] = (LM_UINT8) Value32;
|
||
|
|
||
|
Status = LM_STATUS_SUCCESS;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
Status = LM_NvramRead(pDevice, 0x7c, &Value32);
|
||
|
if(Status == LM_STATUS_SUCCESS)
|
||
|
{
|
||
|
pDevice->NodeAddress[0] = (LM_UINT8) (Value32 >> 16);
|
||
|
pDevice->NodeAddress[1] = (LM_UINT8) (Value32 >> 24);
|
||
|
|
||
|
Status = LM_NvramRead(pDevice, 0x80, &Value32);
|
||
|
|
||
|
pDevice->NodeAddress[2] = (LM_UINT8) Value32;
|
||
|
pDevice->NodeAddress[3] = (LM_UINT8) (Value32 >> 8);
|
||
|
pDevice->NodeAddress[4] = (LM_UINT8) (Value32 >> 16);
|
||
|
pDevice->NodeAddress[5] = (LM_UINT8) (Value32 >> 24);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Assign a default address. */
|
||
|
if(Status != LM_STATUS_SUCCESS)
|
||
|
{
|
||
|
#ifndef EMBEDDED
|
||
|
printk(KERN_ERR "Cannot get MAC addr from NVRAM. Using default.\n");
|
||
|
#endif
|
||
|
pDevice->NodeAddress[0] = 0x00; pDevice->NodeAddress[1] = 0x10;
|
||
|
pDevice->NodeAddress[2] = 0x18; pDevice->NodeAddress[3] = 0x68;
|
||
|
pDevice->NodeAddress[4] = 0x61; pDevice->NodeAddress[5] = 0x76;
|
||
|
}
|
||
|
|
||
|
pDevice->PermanentNodeAddress[0] = pDevice->NodeAddress[0];
|
||
|
pDevice->PermanentNodeAddress[1] = pDevice->NodeAddress[1];
|
||
|
pDevice->PermanentNodeAddress[2] = pDevice->NodeAddress[2];
|
||
|
pDevice->PermanentNodeAddress[3] = pDevice->NodeAddress[3];
|
||
|
pDevice->PermanentNodeAddress[4] = pDevice->NodeAddress[4];
|
||
|
pDevice->PermanentNodeAddress[5] = pDevice->NodeAddress[5];
|
||
|
|
||
|
/* Initialize the default values. */
|
||
|
pDevice->NoTxPseudoHdrChksum = FALSE;
|
||
|
pDevice->NoRxPseudoHdrChksum = FALSE;
|
||
|
pDevice->NicSendBd = FALSE;
|
||
|
pDevice->TxPacketDescCnt = DEFAULT_TX_PACKET_DESC_COUNT;
|
||
|
pDevice->RxStdDescCnt = DEFAULT_STD_RCV_DESC_COUNT;
|
||
|
pDevice->RxCoalescingTicks = DEFAULT_RX_COALESCING_TICKS;
|
||
|
pDevice->TxCoalescingTicks = DEFAULT_TX_COALESCING_TICKS;
|
||
|
pDevice->RxMaxCoalescedFrames = DEFAULT_RX_MAX_COALESCED_FRAMES;
|
||
|
pDevice->TxMaxCoalescedFrames = DEFAULT_TX_MAX_COALESCED_FRAMES;
|
||
|
pDevice->RxCoalescingTicksDuringInt = BAD_DEFAULT_VALUE;
|
||
|
pDevice->TxCoalescingTicksDuringInt = BAD_DEFAULT_VALUE;
|
||
|
pDevice->RxMaxCoalescedFramesDuringInt = BAD_DEFAULT_VALUE;
|
||
|
pDevice->TxMaxCoalescedFramesDuringInt = BAD_DEFAULT_VALUE;
|
||
|
pDevice->StatsCoalescingTicks = DEFAULT_STATS_COALESCING_TICKS;
|
||
|
pDevice->EnableMWI = FALSE;
|
||
|
pDevice->TxMtu = MAX_ETHERNET_PACKET_SIZE_NO_CRC;
|
||
|
pDevice->RxMtu = MAX_ETHERNET_PACKET_SIZE_NO_CRC;
|
||
|
pDevice->DisableAutoNeg = FALSE;
|
||
|
pDevice->PhyIntMode = T3_PHY_INT_MODE_AUTO;
|
||
|
pDevice->LinkChngMode = T3_LINK_CHNG_MODE_AUTO;
|
||
|
pDevice->LedMode = LED_MODE_AUTO;
|
||
|
pDevice->ResetPhyOnInit = TRUE;
|
||
|
pDevice->DelayPciGrant = TRUE;
|
||
|
pDevice->UseTaggedStatus = FALSE;
|
||
|
pDevice->OneDmaAtOnce = BAD_DEFAULT_VALUE;
|
||
|
|
||
|
pDevice->DmaMbufLowMark = T3_DEF_DMA_MBUF_LOW_WMARK_JUMBO;
|
||
|
pDevice->RxMacMbufLowMark = T3_DEF_RX_MAC_MBUF_LOW_WMARK_JUMBO;
|
||
|
pDevice->MbufHighMark = T3_DEF_MBUF_HIGH_WMARK_JUMBO;
|
||
|
|
||
|
pDevice->RequestedMediaType = LM_REQUESTED_MEDIA_TYPE_AUTO;
|
||
|
pDevice->TaskOffloadCap = LM_TASK_OFFLOAD_NONE;
|
||
|
pDevice->FlowControlCap = LM_FLOW_CONTROL_AUTO_PAUSE;
|
||
|
pDevice->EnableTbi = FALSE;
|
||
|
#if INCLUDE_TBI_SUPPORT
|
||
|
pDevice->PollTbiLink = BAD_DEFAULT_VALUE;
|
||
|
#endif
|
||
|
|
||
|
switch (T3_ASIC_REV(pDevice->ChipRevId))
|
||
|
{
|
||
|
case T3_ASIC_REV_5704:
|
||
|
pDevice->MbufBase = T3_NIC_MBUF_POOL_ADDR;
|
||
|
pDevice->MbufSize = T3_NIC_MBUF_POOL_SIZE64;
|
||
|
break;
|
||
|
default:
|
||
|
pDevice->MbufBase = T3_NIC_MBUF_POOL_ADDR;
|
||
|
pDevice->MbufSize = T3_NIC_MBUF_POOL_SIZE96;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
pDevice->LinkStatus = LM_STATUS_LINK_DOWN;
|
||
|
pDevice->QueueRxPackets = TRUE;
|
||
|
|
||
|
pDevice->EnableWireSpeed = TRUE;
|
||
|
|
||
|
#if T3_JUMBO_RCV_RCB_ENTRY_COUNT
|
||
|
pDevice->RxJumboDescCnt = DEFAULT_JUMBO_RCV_DESC_COUNT;
|
||
|
#endif /* T3_JUMBO_RCV_RCB_ENTRY_COUNT */
|
||
|
|
||
|
/* Make this is a known adapter. */
|
||
|
pAdapterInfo = LM_GetAdapterInfoBySsid(pDevice->SubsystemVendorId,
|
||
|
pDevice->SubsystemId);
|
||
|
|
||
|
pDevice->BondId = REG_RD(pDevice, Grc.MiscCfg) & GRC_MISC_BD_ID_MASK;
|
||
|
if (pDevice->BondId != GRC_MISC_BD_ID_5700 &&
|
||
|
pDevice->BondId != GRC_MISC_BD_ID_5701 &&
|
||
|
pDevice->BondId != GRC_MISC_BD_ID_5702FE &&
|
||
|
pDevice->BondId != GRC_MISC_BD_ID_5703 &&
|
||
|
pDevice->BondId != GRC_MISC_BD_ID_5703S &&
|
||
|
pDevice->BondId != GRC_MISC_BD_ID_5704 &&
|
||
|
pDevice->BondId != GRC_MISC_BD_ID_5704CIOBE)
|
||
|
{
|
||
|
return LM_STATUS_UNKNOWN_ADAPTER;
|
||
|
}
|
||
|
|
||
|
pDevice->SplitModeEnable = SPLIT_MODE_DISABLE;
|
||
|
if ((pDevice->ChipRevId == T3_CHIP_ID_5704_A0) &&
|
||
|
(pDevice->BondId == GRC_MISC_BD_ID_5704CIOBE))
|
||
|
{
|
||
|
pDevice->SplitModeEnable = SPLIT_MODE_ENABLE;
|
||
|
pDevice->SplitModeMaxReq = SPLIT_MODE_5704_MAX_REQ;
|
||
|
}
|
||
|
|
||
|
/* Get Eeprom info. */
|
||
|
Value32 = MEM_RD_OFFSET(pDevice, T3_NIC_DATA_SIG_ADDR);
|
||
|
if (Value32 == T3_NIC_DATA_SIG)
|
||
|
{
|
||
|
EeSigFound = TRUE;
|
||
|
Value32 = MEM_RD_OFFSET(pDevice, T3_NIC_DATA_NIC_CFG_ADDR);
|
||
|
|
||
|
/* Determine PHY type. */
|
||
|
switch (Value32 & T3_NIC_CFG_PHY_TYPE_MASK)
|
||
|
{
|
||
|
case T3_NIC_CFG_PHY_TYPE_COPPER:
|
||
|
EePhyTypeSerdes = FALSE;
|
||
|
break;
|
||
|
|
||
|
case T3_NIC_CFG_PHY_TYPE_FIBER:
|
||
|
EePhyTypeSerdes = TRUE;
|
||
|
break;
|
||
|
|
||
|
default:
|
||
|
EePhyTypeSerdes = FALSE;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
/* Determine PHY led mode. */
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700 ||
|
||
|
T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5701)
|
||
|
{
|
||
|
switch(Value32 & T3_NIC_CFG_LED_MODE_MASK)
|
||
|
{
|
||
|
case T3_NIC_CFG_LED_MODE_TRIPLE_SPEED:
|
||
|
EePhyLedMode = LED_MODE_THREE_LINK;
|
||
|
break;
|
||
|
|
||
|
case T3_NIC_CFG_LED_MODE_LINK_SPEED:
|
||
|
EePhyLedMode = LED_MODE_LINK10;
|
||
|
break;
|
||
|
|
||
|
default:
|
||
|
EePhyLedMode = LED_MODE_AUTO;
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
switch(Value32 & T3_NIC_CFG_LED_MODE_MASK)
|
||
|
{
|
||
|
case T3_NIC_CFG_LED_MODE_OPEN_DRAIN:
|
||
|
EePhyLedMode = LED_MODE_OPEN_DRAIN;
|
||
|
break;
|
||
|
|
||
|
case T3_NIC_CFG_LED_MODE_OUTPUT:
|
||
|
EePhyLedMode = LED_MODE_OUTPUT;
|
||
|
break;
|
||
|
|
||
|
default:
|
||
|
EePhyLedMode = LED_MODE_AUTO;
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
if(pDevice->ChipRevId == T3_CHIP_ID_5703_A1 ||
|
||
|
pDevice->ChipRevId == T3_CHIP_ID_5703_A2)
|
||
|
{
|
||
|
/* Enable EEPROM write protection. */
|
||
|
if(Value32 & T3_NIC_EEPROM_WP)
|
||
|
{
|
||
|
pDevice->EepromWp = TRUE;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Get the PHY Id. */
|
||
|
Value32 = MEM_RD_OFFSET(pDevice, T3_NIC_DATA_PHY_ID_ADDR);
|
||
|
if (Value32)
|
||
|
{
|
||
|
EePhyId = (((Value32 & T3_NIC_PHY_ID1_MASK) >> 16) &
|
||
|
PHY_ID1_OUI_MASK) << 10;
|
||
|
|
||
|
Value32 = Value32 & T3_NIC_PHY_ID2_MASK;
|
||
|
|
||
|
EePhyId |= ((Value32 & PHY_ID2_OUI_MASK) << 16) |
|
||
|
(Value32 & PHY_ID2_MODEL_MASK) | (Value32 & PHY_ID2_REV_MASK);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
EePhyId = 0;
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
EeSigFound = FALSE;
|
||
|
}
|
||
|
|
||
|
/* Set the PHY address. */
|
||
|
pDevice->PhyAddr = PHY_DEVICE_ID;
|
||
|
|
||
|
/* Disable auto polling. */
|
||
|
pDevice->MiMode = 0xc0000;
|
||
|
REG_WR(pDevice, MacCtrl.MiMode, pDevice->MiMode);
|
||
|
MM_Wait(40);
|
||
|
|
||
|
/* Get the PHY id. */
|
||
|
LM_ReadPhy(pDevice, PHY_ID1_REG, &Value32);
|
||
|
pDevice->PhyId = (Value32 & PHY_ID1_OUI_MASK) << 10;
|
||
|
|
||
|
LM_ReadPhy(pDevice, PHY_ID2_REG, &Value32);
|
||
|
pDevice->PhyId |= ((Value32 & PHY_ID2_OUI_MASK) << 16) |
|
||
|
(Value32 & PHY_ID2_MODEL_MASK) | (Value32 & PHY_ID2_REV_MASK);
|
||
|
|
||
|
/* Set the EnableTbi flag to false if we have a copper PHY. */
|
||
|
switch(pDevice->PhyId & PHY_ID_MASK)
|
||
|
{
|
||
|
case PHY_BCM5400_PHY_ID:
|
||
|
pDevice->EnableTbi = FALSE;
|
||
|
break;
|
||
|
|
||
|
case PHY_BCM5401_PHY_ID:
|
||
|
pDevice->EnableTbi = FALSE;
|
||
|
break;
|
||
|
|
||
|
case PHY_BCM5411_PHY_ID:
|
||
|
pDevice->EnableTbi = FALSE;
|
||
|
break;
|
||
|
|
||
|
case PHY_BCM5701_PHY_ID:
|
||
|
pDevice->EnableTbi = FALSE;
|
||
|
break;
|
||
|
|
||
|
case PHY_BCM5703_PHY_ID:
|
||
|
pDevice->EnableTbi = FALSE;
|
||
|
break;
|
||
|
|
||
|
case PHY_BCM5704_PHY_ID:
|
||
|
pDevice->EnableTbi = FALSE;
|
||
|
break;
|
||
|
|
||
|
case PHY_BCM8002_PHY_ID:
|
||
|
pDevice->EnableTbi = TRUE;
|
||
|
break;
|
||
|
|
||
|
default:
|
||
|
|
||
|
if (pAdapterInfo)
|
||
|
{
|
||
|
pDevice->PhyId = pAdapterInfo->PhyId;
|
||
|
pDevice->EnableTbi = pAdapterInfo->Serdes;
|
||
|
}
|
||
|
else if (EeSigFound)
|
||
|
{
|
||
|
pDevice->PhyId = EePhyId;
|
||
|
pDevice->EnableTbi = EePhyTypeSerdes;
|
||
|
}
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
/* Bail out if we don't know the copper PHY id. */
|
||
|
if(UNKNOWN_PHY_ID(pDevice->PhyId) && !pDevice->EnableTbi)
|
||
|
{
|
||
|
return LM_STATUS_FAILURE;
|
||
|
}
|
||
|
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5703)
|
||
|
{
|
||
|
if((pDevice->SavedCacheLineReg & 0xff00) < 0x4000)
|
||
|
{
|
||
|
pDevice->SavedCacheLineReg &= 0xffff00ff;
|
||
|
pDevice->SavedCacheLineReg |= 0x4000;
|
||
|
}
|
||
|
}
|
||
|
/* Change driver parameters. */
|
||
|
Status = MM_GetConfig(pDevice);
|
||
|
if(Status != LM_STATUS_SUCCESS)
|
||
|
{
|
||
|
return Status;
|
||
|
}
|
||
|
|
||
|
#if INCLUDE_5701_AX_FIX
|
||
|
if (pDevice->ChipRevId == T3_CHIP_ID_5701_A0 ||
|
||
|
pDevice->ChipRevId == T3_CHIP_ID_5701_B0)
|
||
|
{
|
||
|
pDevice->ResetPhyOnInit = TRUE;
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
/* Save the current phy link status. */
|
||
|
if(!pDevice->EnableTbi)
|
||
|
{
|
||
|
LM_ReadPhy(pDevice, PHY_STATUS_REG, &Value32);
|
||
|
LM_ReadPhy(pDevice, PHY_STATUS_REG, &Value32);
|
||
|
|
||
|
/* If we don't have link reset the PHY. */
|
||
|
if(!(Value32 & PHY_STATUS_LINK_PASS) || pDevice->ResetPhyOnInit)
|
||
|
{
|
||
|
|
||
|
LM_WritePhy(pDevice, PHY_CTRL_REG, PHY_CTRL_PHY_RESET);
|
||
|
|
||
|
for(j = 0; j < 100; j++)
|
||
|
{
|
||
|
MM_Wait(10);
|
||
|
|
||
|
LM_ReadPhy(pDevice, PHY_CTRL_REG, &Value32);
|
||
|
if(Value32 && !(Value32 & PHY_CTRL_PHY_RESET))
|
||
|
{
|
||
|
MM_Wait(40);
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
|
||
|
#if INCLUDE_5701_AX_FIX
|
||
|
/* 5701_AX_BX bug: only advertises 10mb speed. */
|
||
|
if(pDevice->ChipRevId == T3_CHIP_ID_5701_A0 ||
|
||
|
pDevice->ChipRevId == T3_CHIP_ID_5701_B0)
|
||
|
{
|
||
|
|
||
|
Value32 = PHY_AN_AD_PROTOCOL_802_3_CSMA_CD |
|
||
|
PHY_AN_AD_10BASET_HALF | PHY_AN_AD_10BASET_FULL |
|
||
|
PHY_AN_AD_100BASETX_FULL | PHY_AN_AD_100BASETX_HALF;
|
||
|
Value32 |= GetPhyAdFlowCntrlSettings(pDevice);
|
||
|
LM_WritePhy(pDevice, PHY_AN_AD_REG, Value32);
|
||
|
pDevice->advertising = Value32;
|
||
|
|
||
|
Value32 = BCM540X_AN_AD_1000BASET_HALF |
|
||
|
BCM540X_AN_AD_1000BASET_FULL | BCM540X_CONFIG_AS_MASTER |
|
||
|
BCM540X_ENABLE_CONFIG_AS_MASTER;
|
||
|
LM_WritePhy(pDevice, BCM540X_1000BASET_CTRL_REG, Value32);
|
||
|
pDevice->advertising1000 = Value32;
|
||
|
|
||
|
LM_WritePhy(pDevice, PHY_CTRL_REG, PHY_CTRL_AUTO_NEG_ENABLE |
|
||
|
PHY_CTRL_RESTART_AUTO_NEG);
|
||
|
}
|
||
|
#endif
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5703)
|
||
|
{
|
||
|
LM_WritePhy(pDevice, 0x18, 0x0c00);
|
||
|
LM_WritePhy(pDevice, 0x17, 0x201f);
|
||
|
LM_WritePhy(pDevice, 0x15, 0x2aaa);
|
||
|
}
|
||
|
if(pDevice->ChipRevId == T3_CHIP_ID_5704_A0)
|
||
|
{
|
||
|
LM_WritePhy(pDevice, 0x1c, 0x8d68);
|
||
|
LM_WritePhy(pDevice, 0x1c, 0x8d68);
|
||
|
}
|
||
|
/* Enable Ethernet@WireSpeed. */
|
||
|
if(pDevice->EnableWireSpeed)
|
||
|
{
|
||
|
LM_WritePhy(pDevice, 0x18, 0x7007);
|
||
|
LM_ReadPhy(pDevice, 0x18, &Value32);
|
||
|
LM_WritePhy(pDevice, 0x18, Value32 | BIT_15 | BIT_4);
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Turn off tap power management. */
|
||
|
if((pDevice->PhyId & PHY_ID_MASK) == PHY_BCM5401_PHY_ID)
|
||
|
{
|
||
|
LM_WritePhy(pDevice, BCM5401_AUX_CTRL, 0x0c20);
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_ADDRESS_REG, 0x0012);
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_RW_PORT, 0x1804);
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_ADDRESS_REG, 0x0013);
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_RW_PORT, 0x1204);
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_ADDRESS_REG, 0x8006);
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_RW_PORT, 0x0132);
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_ADDRESS_REG, 0x8006);
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_RW_PORT, 0x0232);
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_ADDRESS_REG, 0x201f);
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_RW_PORT, 0x0a20);
|
||
|
|
||
|
MM_Wait(40);
|
||
|
}
|
||
|
|
||
|
#if INCLUDE_TBI_SUPPORT
|
||
|
pDevice->IgnoreTbiLinkChange = FALSE;
|
||
|
|
||
|
if(pDevice->EnableTbi)
|
||
|
{
|
||
|
pDevice->WakeUpModeCap = LM_WAKE_UP_MODE_NONE;
|
||
|
pDevice->PhyIntMode = T3_PHY_INT_MODE_LINK_READY;
|
||
|
if ((pDevice->PollTbiLink == BAD_DEFAULT_VALUE) ||
|
||
|
pDevice->DisableAutoNeg)
|
||
|
{
|
||
|
pDevice->PollTbiLink = FALSE;
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
pDevice->PollTbiLink = FALSE;
|
||
|
}
|
||
|
#endif /* INCLUDE_TBI_SUPPORT */
|
||
|
|
||
|
/* UseTaggedStatus is only valid for 5701 and later. */
|
||
|
if (T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700)
|
||
|
{
|
||
|
pDevice->UseTaggedStatus = FALSE;
|
||
|
|
||
|
pDevice->CoalesceMode = 0;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
pDevice->CoalesceMode = HOST_COALESCE_CLEAR_TICKS_ON_RX_BD_EVENT |
|
||
|
HOST_COALESCE_CLEAR_TICKS_ON_TX_BD_EVENT;
|
||
|
}
|
||
|
|
||
|
/* Set the status block size. */
|
||
|
if(T3_CHIP_REV(pDevice->ChipRevId) != T3_CHIP_REV_5700_AX &&
|
||
|
T3_CHIP_REV(pDevice->ChipRevId) != T3_CHIP_REV_5700_BX)
|
||
|
{
|
||
|
pDevice->CoalesceMode |= HOST_COALESCE_32_BYTE_STATUS_MODE;
|
||
|
}
|
||
|
|
||
|
/* Check the DURING_INT coalescing ticks parameters. */
|
||
|
if(pDevice->UseTaggedStatus)
|
||
|
{
|
||
|
if(pDevice->RxCoalescingTicksDuringInt == BAD_DEFAULT_VALUE)
|
||
|
{
|
||
|
pDevice->RxCoalescingTicksDuringInt =
|
||
|
DEFAULT_RX_COALESCING_TICKS_DURING_INT;
|
||
|
}
|
||
|
|
||
|
if(pDevice->TxCoalescingTicksDuringInt == BAD_DEFAULT_VALUE)
|
||
|
{
|
||
|
pDevice->TxCoalescingTicksDuringInt =
|
||
|
DEFAULT_TX_COALESCING_TICKS_DURING_INT;
|
||
|
}
|
||
|
|
||
|
if(pDevice->RxMaxCoalescedFramesDuringInt == BAD_DEFAULT_VALUE)
|
||
|
{
|
||
|
pDevice->RxMaxCoalescedFramesDuringInt =
|
||
|
DEFAULT_RX_MAX_COALESCED_FRAMES_DURING_INT;
|
||
|
}
|
||
|
|
||
|
if(pDevice->TxMaxCoalescedFramesDuringInt == BAD_DEFAULT_VALUE)
|
||
|
{
|
||
|
pDevice->TxMaxCoalescedFramesDuringInt =
|
||
|
DEFAULT_TX_MAX_COALESCED_FRAMES_DURING_INT;
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if(pDevice->RxCoalescingTicksDuringInt == BAD_DEFAULT_VALUE)
|
||
|
{
|
||
|
pDevice->RxCoalescingTicksDuringInt = 0;
|
||
|
}
|
||
|
|
||
|
if(pDevice->TxCoalescingTicksDuringInt == BAD_DEFAULT_VALUE)
|
||
|
{
|
||
|
pDevice->TxCoalescingTicksDuringInt = 0;
|
||
|
}
|
||
|
|
||
|
if(pDevice->RxMaxCoalescedFramesDuringInt == BAD_DEFAULT_VALUE)
|
||
|
{
|
||
|
pDevice->RxMaxCoalescedFramesDuringInt = 0;
|
||
|
}
|
||
|
|
||
|
if(pDevice->TxMaxCoalescedFramesDuringInt == BAD_DEFAULT_VALUE)
|
||
|
{
|
||
|
pDevice->TxMaxCoalescedFramesDuringInt = 0;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
#if T3_JUMBO_RCV_RCB_ENTRY_COUNT
|
||
|
if(pDevice->RxMtu <= (MAX_STD_RCV_BUFFER_SIZE - 8 /* CRC */))
|
||
|
{
|
||
|
pDevice->RxJumboDescCnt = 0;
|
||
|
if(pDevice->RxMtu <= MAX_ETHERNET_PACKET_SIZE_NO_CRC)
|
||
|
{
|
||
|
pDevice->RxMtu = MAX_ETHERNET_PACKET_SIZE_NO_CRC;
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
pDevice->RxJumboBufferSize = (pDevice->RxMtu + 8 /* CRC + VLAN */ +
|
||
|
COMMON_CACHE_LINE_SIZE-1) & ~COMMON_CACHE_LINE_MASK;
|
||
|
|
||
|
if(pDevice->RxJumboBufferSize > MAX_JUMBO_RCV_BUFFER_SIZE)
|
||
|
{
|
||
|
pDevice->RxJumboBufferSize = DEFAULT_JUMBO_RCV_BUFFER_SIZE;
|
||
|
pDevice->RxMtu = pDevice->RxJumboBufferSize - 8 /* CRC + VLAN */;
|
||
|
}
|
||
|
pDevice->TxMtu = pDevice->RxMtu;
|
||
|
|
||
|
}
|
||
|
#else
|
||
|
pDevice->RxMtu = MAX_ETHERNET_PACKET_SIZE_NO_CRC;
|
||
|
#endif /* T3_JUMBO_RCV_RCB_ENTRY_COUNT */
|
||
|
|
||
|
pDevice->RxPacketDescCnt =
|
||
|
#if T3_JUMBO_RCV_RCB_ENTRY_COUNT
|
||
|
pDevice->RxJumboDescCnt +
|
||
|
#endif /* T3_JUMBO_RCV_RCB_ENTRY_COUNT */
|
||
|
pDevice->RxStdDescCnt;
|
||
|
|
||
|
if(pDevice->TxMtu < MAX_ETHERNET_PACKET_SIZE_NO_CRC)
|
||
|
{
|
||
|
pDevice->TxMtu = MAX_ETHERNET_PACKET_SIZE_NO_CRC;
|
||
|
}
|
||
|
|
||
|
if(pDevice->TxMtu > MAX_JUMBO_TX_BUFFER_SIZE)
|
||
|
{
|
||
|
pDevice->TxMtu = MAX_JUMBO_TX_BUFFER_SIZE;
|
||
|
}
|
||
|
|
||
|
/* Configure the proper ways to get link change interrupt. */
|
||
|
if(pDevice->PhyIntMode == T3_PHY_INT_MODE_AUTO)
|
||
|
{
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700)
|
||
|
{
|
||
|
pDevice->PhyIntMode = T3_PHY_INT_MODE_MI_INTERRUPT;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
pDevice->PhyIntMode = T3_PHY_INT_MODE_LINK_READY;
|
||
|
}
|
||
|
}
|
||
|
else if(pDevice->PhyIntMode == T3_PHY_INT_MODE_AUTO_POLLING)
|
||
|
{
|
||
|
/* Auto-polling does not work on 5700_AX and 5700_BX. */
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700)
|
||
|
{
|
||
|
pDevice->PhyIntMode = T3_PHY_INT_MODE_MI_INTERRUPT;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Determine the method to get link change status. */
|
||
|
if(pDevice->LinkChngMode == T3_LINK_CHNG_MODE_AUTO)
|
||
|
{
|
||
|
/* The link status bit in the status block does not work on 5700_AX */
|
||
|
/* and 5700_BX chips. */
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700)
|
||
|
{
|
||
|
pDevice->LinkChngMode = T3_LINK_CHNG_MODE_USE_STATUS_REG;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
pDevice->LinkChngMode = T3_LINK_CHNG_MODE_USE_STATUS_BLOCK;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if(pDevice->PhyIntMode == T3_PHY_INT_MODE_MI_INTERRUPT ||
|
||
|
T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700)
|
||
|
{
|
||
|
pDevice->LinkChngMode = T3_LINK_CHNG_MODE_USE_STATUS_REG;
|
||
|
}
|
||
|
|
||
|
/* Configure PHY led mode. */
|
||
|
if(pDevice->LedMode == LED_MODE_AUTO)
|
||
|
{
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700 ||
|
||
|
T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5701)
|
||
|
{
|
||
|
if(pDevice->SubsystemVendorId == T3_SVID_DELL)
|
||
|
{
|
||
|
pDevice->LedMode = LED_MODE_LINK10;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
pDevice->LedMode = LED_MODE_THREE_LINK;
|
||
|
|
||
|
if(EeSigFound && EePhyLedMode != LED_MODE_AUTO)
|
||
|
{
|
||
|
pDevice->LedMode = EePhyLedMode;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* bug? 5701 in LINK10 mode does not seem to work when */
|
||
|
/* PhyIntMode is LINK_READY. */
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) != T3_ASIC_REV_5700 &&
|
||
|
#if INCLUDE_TBI_SUPPORT
|
||
|
pDevice->EnableTbi == FALSE &&
|
||
|
#endif
|
||
|
pDevice->LedMode == LED_MODE_LINK10)
|
||
|
{
|
||
|
pDevice->PhyIntMode = T3_PHY_INT_MODE_MI_INTERRUPT;
|
||
|
pDevice->LinkChngMode = T3_LINK_CHNG_MODE_USE_STATUS_REG;
|
||
|
}
|
||
|
|
||
|
if(pDevice->EnableTbi)
|
||
|
{
|
||
|
pDevice->LedMode = LED_MODE_THREE_LINK;
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if(EeSigFound && EePhyLedMode != LED_MODE_AUTO)
|
||
|
{
|
||
|
pDevice->LedMode = EePhyLedMode;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
pDevice->LedMode = LED_MODE_OPEN_DRAIN;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Enable OneDmaAtOnce. */
|
||
|
if(pDevice->OneDmaAtOnce == BAD_DEFAULT_VALUE)
|
||
|
{
|
||
|
pDevice->OneDmaAtOnce = FALSE;
|
||
|
}
|
||
|
|
||
|
if (T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700 ||
|
||
|
pDevice->ChipRevId == T3_CHIP_ID_5701_A0 ||
|
||
|
pDevice->ChipRevId == T3_CHIP_ID_5701_B0 ||
|
||
|
pDevice->ChipRevId == T3_CHIP_ID_5701_B2)
|
||
|
{
|
||
|
pDevice->WolSpeed = WOL_SPEED_10MB;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
pDevice->WolSpeed = WOL_SPEED_100MB;
|
||
|
}
|
||
|
|
||
|
/* Offloadings. */
|
||
|
pDevice->TaskToOffload = LM_TASK_OFFLOAD_NONE;
|
||
|
|
||
|
/* Turn off task offloading on Ax. */
|
||
|
if(pDevice->ChipRevId == T3_CHIP_ID_5700_B0)
|
||
|
{
|
||
|
pDevice->TaskOffloadCap &= ~(LM_TASK_OFFLOAD_TX_TCP_CHECKSUM |
|
||
|
LM_TASK_OFFLOAD_TX_UDP_CHECKSUM);
|
||
|
}
|
||
|
pDevice->PciState = REG_RD(pDevice, PciCfg.PciState);
|
||
|
LM_ReadVPD(pDevice);
|
||
|
LM_ReadBootCodeVersion(pDevice);
|
||
|
LM_GetBusSpeed(pDevice);
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
} /* LM_GetAdapterInfo */
|
||
|
|
||
|
STATIC PLM_ADAPTER_INFO
|
||
|
LM_GetAdapterInfoBySsid(
|
||
|
LM_UINT16 Svid,
|
||
|
LM_UINT16 Ssid)
|
||
|
{
|
||
|
static LM_ADAPTER_INFO AdapterArr[] =
|
||
|
{
|
||
|
{ T3_SVID_BROADCOM, T3_SSID_BROADCOM_BCM95700A6, PHY_BCM5401_PHY_ID, 0},
|
||
|
{ T3_SVID_BROADCOM, T3_SSID_BROADCOM_BCM95701A5, PHY_BCM5701_PHY_ID, 0},
|
||
|
{ T3_SVID_BROADCOM, T3_SSID_BROADCOM_BCM95700T6, PHY_BCM8002_PHY_ID, 1},
|
||
|
{ T3_SVID_BROADCOM, T3_SSID_BROADCOM_BCM95700A9, 0, 1 },
|
||
|
{ T3_SVID_BROADCOM, T3_SSID_BROADCOM_BCM95701T1, PHY_BCM5701_PHY_ID, 0},
|
||
|
{ T3_SVID_BROADCOM, T3_SSID_BROADCOM_BCM95701T8, PHY_BCM5701_PHY_ID, 0},
|
||
|
{ T3_SVID_BROADCOM, T3_SSID_BROADCOM_BCM95701A7, 0, 1},
|
||
|
{ T3_SVID_BROADCOM, T3_SSID_BROADCOM_BCM95701A10, PHY_BCM5701_PHY_ID, 0},
|
||
|
{ T3_SVID_BROADCOM, T3_SSID_BROADCOM_BCM95701A12, PHY_BCM5701_PHY_ID, 0},
|
||
|
{ T3_SVID_BROADCOM, T3_SSID_BROADCOM_BCM95703Ax1, PHY_BCM5701_PHY_ID, 0},
|
||
|
{ T3_SVID_BROADCOM, T3_SSID_BROADCOM_BCM95703Ax2, PHY_BCM5701_PHY_ID, 0},
|
||
|
|
||
|
{ T3_SVID_3COM, T3_SSID_3COM_3C996T, PHY_BCM5401_PHY_ID, 0 },
|
||
|
{ T3_SVID_3COM, T3_SSID_3COM_3C996BT, PHY_BCM5701_PHY_ID, 0 },
|
||
|
{ T3_SVID_3COM, T3_SSID_3COM_3C996SX, 0, 1 },
|
||
|
{ T3_SVID_3COM, T3_SSID_3COM_3C1000T, PHY_BCM5701_PHY_ID, 0 },
|
||
|
{ T3_SVID_3COM, T3_SSID_3COM_3C940BR01, PHY_BCM5701_PHY_ID, 0 },
|
||
|
|
||
|
{ T3_SVID_DELL, T3_SSID_DELL_VIPER, PHY_BCM5401_PHY_ID, 0 },
|
||
|
{ T3_SVID_DELL, T3_SSID_DELL_JAGUAR, PHY_BCM5401_PHY_ID, 0 },
|
||
|
{ T3_SVID_DELL, T3_SSID_DELL_MERLOT, PHY_BCM5411_PHY_ID, 0 },
|
||
|
{ T3_SVID_DELL, T3_SSID_DELL_SLIM_MERLOT, PHY_BCM5411_PHY_ID, 0 },
|
||
|
|
||
|
{ T3_SVID_COMPAQ, T3_SSID_COMPAQ_BANSHEE, PHY_BCM5701_PHY_ID, 0 },
|
||
|
{ T3_SVID_COMPAQ, T3_SSID_COMPAQ_BANSHEE_2, PHY_BCM5701_PHY_ID, 0 },
|
||
|
{ T3_SVID_COMPAQ, T3_SSID_COMPAQ_CHANGELING, 0, 1 },
|
||
|
{ T3_SVID_COMPAQ, T3_SSID_COMPAQ_NC7780, PHY_BCM5701_PHY_ID, 0 },
|
||
|
{ T3_SVID_COMPAQ, T3_SSID_COMPAQ_NC7780_2, PHY_BCM5701_PHY_ID, 0 },
|
||
|
|
||
|
};
|
||
|
LM_UINT32 j;
|
||
|
|
||
|
for(j = 0; j < sizeof(AdapterArr)/sizeof(LM_ADAPTER_INFO); j++)
|
||
|
{
|
||
|
if(AdapterArr[j].Svid == Svid && AdapterArr[j].Ssid == Ssid)
|
||
|
{
|
||
|
return &AdapterArr[j];
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return NULL;
|
||
|
}
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* This routine sets up receive/transmit buffer descriptions queues. */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/* LM_STATUS_SUCCESS */
|
||
|
/******************************************************************************/
|
||
|
LM_STATUS
|
||
|
LM_InitializeAdapter(
|
||
|
PLM_DEVICE_BLOCK pDevice)
|
||
|
{
|
||
|
LM_PHYSICAL_ADDRESS MemPhy;
|
||
|
PLM_UINT8 pMemVirt;
|
||
|
PLM_PACKET pPacket;
|
||
|
LM_STATUS Status;
|
||
|
LM_UINT32 Size;
|
||
|
LM_UINT32 j;
|
||
|
|
||
|
/* Set power state to D0. */
|
||
|
LM_SetPowerState(pDevice, LM_POWER_STATE_D0);
|
||
|
|
||
|
/* Intialize the queues. */
|
||
|
QQ_InitQueue(&pDevice->RxPacketReceivedQ.Container,
|
||
|
MAX_RX_PACKET_DESC_COUNT);
|
||
|
QQ_InitQueue(&pDevice->RxPacketFreeQ.Container,
|
||
|
MAX_RX_PACKET_DESC_COUNT);
|
||
|
|
||
|
QQ_InitQueue(&pDevice->TxPacketFreeQ.Container,MAX_TX_PACKET_DESC_COUNT);
|
||
|
QQ_InitQueue(&pDevice->TxPacketActiveQ.Container,MAX_TX_PACKET_DESC_COUNT);
|
||
|
QQ_InitQueue(&pDevice->TxPacketXmittedQ.Container,MAX_TX_PACKET_DESC_COUNT);
|
||
|
|
||
|
/* Allocate shared memory for: status block, the buffers for receive */
|
||
|
/* rings -- standard, mini, jumbo, and return rings. */
|
||
|
Size = T3_STATUS_BLOCK_SIZE + sizeof(T3_STATS_BLOCK) +
|
||
|
T3_STD_RCV_RCB_ENTRY_COUNT * sizeof(T3_RCV_BD) +
|
||
|
#if T3_JUMBO_RCV_RCB_ENTRY_COUNT
|
||
|
T3_JUMBO_RCV_RCB_ENTRY_COUNT * sizeof(T3_RCV_BD) +
|
||
|
#endif /* T3_JUMBO_RCV_RCB_ENTRY_COUNT */
|
||
|
T3_RCV_RETURN_RCB_ENTRY_COUNT * sizeof(T3_RCV_BD);
|
||
|
|
||
|
/* Memory for host based Send BD. */
|
||
|
if(pDevice->NicSendBd == FALSE)
|
||
|
{
|
||
|
Size += sizeof(T3_SND_BD) * T3_SEND_RCB_ENTRY_COUNT;
|
||
|
}
|
||
|
|
||
|
/* Allocate the memory block. */
|
||
|
Status = MM_AllocateSharedMemory(pDevice, Size, (PLM_VOID) &pMemVirt, &MemPhy, FALSE);
|
||
|
if(Status != LM_STATUS_SUCCESS)
|
||
|
{
|
||
|
return Status;
|
||
|
}
|
||
|
|
||
|
/* Program DMA Read/Write */
|
||
|
if (pDevice->PciState & T3_PCI_STATE_NOT_PCI_X_BUS)
|
||
|
{
|
||
|
pDevice->DmaReadWriteCtrl = 0x763f000f;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5704)
|
||
|
{
|
||
|
pDevice->DmaReadWriteCtrl = 0x761f0000;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
pDevice->DmaReadWriteCtrl = 0x761b000f;
|
||
|
}
|
||
|
if(pDevice->ChipRevId == T3_CHIP_ID_5703_A1 ||
|
||
|
pDevice->ChipRevId == T3_CHIP_ID_5703_A2)
|
||
|
{
|
||
|
pDevice->OneDmaAtOnce = TRUE;
|
||
|
}
|
||
|
}
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5703)
|
||
|
{
|
||
|
pDevice->DmaReadWriteCtrl &= 0xfffffff0;
|
||
|
}
|
||
|
|
||
|
if(pDevice->OneDmaAtOnce)
|
||
|
{
|
||
|
pDevice->DmaReadWriteCtrl |= DMA_CTRL_WRITE_ONE_DMA_AT_ONCE;
|
||
|
}
|
||
|
REG_WR(pDevice, PciCfg.DmaReadWriteCtrl, pDevice->DmaReadWriteCtrl);
|
||
|
|
||
|
if (LM_DmaTest(pDevice, pMemVirt, MemPhy, 0x400) != LM_STATUS_SUCCESS)
|
||
|
{
|
||
|
return LM_STATUS_FAILURE;
|
||
|
}
|
||
|
|
||
|
/* Status block. */
|
||
|
pDevice->pStatusBlkVirt = (PT3_STATUS_BLOCK) pMemVirt;
|
||
|
pDevice->StatusBlkPhy = MemPhy;
|
||
|
pMemVirt += T3_STATUS_BLOCK_SIZE;
|
||
|
LM_INC_PHYSICAL_ADDRESS(&MemPhy, T3_STATUS_BLOCK_SIZE);
|
||
|
|
||
|
/* Statistics block. */
|
||
|
pDevice->pStatsBlkVirt = (PT3_STATS_BLOCK) pMemVirt;
|
||
|
pDevice->StatsBlkPhy = MemPhy;
|
||
|
pMemVirt += sizeof(T3_STATS_BLOCK);
|
||
|
LM_INC_PHYSICAL_ADDRESS(&MemPhy, sizeof(T3_STATS_BLOCK));
|
||
|
|
||
|
/* Receive standard BD buffer. */
|
||
|
pDevice->pRxStdBdVirt = (PT3_RCV_BD) pMemVirt;
|
||
|
pDevice->RxStdBdPhy = MemPhy;
|
||
|
|
||
|
pMemVirt += T3_STD_RCV_RCB_ENTRY_COUNT * sizeof(T3_RCV_BD);
|
||
|
LM_INC_PHYSICAL_ADDRESS(&MemPhy,
|
||
|
T3_STD_RCV_RCB_ENTRY_COUNT * sizeof(T3_RCV_BD));
|
||
|
|
||
|
#if T3_JUMBO_RCV_RCB_ENTRY_COUNT
|
||
|
/* Receive jumbo BD buffer. */
|
||
|
pDevice->pRxJumboBdVirt = (PT3_RCV_BD) pMemVirt;
|
||
|
pDevice->RxJumboBdPhy = MemPhy;
|
||
|
|
||
|
pMemVirt += T3_JUMBO_RCV_RCB_ENTRY_COUNT * sizeof(T3_RCV_BD);
|
||
|
LM_INC_PHYSICAL_ADDRESS(&MemPhy,
|
||
|
T3_JUMBO_RCV_RCB_ENTRY_COUNT * sizeof(T3_RCV_BD));
|
||
|
#endif /* T3_JUMBO_RCV_RCB_ENTRY_COUNT */
|
||
|
|
||
|
/* Receive return BD buffer. */
|
||
|
pDevice->pRcvRetBdVirt = (PT3_RCV_BD) pMemVirt;
|
||
|
pDevice->RcvRetBdPhy = MemPhy;
|
||
|
|
||
|
pMemVirt += T3_RCV_RETURN_RCB_ENTRY_COUNT * sizeof(T3_RCV_BD);
|
||
|
LM_INC_PHYSICAL_ADDRESS(&MemPhy,
|
||
|
T3_RCV_RETURN_RCB_ENTRY_COUNT * sizeof(T3_RCV_BD));
|
||
|
|
||
|
/* Set up Send BD. */
|
||
|
if(pDevice->NicSendBd == FALSE)
|
||
|
{
|
||
|
pDevice->pSendBdVirt = (PT3_SND_BD) pMemVirt;
|
||
|
pDevice->SendBdPhy = MemPhy;
|
||
|
|
||
|
pMemVirt += sizeof(T3_SND_BD) * T3_SEND_RCB_ENTRY_COUNT;
|
||
|
LM_INC_PHYSICAL_ADDRESS(&MemPhy,
|
||
|
sizeof(T3_SND_BD) * T3_SEND_RCB_ENTRY_COUNT);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
pDevice->pSendBdVirt = (PT3_SND_BD)
|
||
|
pDevice->pMemView->uIntMem.First32k.BufferDesc;
|
||
|
pDevice->SendBdPhy.High = 0;
|
||
|
pDevice->SendBdPhy.Low = T3_NIC_SND_BUFFER_DESC_ADDR;
|
||
|
}
|
||
|
|
||
|
/* Allocate memory for packet descriptors. */
|
||
|
Size = (pDevice->RxPacketDescCnt +
|
||
|
pDevice->TxPacketDescCnt) * MM_PACKET_DESC_SIZE;
|
||
|
Status = MM_AllocateMemory(pDevice, Size, (PLM_VOID *) &pPacket);
|
||
|
if(Status != LM_STATUS_SUCCESS)
|
||
|
{
|
||
|
return Status;
|
||
|
}
|
||
|
pDevice->pPacketDescBase = (PLM_VOID) pPacket;
|
||
|
|
||
|
/* Create transmit packet descriptors from the memory block and add them */
|
||
|
/* to the TxPacketFreeQ for each send ring. */
|
||
|
for(j = 0; j < pDevice->TxPacketDescCnt; j++)
|
||
|
{
|
||
|
/* Ring index. */
|
||
|
pPacket->Flags = 0;
|
||
|
|
||
|
/* Queue the descriptor in the TxPacketFreeQ of the 'k' ring. */
|
||
|
QQ_PushTail(&pDevice->TxPacketFreeQ.Container, pPacket);
|
||
|
|
||
|
/* Get the pointer to the next descriptor. MM_PACKET_DESC_SIZE */
|
||
|
/* is the total size of the packet descriptor including the */
|
||
|
/* os-specific extensions in the UM_PACKET structure. */
|
||
|
pPacket = (PLM_PACKET) ((PLM_UINT8) pPacket + MM_PACKET_DESC_SIZE);
|
||
|
} /* for(j.. */
|
||
|
|
||
|
/* Create receive packet descriptors from the memory block and add them */
|
||
|
/* to the RxPacketFreeQ. Create the Standard packet descriptors. */
|
||
|
for(j = 0; j < pDevice->RxStdDescCnt; j++)
|
||
|
{
|
||
|
/* Receive producer ring. */
|
||
|
pPacket->u.Rx.RcvProdRing = T3_STD_RCV_PROD_RING;
|
||
|
|
||
|
/* Receive buffer size. */
|
||
|
pPacket->u.Rx.RxBufferSize = MAX_STD_RCV_BUFFER_SIZE;
|
||
|
|
||
|
/* Add the descriptor to RxPacketFreeQ. */
|
||
|
QQ_PushTail(&pDevice->RxPacketFreeQ.Container, pPacket);
|
||
|
|
||
|
/* Get the pointer to the next descriptor. MM_PACKET_DESC_SIZE */
|
||
|
/* is the total size of the packet descriptor including the */
|
||
|
/* os-specific extensions in the UM_PACKET structure. */
|
||
|
pPacket = (PLM_PACKET) ((PLM_UINT8) pPacket + MM_PACKET_DESC_SIZE);
|
||
|
} /* for */
|
||
|
|
||
|
#if T3_JUMBO_RCV_RCB_ENTRY_COUNT
|
||
|
/* Create the Jumbo packet descriptors. */
|
||
|
for(j = 0; j < pDevice->RxJumboDescCnt; j++)
|
||
|
{
|
||
|
/* Receive producer ring. */
|
||
|
pPacket->u.Rx.RcvProdRing = T3_JUMBO_RCV_PROD_RING;
|
||
|
|
||
|
/* Receive buffer size. */
|
||
|
pPacket->u.Rx.RxBufferSize = pDevice->RxJumboBufferSize;
|
||
|
|
||
|
/* Add the descriptor to RxPacketFreeQ. */
|
||
|
QQ_PushTail(&pDevice->RxPacketFreeQ.Container, pPacket);
|
||
|
|
||
|
/* Get the pointer to the next descriptor. MM_PACKET_DESC_SIZE */
|
||
|
/* is the total size of the packet descriptor including the */
|
||
|
/* os-specific extensions in the UM_PACKET structure. */
|
||
|
pPacket = (PLM_PACKET) ((PLM_UINT8) pPacket + MM_PACKET_DESC_SIZE);
|
||
|
} /* for */
|
||
|
#endif /* T3_JUMBO_RCV_RCB_ENTRY_COUNT */
|
||
|
|
||
|
/* Initialize the rest of the packet descriptors. */
|
||
|
Status = MM_InitializeUmPackets(pDevice);
|
||
|
if(Status != LM_STATUS_SUCCESS)
|
||
|
{
|
||
|
return Status;
|
||
|
} /* if */
|
||
|
|
||
|
/* Default receive mask. */
|
||
|
pDevice->ReceiveMask = LM_ACCEPT_MULTICAST | LM_ACCEPT_BROADCAST |
|
||
|
LM_ACCEPT_UNICAST;
|
||
|
|
||
|
/* Make sure we are in the first 32k memory window or NicSendBd. */
|
||
|
REG_WR(pDevice, PciCfg.MemWindowBaseAddr, 0);
|
||
|
|
||
|
/* Initialize the hardware. */
|
||
|
Status = LM_ResetAdapter(pDevice);
|
||
|
if(Status != LM_STATUS_SUCCESS)
|
||
|
{
|
||
|
return Status;
|
||
|
}
|
||
|
|
||
|
/* We are done with initialization. */
|
||
|
pDevice->InitDone = TRUE;
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
} /* LM_InitializeAdapter */
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* This function Enables/Disables a given block. */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/* LM_STATUS_SUCCESS */
|
||
|
/******************************************************************************/
|
||
|
LM_STATUS
|
||
|
LM_CntrlBlock(
|
||
|
PLM_DEVICE_BLOCK pDevice,
|
||
|
LM_UINT32 mask,LM_UINT32 cntrl)
|
||
|
{
|
||
|
LM_UINT32 j,i,data;
|
||
|
LM_UINT32 MaxWaitCnt;
|
||
|
|
||
|
MaxWaitCnt = 2;
|
||
|
j = 0;
|
||
|
|
||
|
for(i = 0 ; i < 32; i++)
|
||
|
{
|
||
|
if(!(mask & (1 << i)))
|
||
|
continue;
|
||
|
|
||
|
switch (1 << i)
|
||
|
{
|
||
|
case T3_BLOCK_DMA_RD:
|
||
|
data = REG_RD(pDevice, DmaRead.Mode);
|
||
|
if (cntrl == LM_DISABLE)
|
||
|
{
|
||
|
data &= ~DMA_READ_MODE_ENABLE;
|
||
|
REG_WR(pDevice, DmaRead.Mode, data);
|
||
|
for(j = 0; j < MaxWaitCnt; j++)
|
||
|
{
|
||
|
if(!(REG_RD(pDevice, DmaRead.Mode) & DMA_READ_MODE_ENABLE))
|
||
|
break;
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
REG_WR(pDevice, DmaRead.Mode, data | DMA_READ_MODE_ENABLE);
|
||
|
break;
|
||
|
|
||
|
case T3_BLOCK_DMA_COMP:
|
||
|
data = REG_RD(pDevice,DmaComp.Mode);
|
||
|
if (cntrl == LM_DISABLE)
|
||
|
{
|
||
|
data &= ~DMA_COMP_MODE_ENABLE;
|
||
|
REG_WR(pDevice, DmaComp.Mode, data);
|
||
|
for(j = 0; j < MaxWaitCnt; j++)
|
||
|
{
|
||
|
if(!(REG_RD(pDevice, DmaComp.Mode) & DMA_COMP_MODE_ENABLE))
|
||
|
break;
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
REG_WR(pDevice, DmaComp.Mode, data | DMA_COMP_MODE_ENABLE);
|
||
|
break;
|
||
|
|
||
|
case T3_BLOCK_RX_BD_INITIATOR:
|
||
|
data = REG_RD(pDevice, RcvBdIn.Mode);
|
||
|
if (cntrl == LM_DISABLE)
|
||
|
{
|
||
|
data &= ~RCV_BD_IN_MODE_ENABLE;
|
||
|
REG_WR(pDevice, RcvBdIn.Mode,data);
|
||
|
for(j = 0; j < MaxWaitCnt; j++)
|
||
|
{
|
||
|
if(!(REG_RD(pDevice, RcvBdIn.Mode) & RCV_BD_IN_MODE_ENABLE))
|
||
|
break;
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
REG_WR(pDevice, RcvBdIn.Mode,data | RCV_BD_IN_MODE_ENABLE);
|
||
|
break;
|
||
|
|
||
|
case T3_BLOCK_RX_BD_COMP:
|
||
|
data = REG_RD(pDevice, RcvBdComp.Mode);
|
||
|
if (cntrl == LM_DISABLE)
|
||
|
{
|
||
|
data &= ~RCV_BD_COMP_MODE_ENABLE;
|
||
|
REG_WR(pDevice, RcvBdComp.Mode,data);
|
||
|
for(j = 0; j < MaxWaitCnt; j++)
|
||
|
{
|
||
|
if(!(REG_RD(pDevice, RcvBdComp.Mode) & RCV_BD_COMP_MODE_ENABLE))
|
||
|
break;
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
REG_WR(pDevice, RcvBdComp.Mode,data | RCV_BD_COMP_MODE_ENABLE);
|
||
|
break;
|
||
|
|
||
|
case T3_BLOCK_DMA_WR:
|
||
|
data = REG_RD(pDevice, DmaWrite.Mode);
|
||
|
if (cntrl == LM_DISABLE)
|
||
|
{
|
||
|
data &= ~DMA_WRITE_MODE_ENABLE;
|
||
|
REG_WR(pDevice, DmaWrite.Mode,data);
|
||
|
|
||
|
for(j = 0; j < MaxWaitCnt; j++)
|
||
|
{
|
||
|
if(!(REG_RD(pDevice, DmaWrite.Mode) & DMA_WRITE_MODE_ENABLE))
|
||
|
break;
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
REG_WR(pDevice, DmaWrite.Mode,data | DMA_WRITE_MODE_ENABLE);
|
||
|
break;
|
||
|
|
||
|
case T3_BLOCK_MSI_HANDLER:
|
||
|
data = REG_RD(pDevice, Msi.Mode);
|
||
|
if (cntrl == LM_DISABLE)
|
||
|
{
|
||
|
data &= ~MSI_MODE_ENABLE;
|
||
|
REG_WR(pDevice, Msi.Mode, data);
|
||
|
for(j = 0; j < MaxWaitCnt; j++)
|
||
|
{
|
||
|
if(!(REG_RD(pDevice, Msi.Mode) & MSI_MODE_ENABLE))
|
||
|
break;
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
REG_WR(pDevice, Msi.Mode, data |MSI_MODE_ENABLE);
|
||
|
break;
|
||
|
|
||
|
case T3_BLOCK_RX_LIST_PLMT:
|
||
|
data = REG_RD(pDevice, RcvListPlmt.Mode);
|
||
|
if (cntrl == LM_DISABLE)
|
||
|
{
|
||
|
data &= ~RCV_LIST_PLMT_MODE_ENABLE;
|
||
|
REG_WR(pDevice, RcvListPlmt.Mode,data);
|
||
|
for(j = 0; j < MaxWaitCnt; j++)
|
||
|
{
|
||
|
if(!(REG_RD(pDevice, RcvListPlmt.Mode) & RCV_LIST_PLMT_MODE_ENABLE))
|
||
|
break;
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
REG_WR(pDevice, RcvListPlmt.Mode,data | RCV_LIST_PLMT_MODE_ENABLE);
|
||
|
break;
|
||
|
|
||
|
case T3_BLOCK_RX_LIST_SELECTOR:
|
||
|
data = REG_RD(pDevice, RcvListSel.Mode);
|
||
|
if (cntrl == LM_DISABLE)
|
||
|
{
|
||
|
data &= ~RCV_LIST_SEL_MODE_ENABLE;
|
||
|
REG_WR(pDevice, RcvListSel.Mode,data);
|
||
|
for(j = 0; j < MaxWaitCnt; j++)
|
||
|
{
|
||
|
if(!(REG_RD(pDevice, RcvListSel.Mode) & RCV_LIST_SEL_MODE_ENABLE))
|
||
|
break;
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
REG_WR(pDevice, RcvListSel.Mode,data |RCV_LIST_SEL_MODE_ENABLE);
|
||
|
break;
|
||
|
|
||
|
case T3_BLOCK_RX_DATA_INITIATOR:
|
||
|
data = REG_RD(pDevice, RcvDataBdIn.Mode);
|
||
|
if (cntrl == LM_DISABLE)
|
||
|
{
|
||
|
data &= ~RCV_DATA_BD_IN_MODE_ENABLE;
|
||
|
REG_WR(pDevice, RcvDataBdIn.Mode,data);
|
||
|
for(j = 0; j < MaxWaitCnt; j++)
|
||
|
{
|
||
|
if(!(REG_RD(pDevice, RcvDataBdIn.Mode) & RCV_DATA_BD_IN_MODE_ENABLE))
|
||
|
break;
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
REG_WR(pDevice, RcvDataBdIn.Mode, data | RCV_DATA_BD_IN_MODE_ENABLE);
|
||
|
break;
|
||
|
|
||
|
case T3_BLOCK_RX_DATA_COMP:
|
||
|
data = REG_RD(pDevice, RcvDataComp.Mode);
|
||
|
if (cntrl == LM_DISABLE)
|
||
|
{
|
||
|
data &= ~RCV_DATA_COMP_MODE_ENABLE;
|
||
|
REG_WR(pDevice, RcvDataComp.Mode,data);
|
||
|
for(j = 0; j < MaxWaitCnt; j++)
|
||
|
{
|
||
|
if(!(REG_RD(pDevice, RcvDataBdIn.Mode) & RCV_DATA_COMP_MODE_ENABLE))
|
||
|
break;
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
REG_WR(pDevice, RcvDataComp.Mode,data | RCV_DATA_COMP_MODE_ENABLE);
|
||
|
break;
|
||
|
|
||
|
case T3_BLOCK_HOST_COALESING:
|
||
|
data = REG_RD(pDevice, HostCoalesce.Mode);
|
||
|
if (cntrl == LM_DISABLE)
|
||
|
{
|
||
|
data &= ~HOST_COALESCE_ENABLE;
|
||
|
REG_WR(pDevice, HostCoalesce.Mode, data);
|
||
|
for(j = 0; j < MaxWaitCnt; j++)
|
||
|
{
|
||
|
if(!(REG_RD(pDevice, SndBdIn.Mode) & HOST_COALESCE_ENABLE))
|
||
|
break;
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
REG_WR(pDevice, HostCoalesce.Mode, data | HOST_COALESCE_ENABLE);
|
||
|
break;
|
||
|
|
||
|
case T3_BLOCK_MAC_RX_ENGINE:
|
||
|
if(cntrl == LM_DISABLE)
|
||
|
{
|
||
|
pDevice->RxMode &= ~RX_MODE_ENABLE;
|
||
|
REG_WR(pDevice, MacCtrl.RxMode, pDevice->RxMode);
|
||
|
for(j = 0; j < MaxWaitCnt; j++)
|
||
|
{
|
||
|
if(!(REG_RD(pDevice, MacCtrl.RxMode) & RX_MODE_ENABLE))
|
||
|
{
|
||
|
break;
|
||
|
}
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
pDevice->RxMode |= RX_MODE_ENABLE;
|
||
|
REG_WR(pDevice, MacCtrl.RxMode, pDevice->RxMode);
|
||
|
}
|
||
|
break;
|
||
|
|
||
|
case T3_BLOCK_MBUF_CLUSTER_FREE:
|
||
|
data = REG_RD(pDevice, MbufClusterFree.Mode);
|
||
|
if (cntrl == LM_DISABLE)
|
||
|
{
|
||
|
data &= ~MBUF_CLUSTER_FREE_MODE_ENABLE;
|
||
|
REG_WR(pDevice, MbufClusterFree.Mode,data);
|
||
|
for(j = 0; j < MaxWaitCnt; j++)
|
||
|
{
|
||
|
if(!(REG_RD(pDevice, MbufClusterFree.Mode) & MBUF_CLUSTER_FREE_MODE_ENABLE))
|
||
|
break;
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
REG_WR(pDevice, MbufClusterFree.Mode, data | MBUF_CLUSTER_FREE_MODE_ENABLE);
|
||
|
break;
|
||
|
|
||
|
case T3_BLOCK_SEND_BD_INITIATOR:
|
||
|
data = REG_RD(pDevice, SndBdIn.Mode);
|
||
|
if (cntrl == LM_DISABLE)
|
||
|
{
|
||
|
data &= ~SND_BD_IN_MODE_ENABLE;
|
||
|
REG_WR(pDevice, SndBdIn.Mode, data);
|
||
|
for(j = 0; j < MaxWaitCnt; j++)
|
||
|
{
|
||
|
if(!(REG_RD(pDevice, SndBdIn.Mode) & SND_BD_IN_MODE_ENABLE))
|
||
|
break;
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
REG_WR(pDevice, SndBdIn.Mode, data | SND_BD_IN_MODE_ENABLE);
|
||
|
break;
|
||
|
|
||
|
case T3_BLOCK_SEND_BD_COMP:
|
||
|
data = REG_RD(pDevice, SndBdComp.Mode);
|
||
|
if (cntrl == LM_DISABLE)
|
||
|
{
|
||
|
data &= ~SND_BD_COMP_MODE_ENABLE;
|
||
|
REG_WR(pDevice, SndBdComp.Mode, data);
|
||
|
for(j = 0; j < MaxWaitCnt; j++)
|
||
|
{
|
||
|
if(!(REG_RD(pDevice, SndBdComp.Mode) & SND_BD_COMP_MODE_ENABLE))
|
||
|
break;
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
REG_WR(pDevice, SndBdComp.Mode, data | SND_BD_COMP_MODE_ENABLE);
|
||
|
break;
|
||
|
|
||
|
case T3_BLOCK_SEND_BD_SELECTOR:
|
||
|
data = REG_RD(pDevice, SndBdSel.Mode);
|
||
|
if (cntrl == LM_DISABLE)
|
||
|
{
|
||
|
data &= ~SND_BD_SEL_MODE_ENABLE;
|
||
|
REG_WR(pDevice, SndBdSel.Mode, data);
|
||
|
for(j = 0; j < MaxWaitCnt; j++)
|
||
|
{
|
||
|
if(!(REG_RD(pDevice, SndBdSel.Mode) & SND_BD_SEL_MODE_ENABLE))
|
||
|
break;
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
REG_WR(pDevice, SndBdSel.Mode, data | SND_BD_SEL_MODE_ENABLE);
|
||
|
break;
|
||
|
|
||
|
case T3_BLOCK_SEND_DATA_INITIATOR:
|
||
|
data = REG_RD(pDevice, SndDataIn.Mode);
|
||
|
if (cntrl == LM_DISABLE)
|
||
|
{
|
||
|
data &= ~T3_SND_DATA_IN_MODE_ENABLE;
|
||
|
REG_WR(pDevice, SndDataIn.Mode,data);
|
||
|
for(j = 0; j < MaxWaitCnt; j++)
|
||
|
{
|
||
|
if(!(REG_RD(pDevice, SndDataIn.Mode) & T3_SND_DATA_IN_MODE_ENABLE))
|
||
|
break;
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
REG_WR(pDevice, SndDataIn.Mode,data | T3_SND_DATA_IN_MODE_ENABLE);
|
||
|
break;
|
||
|
|
||
|
case T3_BLOCK_SEND_DATA_COMP:
|
||
|
data = REG_RD(pDevice, SndDataComp.Mode);
|
||
|
if (cntrl == LM_DISABLE)
|
||
|
{
|
||
|
data &= ~SND_DATA_COMP_MODE_ENABLE;
|
||
|
REG_WR(pDevice, SndDataComp.Mode, data);
|
||
|
for(j = 0; j < MaxWaitCnt; j++)
|
||
|
{
|
||
|
if(!(REG_RD(pDevice, SndDataComp.Mode) & SND_DATA_COMP_MODE_ENABLE))
|
||
|
break;
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
REG_WR(pDevice, SndDataComp.Mode,data | SND_DATA_COMP_MODE_ENABLE);
|
||
|
break;
|
||
|
|
||
|
case T3_BLOCK_MAC_TX_ENGINE:
|
||
|
if(cntrl == LM_DISABLE)
|
||
|
{
|
||
|
pDevice->TxMode &= ~TX_MODE_ENABLE;
|
||
|
REG_WR(pDevice, MacCtrl.TxMode, pDevice->TxMode);
|
||
|
for(j = 0; j < MaxWaitCnt; j++)
|
||
|
{
|
||
|
if(!(REG_RD(pDevice, MacCtrl.TxMode) & TX_MODE_ENABLE))
|
||
|
break;
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
pDevice->TxMode |= TX_MODE_ENABLE;
|
||
|
REG_WR(pDevice, MacCtrl.TxMode, pDevice->TxMode);
|
||
|
}
|
||
|
break;
|
||
|
|
||
|
case T3_BLOCK_MEM_ARBITOR:
|
||
|
data = REG_RD(pDevice, MemArbiter.Mode);
|
||
|
if (cntrl == LM_DISABLE)
|
||
|
{
|
||
|
data &= ~T3_MEM_ARBITER_MODE_ENABLE;
|
||
|
REG_WR(pDevice, MemArbiter.Mode, data);
|
||
|
for(j = 0; j < MaxWaitCnt; j++)
|
||
|
{
|
||
|
if(!(REG_RD(pDevice, MemArbiter.Mode) & T3_MEM_ARBITER_MODE_ENABLE))
|
||
|
break;
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
REG_WR(pDevice, MemArbiter.Mode,data|T3_MEM_ARBITER_MODE_ENABLE);
|
||
|
break;
|
||
|
|
||
|
case T3_BLOCK_MBUF_MANAGER:
|
||
|
data = REG_RD(pDevice, BufMgr.Mode);
|
||
|
if (cntrl == LM_DISABLE)
|
||
|
{
|
||
|
data &= ~BUFMGR_MODE_ENABLE;
|
||
|
REG_WR(pDevice, BufMgr.Mode,data);
|
||
|
for(j = 0; j < MaxWaitCnt; j++)
|
||
|
{
|
||
|
if(!(REG_RD(pDevice, BufMgr.Mode) & BUFMGR_MODE_ENABLE))
|
||
|
break;
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
REG_WR(pDevice, BufMgr.Mode,data | BUFMGR_MODE_ENABLE);
|
||
|
break;
|
||
|
|
||
|
case T3_BLOCK_MAC_GLOBAL:
|
||
|
if(cntrl == LM_DISABLE)
|
||
|
{
|
||
|
pDevice->MacMode &= ~(MAC_MODE_ENABLE_TDE |
|
||
|
MAC_MODE_ENABLE_RDE |
|
||
|
MAC_MODE_ENABLE_FHDE);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
pDevice->MacMode |= (MAC_MODE_ENABLE_TDE |
|
||
|
MAC_MODE_ENABLE_RDE |
|
||
|
MAC_MODE_ENABLE_FHDE);
|
||
|
}
|
||
|
REG_WR(pDevice, MacCtrl.Mode, pDevice->MacMode);
|
||
|
break;
|
||
|
|
||
|
default:
|
||
|
return LM_STATUS_FAILURE;
|
||
|
} /* switch */
|
||
|
|
||
|
if(j >= MaxWaitCnt)
|
||
|
{
|
||
|
return LM_STATUS_FAILURE;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
}
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* This function reinitializes the adapter. */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/* LM_STATUS_SUCCESS */
|
||
|
/******************************************************************************/
|
||
|
LM_STATUS
|
||
|
LM_ResetAdapter(
|
||
|
PLM_DEVICE_BLOCK pDevice)
|
||
|
{
|
||
|
LM_UINT32 Value32;
|
||
|
LM_UINT16 Value16;
|
||
|
LM_UINT32 j, k;
|
||
|
|
||
|
/* Disable interrupt. */
|
||
|
LM_DisableInterrupt(pDevice);
|
||
|
|
||
|
/* May get a spurious interrupt */
|
||
|
pDevice->pStatusBlkVirt->Status = STATUS_BLOCK_UPDATED;
|
||
|
|
||
|
/* Disable transmit and receive DMA engines. Abort all pending requests. */
|
||
|
if(pDevice->InitDone)
|
||
|
{
|
||
|
LM_Abort(pDevice);
|
||
|
}
|
||
|
|
||
|
pDevice->ShuttingDown = FALSE;
|
||
|
|
||
|
LM_ResetChip(pDevice);
|
||
|
|
||
|
/* Bug: Athlon fix for B3 silicon only. This bit does not do anything */
|
||
|
/* in other chip revisions. */
|
||
|
if(pDevice->DelayPciGrant)
|
||
|
{
|
||
|
Value32 = REG_RD(pDevice, PciCfg.ClockCtrl);
|
||
|
REG_WR(pDevice, PciCfg.ClockCtrl, Value32 | BIT_31);
|
||
|
}
|
||
|
|
||
|
if(pDevice->ChipRevId == T3_CHIP_ID_5704_A0)
|
||
|
{
|
||
|
if (!(pDevice->PciState & T3_PCI_STATE_CONVENTIONAL_PCI_MODE))
|
||
|
{
|
||
|
Value32 = REG_RD(pDevice, PciCfg.PciState);
|
||
|
Value32 |= T3_PCI_STATE_RETRY_SAME_DMA;
|
||
|
REG_WR(pDevice, PciCfg.PciState, Value32);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Enable TaggedStatus mode. */
|
||
|
if(pDevice->UseTaggedStatus)
|
||
|
{
|
||
|
pDevice->MiscHostCtrl |= MISC_HOST_CTRL_ENABLE_TAGGED_STATUS_MODE;
|
||
|
}
|
||
|
|
||
|
/* Restore PCI configuration registers. */
|
||
|
MM_WriteConfig32(pDevice, PCI_CACHE_LINE_SIZE_REG,
|
||
|
pDevice->SavedCacheLineReg);
|
||
|
MM_WriteConfig32(pDevice, PCI_SUBSYSTEM_VENDOR_ID_REG,
|
||
|
(pDevice->SubsystemId << 16) | pDevice->SubsystemVendorId);
|
||
|
|
||
|
/* Clear the statistics block. */
|
||
|
for(j = 0x0300; j < 0x0b00; j++)
|
||
|
{
|
||
|
MEM_WR_OFFSET(pDevice, j, 0);
|
||
|
}
|
||
|
|
||
|
/* Initialize the statistis Block */
|
||
|
pDevice->pStatusBlkVirt->Status = 0;
|
||
|
pDevice->pStatusBlkVirt->RcvStdConIdx = 0;
|
||
|
pDevice->pStatusBlkVirt->RcvJumboConIdx = 0;
|
||
|
pDevice->pStatusBlkVirt->RcvMiniConIdx = 0;
|
||
|
|
||
|
for(j = 0; j < 16; j++)
|
||
|
{
|
||
|
pDevice->pStatusBlkVirt->Idx[j].RcvProdIdx = 0;
|
||
|
pDevice->pStatusBlkVirt->Idx[j].SendConIdx = 0;
|
||
|
}
|
||
|
|
||
|
for(k = 0; k < T3_STD_RCV_RCB_ENTRY_COUNT ;k++)
|
||
|
{
|
||
|
pDevice->pRxStdBdVirt[k].HostAddr.High = 0;
|
||
|
pDevice->pRxStdBdVirt[k].HostAddr.Low = 0;
|
||
|
}
|
||
|
|
||
|
#if T3_JUMBO_RCV_RCB_ENTRY_COUNT
|
||
|
/* Receive jumbo BD buffer. */
|
||
|
for(k = 0; k < T3_JUMBO_RCV_RCB_ENTRY_COUNT; k++)
|
||
|
{
|
||
|
pDevice->pRxJumboBdVirt[k].HostAddr.High = 0;
|
||
|
pDevice->pRxJumboBdVirt[k].HostAddr.Low = 0;
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
REG_WR(pDevice, PciCfg.DmaReadWriteCtrl, pDevice->DmaReadWriteCtrl);
|
||
|
|
||
|
/* GRC mode control register. */
|
||
|
#ifdef BIG_ENDIAN_PCI /* Jimmy, this ifdef block deleted in new code! */
|
||
|
Value32 =
|
||
|
GRC_MODE_WORD_SWAP_DATA |
|
||
|
GRC_MODE_WORD_SWAP_NON_FRAME_DATA |
|
||
|
GRC_MODE_INT_ON_MAC_ATTN |
|
||
|
GRC_MODE_HOST_STACK_UP;
|
||
|
#else
|
||
|
/* No CPU Swap modes for PCI IO */
|
||
|
Value32 =
|
||
|
#ifdef BIG_ENDIAN_HOST
|
||
|
GRC_MODE_BYTE_SWAP_NON_FRAME_DATA |
|
||
|
GRC_MODE_WORD_SWAP_NON_FRAME_DATA |
|
||
|
GRC_MODE_BYTE_SWAP_DATA |
|
||
|
GRC_MODE_WORD_SWAP_DATA |
|
||
|
#else
|
||
|
GRC_MODE_WORD_SWAP_NON_FRAME_DATA |
|
||
|
GRC_MODE_BYTE_SWAP_DATA |
|
||
|
GRC_MODE_WORD_SWAP_DATA |
|
||
|
#endif
|
||
|
GRC_MODE_INT_ON_MAC_ATTN |
|
||
|
GRC_MODE_HOST_STACK_UP;
|
||
|
#endif /* !BIG_ENDIAN_PCI */
|
||
|
|
||
|
/* Configure send BD mode. */
|
||
|
if(pDevice->NicSendBd == FALSE)
|
||
|
{
|
||
|
Value32 |= GRC_MODE_HOST_SEND_BDS;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
Value32 |= GRC_MODE_4X_NIC_BASED_SEND_RINGS;
|
||
|
}
|
||
|
|
||
|
/* Configure pseudo checksum mode. */
|
||
|
if(pDevice->NoTxPseudoHdrChksum)
|
||
|
{
|
||
|
Value32 |= GRC_MODE_TX_NO_PSEUDO_HEADER_CHKSUM;
|
||
|
}
|
||
|
|
||
|
if(pDevice->NoRxPseudoHdrChksum)
|
||
|
{
|
||
|
Value32 |= GRC_MODE_RX_NO_PSEUDO_HEADER_CHKSUM;
|
||
|
}
|
||
|
|
||
|
REG_WR(pDevice, Grc.Mode, Value32);
|
||
|
|
||
|
/* Setup the timer prescalar register. */
|
||
|
REG_WR(pDevice, Grc.MiscCfg, 65 << 1); /* Clock is alwasy 66Mhz. */
|
||
|
|
||
|
/* Set up the MBUF pool base address and size. */
|
||
|
REG_WR(pDevice, BufMgr.MbufPoolAddr, pDevice->MbufBase);
|
||
|
REG_WR(pDevice, BufMgr.MbufPoolSize, pDevice->MbufSize);
|
||
|
|
||
|
/* Set up the DMA descriptor pool base address and size. */
|
||
|
REG_WR(pDevice, BufMgr.DmaDescPoolAddr, T3_NIC_DMA_DESC_POOL_ADDR);
|
||
|
REG_WR(pDevice, BufMgr.DmaDescPoolSize, T3_NIC_DMA_DESC_POOL_SIZE);
|
||
|
|
||
|
/* Configure MBUF and Threshold watermarks */
|
||
|
/* Configure the DMA read MBUF low water mark. */
|
||
|
if(pDevice->DmaMbufLowMark)
|
||
|
{
|
||
|
REG_WR(pDevice, BufMgr.MbufReadDmaLowWaterMark,
|
||
|
pDevice->DmaMbufLowMark);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if(pDevice->TxMtu < MAX_ETHERNET_PACKET_BUFFER_SIZE)
|
||
|
{
|
||
|
REG_WR(pDevice, BufMgr.MbufReadDmaLowWaterMark,
|
||
|
T3_DEF_DMA_MBUF_LOW_WMARK);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
REG_WR(pDevice, BufMgr.MbufReadDmaLowWaterMark,
|
||
|
T3_DEF_DMA_MBUF_LOW_WMARK_JUMBO);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Configure the MAC Rx MBUF low water mark. */
|
||
|
if(pDevice->RxMacMbufLowMark)
|
||
|
{
|
||
|
REG_WR(pDevice, BufMgr.MbufMacRxLowWaterMark,
|
||
|
pDevice->RxMacMbufLowMark);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if(pDevice->TxMtu < MAX_ETHERNET_PACKET_BUFFER_SIZE)
|
||
|
{
|
||
|
REG_WR(pDevice, BufMgr.MbufMacRxLowWaterMark,
|
||
|
T3_DEF_RX_MAC_MBUF_LOW_WMARK);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
REG_WR(pDevice, BufMgr.MbufMacRxLowWaterMark,
|
||
|
T3_DEF_RX_MAC_MBUF_LOW_WMARK_JUMBO);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Configure the MBUF high water mark. */
|
||
|
if(pDevice->MbufHighMark)
|
||
|
{
|
||
|
REG_WR(pDevice, BufMgr.MbufHighWaterMark, pDevice->MbufHighMark);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if(pDevice->TxMtu < MAX_ETHERNET_PACKET_BUFFER_SIZE)
|
||
|
{
|
||
|
REG_WR(pDevice, BufMgr.MbufHighWaterMark,
|
||
|
T3_DEF_MBUF_HIGH_WMARK);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
REG_WR(pDevice, BufMgr.MbufHighWaterMark,
|
||
|
T3_DEF_MBUF_HIGH_WMARK_JUMBO);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
REG_WR(pDevice, BufMgr.DmaLowWaterMark, T3_DEF_DMA_DESC_LOW_WMARK);
|
||
|
REG_WR(pDevice, BufMgr.DmaHighWaterMark, T3_DEF_DMA_DESC_HIGH_WMARK);
|
||
|
|
||
|
/* Enable buffer manager. */
|
||
|
REG_WR(pDevice, BufMgr.Mode, BUFMGR_MODE_ENABLE | BUFMGR_MODE_ATTN_ENABLE);
|
||
|
|
||
|
for(j = 0 ;j < 2000; j++)
|
||
|
{
|
||
|
if(REG_RD(pDevice, BufMgr.Mode) & BUFMGR_MODE_ENABLE)
|
||
|
break;
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
|
||
|
if(j >= 2000)
|
||
|
{
|
||
|
return LM_STATUS_FAILURE;
|
||
|
}
|
||
|
|
||
|
/* Enable the FTQs. */
|
||
|
REG_WR(pDevice, Ftq.Reset, 0xffffffff);
|
||
|
REG_WR(pDevice, Ftq.Reset, 0);
|
||
|
|
||
|
/* Wait until FTQ is ready */
|
||
|
for(j = 0; j < 2000; j++)
|
||
|
{
|
||
|
if(REG_RD(pDevice, Ftq.Reset) == 0)
|
||
|
break;
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
|
||
|
if(j >= 2000)
|
||
|
{
|
||
|
return LM_STATUS_FAILURE;
|
||
|
}
|
||
|
|
||
|
/* Initialize the Standard Receive RCB. */
|
||
|
REG_WR(pDevice, RcvDataBdIn.StdRcvRcb.HostRingAddr.High,
|
||
|
pDevice->RxStdBdPhy.High);
|
||
|
REG_WR(pDevice, RcvDataBdIn.StdRcvRcb.HostRingAddr.Low,
|
||
|
pDevice->RxStdBdPhy.Low);
|
||
|
REG_WR(pDevice, RcvDataBdIn.StdRcvRcb.u.MaxLen_Flags,
|
||
|
MAX_STD_RCV_BUFFER_SIZE << 16);
|
||
|
|
||
|
/* Initialize the Jumbo Receive RCB. */
|
||
|
REG_WR(pDevice, RcvDataBdIn.JumboRcvRcb.u.MaxLen_Flags,
|
||
|
T3_RCB_FLAG_RING_DISABLED);
|
||
|
#if T3_JUMBO_RCV_RCB_ENTRY_COUNT
|
||
|
REG_WR(pDevice, RcvDataBdIn.JumboRcvRcb.HostRingAddr.High,
|
||
|
pDevice->RxJumboBdPhy.High);
|
||
|
REG_WR(pDevice, RcvDataBdIn.JumboRcvRcb.HostRingAddr.Low,
|
||
|
pDevice->RxJumboBdPhy.Low);
|
||
|
|
||
|
REG_WR(pDevice, RcvDataBdIn.JumboRcvRcb.u.MaxLen_Flags, 0);
|
||
|
|
||
|
#endif /* T3_JUMBO_RCV_RCB_ENTRY_COUNT */
|
||
|
|
||
|
/* Initialize the Mini Receive RCB. */
|
||
|
REG_WR(pDevice, RcvDataBdIn.MiniRcvRcb.u.MaxLen_Flags,
|
||
|
T3_RCB_FLAG_RING_DISABLED);
|
||
|
|
||
|
{
|
||
|
REG_WR(pDevice, RcvDataBdIn.StdRcvRcb.NicRingAddr,
|
||
|
(LM_UINT32) T3_NIC_STD_RCV_BUFFER_DESC_ADDR);
|
||
|
REG_WR(pDevice, RcvDataBdIn.JumboRcvRcb.NicRingAddr,
|
||
|
(LM_UINT32) T3_NIC_JUMBO_RCV_BUFFER_DESC_ADDR);
|
||
|
}
|
||
|
|
||
|
/* Receive BD Ring replenish threshold. */
|
||
|
REG_WR(pDevice, RcvBdIn.StdRcvThreshold, pDevice->RxStdDescCnt/8);
|
||
|
#if T3_JUMBO_RCV_RCB_ENTRY_COUNT
|
||
|
REG_WR(pDevice, RcvBdIn.JumboRcvThreshold, pDevice->RxJumboDescCnt/8);
|
||
|
#endif /* T3_JUMBO_RCV_RCB_ENTRY_COUNT */
|
||
|
|
||
|
/* Disable all the unused rings. */
|
||
|
for(j = 0; j < T3_MAX_SEND_RCB_COUNT; j++) {
|
||
|
MEM_WR(pDevice, SendRcb[j].u.MaxLen_Flags, T3_RCB_FLAG_RING_DISABLED);
|
||
|
} /* for */
|
||
|
|
||
|
/* Initialize the indices. */
|
||
|
pDevice->SendProdIdx = 0;
|
||
|
pDevice->SendConIdx = 0;
|
||
|
|
||
|
MB_REG_WR(pDevice, Mailbox.SendHostProdIdx[0].Low, 0);
|
||
|
MB_REG_WR(pDevice, Mailbox.SendNicProdIdx[0].Low, 0);
|
||
|
|
||
|
/* Set up host or NIC based send RCB. */
|
||
|
if(pDevice->NicSendBd == FALSE)
|
||
|
{
|
||
|
MEM_WR(pDevice, SendRcb[0].HostRingAddr.High,
|
||
|
pDevice->SendBdPhy.High);
|
||
|
MEM_WR(pDevice, SendRcb[0].HostRingAddr.Low,
|
||
|
pDevice->SendBdPhy.Low);
|
||
|
|
||
|
/* Set up the NIC ring address in the RCB. */
|
||
|
MEM_WR(pDevice, SendRcb[0].NicRingAddr,T3_NIC_SND_BUFFER_DESC_ADDR);
|
||
|
|
||
|
/* Setup the RCB. */
|
||
|
MEM_WR(pDevice, SendRcb[0].u.MaxLen_Flags,
|
||
|
T3_SEND_RCB_ENTRY_COUNT << 16);
|
||
|
|
||
|
for(k = 0; k < T3_SEND_RCB_ENTRY_COUNT; k++)
|
||
|
{
|
||
|
pDevice->pSendBdVirt[k].HostAddr.High = 0;
|
||
|
pDevice->pSendBdVirt[k].HostAddr.Low = 0;
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
MEM_WR(pDevice, SendRcb[0].HostRingAddr.High, 0);
|
||
|
MEM_WR(pDevice, SendRcb[0].HostRingAddr.Low, 0);
|
||
|
MEM_WR(pDevice, SendRcb[0].NicRingAddr,
|
||
|
pDevice->SendBdPhy.Low);
|
||
|
|
||
|
for(k = 0; k < T3_SEND_RCB_ENTRY_COUNT; k++)
|
||
|
{
|
||
|
__raw_writel(0, &(pDevice->pSendBdVirt[k].HostAddr.High));
|
||
|
__raw_writel(0, &(pDevice->pSendBdVirt[k].HostAddr.Low));
|
||
|
__raw_writel(0, &(pDevice->pSendBdVirt[k].u1.Len_Flags));
|
||
|
pDevice->ShadowSendBd[k].HostAddr.High = 0;
|
||
|
pDevice->ShadowSendBd[k].u1.Len_Flags = 0;
|
||
|
}
|
||
|
}
|
||
|
atomic_set(&pDevice->SendBdLeft, T3_SEND_RCB_ENTRY_COUNT-1);
|
||
|
|
||
|
/* Configure the receive return rings. */
|
||
|
for(j = 0; j < T3_MAX_RCV_RETURN_RCB_COUNT; j++)
|
||
|
{
|
||
|
MEM_WR(pDevice, RcvRetRcb[j].u.MaxLen_Flags, T3_RCB_FLAG_RING_DISABLED);
|
||
|
}
|
||
|
|
||
|
pDevice->RcvRetConIdx = 0;
|
||
|
|
||
|
MEM_WR(pDevice, RcvRetRcb[0].HostRingAddr.High,
|
||
|
pDevice->RcvRetBdPhy.High);
|
||
|
MEM_WR(pDevice, RcvRetRcb[0].HostRingAddr.Low,
|
||
|
pDevice->RcvRetBdPhy.Low);
|
||
|
|
||
|
/* Set up the NIC ring address in the RCB. */
|
||
|
/* Not very clear from the spec. I am guessing that for Receive */
|
||
|
/* Return Ring, NicRingAddr is not used. */
|
||
|
MEM_WR(pDevice, RcvRetRcb[0].NicRingAddr, 0);
|
||
|
|
||
|
/* Setup the RCB. */
|
||
|
MEM_WR(pDevice, RcvRetRcb[0].u.MaxLen_Flags,
|
||
|
T3_RCV_RETURN_RCB_ENTRY_COUNT << 16);
|
||
|
|
||
|
/* Reinitialize RX ring producer index */
|
||
|
MB_REG_WR(pDevice, Mailbox.RcvStdProdIdx.Low, 0);
|
||
|
MB_REG_WR(pDevice, Mailbox.RcvJumboProdIdx.Low, 0);
|
||
|
MB_REG_WR(pDevice, Mailbox.RcvMiniProdIdx.Low, 0);
|
||
|
|
||
|
#if T3_JUMBO_RCV_RCB_ENTRY_COUNT
|
||
|
pDevice->RxJumboProdIdx = 0;
|
||
|
pDevice->RxJumboQueuedCnt = 0;
|
||
|
#endif
|
||
|
|
||
|
/* Reinitialize our copy of the indices. */
|
||
|
pDevice->RxStdProdIdx = 0;
|
||
|
pDevice->RxStdQueuedCnt = 0;
|
||
|
|
||
|
#if T3_JUMBO_RCV_ENTRY_COUNT
|
||
|
pDevice->RxJumboProdIdx = 0;
|
||
|
#endif /* T3_JUMBO_RCV_ENTRY_COUNT */
|
||
|
|
||
|
/* Configure the MAC address. */
|
||
|
LM_SetMacAddress(pDevice, pDevice->NodeAddress);
|
||
|
|
||
|
/* Initialize the transmit random backoff seed. */
|
||
|
Value32 = (pDevice->NodeAddress[0] + pDevice->NodeAddress[1] +
|
||
|
pDevice->NodeAddress[2] + pDevice->NodeAddress[3] +
|
||
|
pDevice->NodeAddress[4] + pDevice->NodeAddress[5]) &
|
||
|
MAC_TX_BACKOFF_SEED_MASK;
|
||
|
REG_WR(pDevice, MacCtrl.TxBackoffSeed, Value32);
|
||
|
|
||
|
/* Receive MTU. Frames larger than the MTU is marked as oversized. */
|
||
|
REG_WR(pDevice, MacCtrl.MtuSize, pDevice->RxMtu + 8); /* CRC + VLAN. */
|
||
|
|
||
|
/* Configure Time slot/IPG per 802.3 */
|
||
|
REG_WR(pDevice, MacCtrl.TxLengths, 0x2620);
|
||
|
|
||
|
/*
|
||
|
* Configure Receive Rules so that packets don't match
|
||
|
* Programmble rule will be queued to Return Ring 1
|
||
|
*/
|
||
|
REG_WR(pDevice, MacCtrl.RcvRuleCfg, RX_RULE_DEFAULT_CLASS);
|
||
|
|
||
|
/*
|
||
|
* Configure to have 16 Classes of Services (COS) and one
|
||
|
* queue per class. Bad frames are queued to RRR#1.
|
||
|
* And frames don't match rules are also queued to COS#1.
|
||
|
*/
|
||
|
REG_WR(pDevice, RcvListPlmt.Config, 0x181);
|
||
|
|
||
|
/* Enable Receive Placement Statistics */
|
||
|
REG_WR(pDevice, RcvListPlmt.StatsEnableMask,0xffffff);
|
||
|
REG_WR(pDevice, RcvListPlmt.StatsCtrl, RCV_LIST_STATS_ENABLE);
|
||
|
|
||
|
/* Enable Send Data Initator Statistics */
|
||
|
REG_WR(pDevice, SndDataIn.StatsEnableMask,0xffffff);
|
||
|
REG_WR(pDevice, SndDataIn.StatsCtrl,
|
||
|
T3_SND_DATA_IN_STATS_CTRL_ENABLE | \
|
||
|
T3_SND_DATA_IN_STATS_CTRL_FASTER_UPDATE);
|
||
|
|
||
|
/* Disable the host coalescing state machine before configuring it's */
|
||
|
/* parameters. */
|
||
|
REG_WR(pDevice, HostCoalesce.Mode, 0);
|
||
|
for(j = 0; j < 2000; j++)
|
||
|
{
|
||
|
Value32 = REG_RD(pDevice, HostCoalesce.Mode);
|
||
|
if(!(Value32 & HOST_COALESCE_ENABLE))
|
||
|
{
|
||
|
break;
|
||
|
}
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
|
||
|
/* Host coalescing configurations. */
|
||
|
REG_WR(pDevice, HostCoalesce.RxCoalescingTicks, pDevice->RxCoalescingTicks);
|
||
|
REG_WR(pDevice, HostCoalesce.TxCoalescingTicks, pDevice->TxCoalescingTicks);
|
||
|
REG_WR(pDevice, HostCoalesce.RxMaxCoalescedFrames,
|
||
|
pDevice->RxMaxCoalescedFrames);
|
||
|
REG_WR(pDevice, HostCoalesce.TxMaxCoalescedFrames,
|
||
|
pDevice->TxMaxCoalescedFrames);
|
||
|
REG_WR(pDevice, HostCoalesce.RxCoalescedTickDuringInt,
|
||
|
pDevice->RxCoalescingTicksDuringInt);
|
||
|
REG_WR(pDevice, HostCoalesce.TxCoalescedTickDuringInt,
|
||
|
pDevice->TxCoalescingTicksDuringInt);
|
||
|
REG_WR(pDevice, HostCoalesce.RxMaxCoalescedFramesDuringInt,
|
||
|
pDevice->RxMaxCoalescedFramesDuringInt);
|
||
|
REG_WR(pDevice, HostCoalesce.TxMaxCoalescedFramesDuringInt,
|
||
|
pDevice->TxMaxCoalescedFramesDuringInt);
|
||
|
|
||
|
/* Initialize the address of the status block. The NIC will DMA */
|
||
|
/* the status block to this memory which resides on the host. */
|
||
|
REG_WR(pDevice, HostCoalesce.StatusBlkHostAddr.High,
|
||
|
pDevice->StatusBlkPhy.High);
|
||
|
REG_WR(pDevice, HostCoalesce.StatusBlkHostAddr.Low,
|
||
|
pDevice->StatusBlkPhy.Low);
|
||
|
|
||
|
/* Initialize the address of the statistics block. The NIC will DMA */
|
||
|
/* the statistics to this block of memory. */
|
||
|
REG_WR(pDevice, HostCoalesce.StatsBlkHostAddr.High,
|
||
|
pDevice->StatsBlkPhy.High);
|
||
|
REG_WR(pDevice, HostCoalesce.StatsBlkHostAddr.Low,
|
||
|
pDevice->StatsBlkPhy.Low);
|
||
|
|
||
|
REG_WR(pDevice, HostCoalesce.StatsCoalescingTicks,
|
||
|
pDevice->StatsCoalescingTicks);
|
||
|
|
||
|
REG_WR(pDevice, HostCoalesce.StatsBlkNicAddr, 0x300);
|
||
|
REG_WR(pDevice, HostCoalesce.StatusBlkNicAddr,0xb00);
|
||
|
|
||
|
/* Enable Host Coalesing state machine */
|
||
|
REG_WR(pDevice, HostCoalesce.Mode, HOST_COALESCE_ENABLE |
|
||
|
pDevice->CoalesceMode);
|
||
|
|
||
|
/* Enable the Receive BD Completion state machine. */
|
||
|
REG_WR(pDevice, RcvBdComp.Mode, RCV_BD_COMP_MODE_ENABLE |
|
||
|
RCV_BD_COMP_MODE_ATTN_ENABLE);
|
||
|
|
||
|
/* Enable the Receive List Placement state machine. */
|
||
|
REG_WR(pDevice, RcvListPlmt.Mode, RCV_LIST_PLMT_MODE_ENABLE);
|
||
|
|
||
|
/* Enable the Receive List Selector state machine. */
|
||
|
REG_WR(pDevice, RcvListSel.Mode, RCV_LIST_SEL_MODE_ENABLE |
|
||
|
RCV_LIST_SEL_MODE_ATTN_ENABLE);
|
||
|
|
||
|
/* Enable transmit DMA, clear statistics. */
|
||
|
pDevice->MacMode = MAC_MODE_ENABLE_TX_STATISTICS |
|
||
|
MAC_MODE_ENABLE_RX_STATISTICS | MAC_MODE_ENABLE_TDE |
|
||
|
MAC_MODE_ENABLE_RDE | MAC_MODE_ENABLE_FHDE;
|
||
|
REG_WR(pDevice, MacCtrl.Mode, pDevice->MacMode |
|
||
|
MAC_MODE_CLEAR_RX_STATISTICS | MAC_MODE_CLEAR_TX_STATISTICS);
|
||
|
|
||
|
/* GRC miscellaneous local control register. */
|
||
|
pDevice->GrcLocalCtrl = GRC_MISC_LOCAL_CTRL_INT_ON_ATTN |
|
||
|
GRC_MISC_LOCAL_CTRL_AUTO_SEEPROM;
|
||
|
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700)
|
||
|
{
|
||
|
pDevice->GrcLocalCtrl |= GRC_MISC_LOCAL_CTRL_GPIO_OE1 |
|
||
|
GRC_MISC_LOCAL_CTRL_GPIO_OUTPUT1;
|
||
|
}
|
||
|
|
||
|
REG_WR(pDevice, Grc.LocalCtrl, pDevice->GrcLocalCtrl);
|
||
|
MM_Wait(40);
|
||
|
|
||
|
/* Reset RX counters. */
|
||
|
for(j = 0; j < sizeof(LM_RX_COUNTERS); j++)
|
||
|
{
|
||
|
((PLM_UINT8) &pDevice->RxCounters)[j] = 0;
|
||
|
}
|
||
|
|
||
|
/* Reset TX counters. */
|
||
|
for(j = 0; j < sizeof(LM_TX_COUNTERS); j++)
|
||
|
{
|
||
|
((PLM_UINT8) &pDevice->TxCounters)[j] = 0;
|
||
|
}
|
||
|
|
||
|
MB_REG_WR(pDevice, Mailbox.Interrupt[0].Low, 0);
|
||
|
|
||
|
/* Enable the DMA Completion state machine. */
|
||
|
REG_WR(pDevice, DmaComp.Mode, DMA_COMP_MODE_ENABLE);
|
||
|
|
||
|
/* Enable the DMA Write state machine. */
|
||
|
Value32 = DMA_WRITE_MODE_ENABLE |
|
||
|
DMA_WRITE_MODE_TARGET_ABORT_ATTN_ENABLE |
|
||
|
DMA_WRITE_MODE_MASTER_ABORT_ATTN_ENABLE |
|
||
|
DMA_WRITE_MODE_PARITY_ERROR_ATTN_ENABLE |
|
||
|
DMA_WRITE_MODE_ADDR_OVERFLOW_ATTN_ENABLE |
|
||
|
DMA_WRITE_MODE_FIFO_OVERRUN_ATTN_ENABLE |
|
||
|
DMA_WRITE_MODE_FIFO_UNDERRUN_ATTN_ENABLE |
|
||
|
DMA_WRITE_MODE_FIFO_OVERREAD_ATTN_ENABLE |
|
||
|
DMA_WRITE_MODE_LONG_READ_ATTN_ENABLE;
|
||
|
REG_WR(pDevice, DmaWrite.Mode, Value32);
|
||
|
|
||
|
if (!(pDevice->PciState & T3_PCI_STATE_CONVENTIONAL_PCI_MODE))
|
||
|
{
|
||
|
if (pDevice->ChipRevId == T3_CHIP_ID_5704_A0)
|
||
|
{
|
||
|
Value16 = REG_RD(pDevice, PciCfg.PciXCommand);
|
||
|
Value16 &= ~(PCIX_CMD_MAX_SPLIT_MASK | PCIX_CMD_MAX_BURST_MASK);
|
||
|
Value16 |= ((PCIX_CMD_MAX_BURST_CPIOB << PCIX_CMD_MAX_BURST_SHL) &
|
||
|
PCIX_CMD_MAX_BURST_MASK);
|
||
|
if (pDevice->SplitModeEnable == SPLIT_MODE_ENABLE)
|
||
|
{
|
||
|
Value16 |= (pDevice->SplitModeMaxReq << PCIX_CMD_MAX_SPLIT_SHL)
|
||
|
& PCIX_CMD_MAX_SPLIT_MASK;
|
||
|
}
|
||
|
REG_WR(pDevice, PciCfg.PciXCommand, Value16);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Enable the Read DMA state machine. */
|
||
|
Value32 = DMA_READ_MODE_ENABLE |
|
||
|
DMA_READ_MODE_TARGET_ABORT_ATTN_ENABLE |
|
||
|
DMA_READ_MODE_MASTER_ABORT_ATTN_ENABLE |
|
||
|
DMA_READ_MODE_PARITY_ERROR_ATTN_ENABLE |
|
||
|
DMA_READ_MODE_ADDR_OVERFLOW_ATTN_ENABLE |
|
||
|
DMA_READ_MODE_FIFO_OVERRUN_ATTN_ENABLE |
|
||
|
DMA_READ_MODE_FIFO_UNDERRUN_ATTN_ENABLE |
|
||
|
DMA_READ_MODE_FIFO_OVERREAD_ATTN_ENABLE |
|
||
|
DMA_READ_MODE_LONG_READ_ATTN_ENABLE;
|
||
|
|
||
|
if (pDevice->SplitModeEnable == SPLIT_MODE_ENABLE)
|
||
|
{
|
||
|
Value32 |= DMA_READ_MODE_SPLIT_ENABLE;
|
||
|
}
|
||
|
REG_WR(pDevice, DmaRead.Mode, Value32);
|
||
|
|
||
|
/* Enable the Receive Data Completion state machine. */
|
||
|
REG_WR(pDevice, RcvDataComp.Mode, RCV_DATA_COMP_MODE_ENABLE |
|
||
|
RCV_DATA_COMP_MODE_ATTN_ENABLE);
|
||
|
|
||
|
/* Enable the Mbuf Cluster Free state machine. */
|
||
|
REG_WR(pDevice, MbufClusterFree.Mode, MBUF_CLUSTER_FREE_MODE_ENABLE);
|
||
|
|
||
|
/* Enable the Send Data Completion state machine. */
|
||
|
REG_WR(pDevice, SndDataComp.Mode, SND_DATA_COMP_MODE_ENABLE);
|
||
|
|
||
|
/* Enable the Send BD Completion state machine. */
|
||
|
REG_WR(pDevice, SndBdComp.Mode, SND_BD_COMP_MODE_ENABLE |
|
||
|
SND_BD_COMP_MODE_ATTN_ENABLE);
|
||
|
|
||
|
/* Enable the Receive BD Initiator state machine. */
|
||
|
REG_WR(pDevice, RcvBdIn.Mode, RCV_BD_IN_MODE_ENABLE |
|
||
|
RCV_BD_IN_MODE_BD_IN_DIABLED_RCB_ATTN_ENABLE);
|
||
|
|
||
|
/* Enable the Receive Data and Receive BD Initiator state machine. */
|
||
|
REG_WR(pDevice, RcvDataBdIn.Mode, RCV_DATA_BD_IN_MODE_ENABLE |
|
||
|
RCV_DATA_BD_IN_MODE_INVALID_RING_SIZE);
|
||
|
|
||
|
/* Enable the Send Data Initiator state machine. */
|
||
|
REG_WR(pDevice, SndDataIn.Mode, T3_SND_DATA_IN_MODE_ENABLE);
|
||
|
|
||
|
/* Enable the Send BD Initiator state machine. */
|
||
|
REG_WR(pDevice, SndBdIn.Mode, SND_BD_IN_MODE_ENABLE |
|
||
|
SND_BD_IN_MODE_ATTN_ENABLE);
|
||
|
|
||
|
/* Enable the Send BD Selector state machine. */
|
||
|
REG_WR(pDevice, SndBdSel.Mode, SND_BD_SEL_MODE_ENABLE |
|
||
|
SND_BD_SEL_MODE_ATTN_ENABLE);
|
||
|
|
||
|
#if INCLUDE_5701_AX_FIX
|
||
|
/* Load the firmware for the 5701_A0 workaround. */
|
||
|
if(pDevice->ChipRevId == T3_CHIP_ID_5701_A0)
|
||
|
{
|
||
|
LM_LoadRlsFirmware(pDevice);
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
/* Enable the transmitter. */
|
||
|
pDevice->TxMode = TX_MODE_ENABLE;
|
||
|
REG_WR(pDevice, MacCtrl.TxMode, pDevice->TxMode);
|
||
|
|
||
|
/* Enable the receiver. */
|
||
|
pDevice->RxMode = RX_MODE_ENABLE;
|
||
|
REG_WR(pDevice, MacCtrl.RxMode, pDevice->RxMode);
|
||
|
|
||
|
if (pDevice->RestoreOnWakeUp)
|
||
|
{
|
||
|
pDevice->RestoreOnWakeUp = FALSE;
|
||
|
pDevice->DisableAutoNeg = pDevice->WakeUpDisableAutoNeg;
|
||
|
pDevice->RequestedMediaType = pDevice->WakeUpRequestedMediaType;
|
||
|
}
|
||
|
|
||
|
/* Disable auto polling. */
|
||
|
pDevice->MiMode = 0xc0000;
|
||
|
REG_WR(pDevice, MacCtrl.MiMode, pDevice->MiMode);
|
||
|
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700 ||
|
||
|
T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5701)
|
||
|
{
|
||
|
Value32 = LED_CTRL_PHY_MODE_1;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if(pDevice->LedMode == LED_MODE_OUTPUT)
|
||
|
{
|
||
|
Value32 = LED_CTRL_PHY_MODE_2;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
Value32 = LED_CTRL_PHY_MODE_1;
|
||
|
}
|
||
|
}
|
||
|
REG_WR(pDevice, MacCtrl.LedCtrl, Value32);
|
||
|
|
||
|
/* Activate Link to enable MAC state machine */
|
||
|
REG_WR(pDevice, MacCtrl.MiStatus, MI_STATUS_ENABLE_LINK_STATUS_ATTN);
|
||
|
|
||
|
if (pDevice->EnableTbi)
|
||
|
{
|
||
|
REG_WR(pDevice, MacCtrl.RxMode, RX_MODE_RESET);
|
||
|
MM_Wait(10);
|
||
|
REG_WR(pDevice, MacCtrl.RxMode, pDevice->RxMode);
|
||
|
if (pDevice->ChipRevId == T3_CHIP_ID_5703_A1)
|
||
|
{
|
||
|
REG_WR(pDevice, MacCtrl.SerdesCfg, 0x616000);
|
||
|
}
|
||
|
}
|
||
|
/* Setup the phy chip. */
|
||
|
LM_SetupPhy(pDevice);
|
||
|
|
||
|
if (!pDevice->EnableTbi) {
|
||
|
/* Clear CRC stats */
|
||
|
LM_ReadPhy(pDevice, 0x1e, &Value32);
|
||
|
LM_WritePhy(pDevice, 0x1e, Value32 | 0x8000);
|
||
|
LM_ReadPhy(pDevice, 0x14, &Value32);
|
||
|
}
|
||
|
|
||
|
/* Set up the receive mask. */
|
||
|
LM_SetReceiveMask(pDevice, pDevice->ReceiveMask);
|
||
|
|
||
|
/* Queue Rx packet buffers. */
|
||
|
if(pDevice->QueueRxPackets)
|
||
|
{
|
||
|
LM_QueueRxPackets(pDevice);
|
||
|
}
|
||
|
|
||
|
/* Enable interrupt to the host. */
|
||
|
if(pDevice->InitDone)
|
||
|
{
|
||
|
LM_EnableInterrupt(pDevice);
|
||
|
}
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
} /* LM_ResetAdapter */
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* This routine disables the adapter from generating interrupts. */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/* LM_STATUS_SUCCESS */
|
||
|
/******************************************************************************/
|
||
|
LM_STATUS
|
||
|
LM_DisableInterrupt(
|
||
|
PLM_DEVICE_BLOCK pDevice)
|
||
|
{
|
||
|
REG_WR(pDevice, PciCfg.MiscHostCtrl, pDevice->MiscHostCtrl |
|
||
|
MISC_HOST_CTRL_MASK_PCI_INT);
|
||
|
MB_REG_WR(pDevice, Mailbox.Interrupt[0].Low, 1);
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
}
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* This routine enables the adapter to generate interrupts. */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/* LM_STATUS_SUCCESS */
|
||
|
/******************************************************************************/
|
||
|
LM_STATUS
|
||
|
LM_EnableInterrupt(
|
||
|
PLM_DEVICE_BLOCK pDevice)
|
||
|
{
|
||
|
REG_WR(pDevice, PciCfg.MiscHostCtrl, pDevice->MiscHostCtrl &
|
||
|
~MISC_HOST_CTRL_MASK_PCI_INT);
|
||
|
MB_REG_WR(pDevice, Mailbox.Interrupt[0].Low, 0);
|
||
|
|
||
|
if(pDevice->pStatusBlkVirt->Status & STATUS_BLOCK_UPDATED)
|
||
|
{
|
||
|
REG_WR(pDevice, Grc.LocalCtrl, pDevice->GrcLocalCtrl |
|
||
|
GRC_MISC_LOCAL_CTRL_SET_INT);
|
||
|
}
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
}
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* This routine puts a packet on the wire if there is a transmit DMA */
|
||
|
/* descriptor available; otherwise the packet is queued for later */
|
||
|
/* transmission. If the second argue is NULL, this routine will put */
|
||
|
/* the queued packet on the wire if possible. */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/* LM_STATUS_SUCCESS */
|
||
|
/******************************************************************************/
|
||
|
#if 0
|
||
|
LM_STATUS
|
||
|
LM_SendPacket(PLM_DEVICE_BLOCK pDevice, PLM_PACKET pPacket)
|
||
|
{
|
||
|
LM_UINT32 FragCount;
|
||
|
PT3_SND_BD pSendBd;
|
||
|
PT3_SND_BD pShadowSendBd;
|
||
|
LM_UINT32 Value32, Len;
|
||
|
LM_UINT32 Idx;
|
||
|
|
||
|
if (T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700) {
|
||
|
return LM_5700SendPacket(pDevice, pPacket);
|
||
|
}
|
||
|
|
||
|
/* Update the SendBdLeft count. */
|
||
|
atomic_sub(pPacket->u.Tx.FragCount, &pDevice->SendBdLeft);
|
||
|
|
||
|
/* Initalize the send buffer descriptors. */
|
||
|
Idx = pDevice->SendProdIdx;
|
||
|
|
||
|
pSendBd = &pDevice->pSendBdVirt[Idx];
|
||
|
|
||
|
/* Next producer index. */
|
||
|
if (pDevice->NicSendBd == TRUE)
|
||
|
{
|
||
|
T3_64BIT_HOST_ADDR paddr;
|
||
|
|
||
|
pShadowSendBd = &pDevice->ShadowSendBd[Idx];
|
||
|
for(FragCount = 0; ; )
|
||
|
{
|
||
|
MM_MapTxDma(pDevice, pPacket, &paddr, &Len, FragCount);
|
||
|
/* Initialize the pointer to the send buffer fragment. */
|
||
|
if (paddr.High != pShadowSendBd->HostAddr.High)
|
||
|
{
|
||
|
__raw_writel(paddr.High, &(pSendBd->HostAddr.High));
|
||
|
pShadowSendBd->HostAddr.High = paddr.High;
|
||
|
}
|
||
|
__raw_writel(paddr.Low, &(pSendBd->HostAddr.Low));
|
||
|
|
||
|
/* Setup the control flags and send buffer size. */
|
||
|
Value32 = (Len << 16) | pPacket->Flags;
|
||
|
|
||
|
Idx = (Idx + 1) & T3_SEND_RCB_ENTRY_COUNT_MASK;
|
||
|
|
||
|
FragCount++;
|
||
|
if (FragCount >= pPacket->u.Tx.FragCount)
|
||
|
{
|
||
|
Value32 |= SND_BD_FLAG_END;
|
||
|
if (Value32 != pShadowSendBd->u1.Len_Flags)
|
||
|
{
|
||
|
__raw_writel(Value32, &(pSendBd->u1.Len_Flags));
|
||
|
pShadowSendBd->u1.Len_Flags = Value32;
|
||
|
}
|
||
|
if (pPacket->Flags & SND_BD_FLAG_VLAN_TAG) {
|
||
|
__raw_writel(pPacket->VlanTag, &(pSendBd->u2.VlanTag));
|
||
|
}
|
||
|
break;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if (Value32 != pShadowSendBd->u1.Len_Flags)
|
||
|
{
|
||
|
__raw_writel(Value32, &(pSendBd->u1.Len_Flags));
|
||
|
pShadowSendBd->u1.Len_Flags = Value32;
|
||
|
}
|
||
|
if (pPacket->Flags & SND_BD_FLAG_VLAN_TAG) {
|
||
|
__raw_writel(pPacket->VlanTag, &(pSendBd->u2.VlanTag));
|
||
|
}
|
||
|
}
|
||
|
|
||
|
pSendBd++;
|
||
|
pShadowSendBd++;
|
||
|
if (Idx == 0)
|
||
|
{
|
||
|
pSendBd = &pDevice->pSendBdVirt[0];
|
||
|
pShadowSendBd = &pDevice->ShadowSendBd[0];
|
||
|
}
|
||
|
} /* for */
|
||
|
|
||
|
/* Put the packet descriptor in the ActiveQ. */
|
||
|
QQ_PushTail(&pDevice->TxPacketActiveQ.Container, pPacket);
|
||
|
|
||
|
wmb();
|
||
|
MB_REG_WR(pDevice, Mailbox.SendNicProdIdx[0].Low, Idx);
|
||
|
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
for(FragCount = 0; ; )
|
||
|
{
|
||
|
/* Initialize the pointer to the send buffer fragment. */
|
||
|
MM_MapTxDma(pDevice, pPacket, &pSendBd->HostAddr, &Len, FragCount);
|
||
|
|
||
|
pSendBd->u2.VlanTag = pPacket->VlanTag;
|
||
|
|
||
|
/* Setup the control flags and send buffer size. */
|
||
|
Value32 = (Len << 16) | pPacket->Flags;
|
||
|
|
||
|
Idx = (Idx + 1) & T3_SEND_RCB_ENTRY_COUNT_MASK;
|
||
|
|
||
|
FragCount++;
|
||
|
if (FragCount >= pPacket->u.Tx.FragCount)
|
||
|
{
|
||
|
pSendBd->u1.Len_Flags = Value32 | SND_BD_FLAG_END;
|
||
|
break;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
pSendBd->u1.Len_Flags = Value32;
|
||
|
}
|
||
|
pSendBd++;
|
||
|
if (Idx == 0)
|
||
|
{
|
||
|
pSendBd = &pDevice->pSendBdVirt[0];
|
||
|
}
|
||
|
} /* for */
|
||
|
|
||
|
/* Put the packet descriptor in the ActiveQ. */
|
||
|
QQ_PushTail(&pDevice->TxPacketActiveQ.Container, pPacket);
|
||
|
|
||
|
wmb();
|
||
|
MB_REG_WR(pDevice, Mailbox.SendHostProdIdx[0].Low, Idx);
|
||
|
|
||
|
}
|
||
|
|
||
|
/* Update the producer index. */
|
||
|
pDevice->SendProdIdx = Idx;
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
LM_STATUS
|
||
|
LM_SendPacket(PLM_DEVICE_BLOCK pDevice, PLM_PACKET pPacket)
|
||
|
{
|
||
|
LM_UINT32 FragCount;
|
||
|
PT3_SND_BD pSendBd, pTmpSendBd, pShadowSendBd;
|
||
|
T3_SND_BD NicSendBdArr[MAX_FRAGMENT_COUNT];
|
||
|
LM_UINT32 StartIdx, Idx;
|
||
|
|
||
|
while (1)
|
||
|
{
|
||
|
/* Initalize the send buffer descriptors. */
|
||
|
StartIdx = Idx = pDevice->SendProdIdx;
|
||
|
|
||
|
if (pDevice->NicSendBd)
|
||
|
{
|
||
|
pTmpSendBd = pSendBd = &NicSendBdArr[0];
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
pTmpSendBd = pSendBd = &pDevice->pSendBdVirt[Idx];
|
||
|
}
|
||
|
|
||
|
/* Next producer index. */
|
||
|
for(FragCount = 0; ; )
|
||
|
{
|
||
|
LM_UINT32 Value32, Len;
|
||
|
|
||
|
/* Initialize the pointer to the send buffer fragment. */
|
||
|
MM_MapTxDma(pDevice, pPacket, &pSendBd->HostAddr, &Len, FragCount);
|
||
|
|
||
|
pSendBd->u2.VlanTag = pPacket->VlanTag;
|
||
|
|
||
|
/* Setup the control flags and send buffer size. */
|
||
|
Value32 = (Len << 16) | pPacket->Flags;
|
||
|
|
||
|
Idx = (Idx + 1) & T3_SEND_RCB_ENTRY_COUNT_MASK;
|
||
|
|
||
|
FragCount++;
|
||
|
if (FragCount >= pPacket->u.Tx.FragCount)
|
||
|
{
|
||
|
pSendBd->u1.Len_Flags = Value32 | SND_BD_FLAG_END;
|
||
|
break;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
pSendBd->u1.Len_Flags = Value32;
|
||
|
}
|
||
|
pSendBd++;
|
||
|
if ((Idx == 0) && !pDevice->NicSendBd)
|
||
|
{
|
||
|
pSendBd = &pDevice->pSendBdVirt[0];
|
||
|
}
|
||
|
} /* for */
|
||
|
if (T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700)
|
||
|
{
|
||
|
if (LM_Test4GBoundary(pDevice, pPacket, pTmpSendBd) ==
|
||
|
LM_STATUS_SUCCESS)
|
||
|
{
|
||
|
if (MM_CoalesceTxBuffer(pDevice, pPacket) != LM_STATUS_SUCCESS)
|
||
|
{
|
||
|
QQ_PushHead(&pDevice->TxPacketFreeQ.Container, pPacket);
|
||
|
return LM_STATUS_FAILURE;
|
||
|
}
|
||
|
continue;
|
||
|
}
|
||
|
}
|
||
|
break;
|
||
|
}
|
||
|
/* Put the packet descriptor in the ActiveQ. */
|
||
|
QQ_PushTail(&pDevice->TxPacketActiveQ.Container, pPacket);
|
||
|
|
||
|
if (pDevice->NicSendBd)
|
||
|
{
|
||
|
pSendBd = &pDevice->pSendBdVirt[StartIdx];
|
||
|
pShadowSendBd = &pDevice->ShadowSendBd[StartIdx];
|
||
|
|
||
|
while (StartIdx != Idx)
|
||
|
{
|
||
|
LM_UINT32 Value32;
|
||
|
|
||
|
if ((Value32 = pTmpSendBd->HostAddr.High) !=
|
||
|
pShadowSendBd->HostAddr.High)
|
||
|
{
|
||
|
__raw_writel(Value32, &(pSendBd->HostAddr.High));
|
||
|
pShadowSendBd->HostAddr.High = Value32;
|
||
|
}
|
||
|
|
||
|
__raw_writel(pTmpSendBd->HostAddr.Low, &(pSendBd->HostAddr.Low));
|
||
|
|
||
|
if ((Value32 = pTmpSendBd->u1.Len_Flags) !=
|
||
|
pShadowSendBd->u1.Len_Flags)
|
||
|
{
|
||
|
__raw_writel(Value32, &(pSendBd->u1.Len_Flags));
|
||
|
pShadowSendBd->u1.Len_Flags = Value32;
|
||
|
}
|
||
|
|
||
|
if (pPacket->Flags & SND_BD_FLAG_VLAN_TAG)
|
||
|
{
|
||
|
__raw_writel(pTmpSendBd->u2.VlanTag, &(pSendBd->u2.VlanTag));
|
||
|
}
|
||
|
|
||
|
StartIdx = (StartIdx + 1) & T3_SEND_RCB_ENTRY_COUNT_MASK;
|
||
|
if (StartIdx == 0)
|
||
|
pSendBd = &pDevice->pSendBdVirt[0];
|
||
|
else
|
||
|
pSendBd++;
|
||
|
pTmpSendBd++;
|
||
|
}
|
||
|
wmb();
|
||
|
MB_REG_WR(pDevice, Mailbox.SendNicProdIdx[0].Low, Idx);
|
||
|
|
||
|
if(T3_CHIP_REV(pDevice->ChipRevId) == T3_CHIP_REV_5700_BX)
|
||
|
{
|
||
|
MB_REG_WR(pDevice, Mailbox.SendNicProdIdx[0].Low, Idx);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
wmb();
|
||
|
MB_REG_WR(pDevice, Mailbox.SendHostProdIdx[0].Low, Idx);
|
||
|
|
||
|
if(T3_CHIP_REV(pDevice->ChipRevId) == T3_CHIP_REV_5700_BX)
|
||
|
{
|
||
|
MB_REG_WR(pDevice, Mailbox.SendHostProdIdx[0].Low, Idx);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Update the SendBdLeft count. */
|
||
|
atomic_sub(pPacket->u.Tx.FragCount, &pDevice->SendBdLeft);
|
||
|
|
||
|
/* Update the producer index. */
|
||
|
pDevice->SendProdIdx = Idx;
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
}
|
||
|
|
||
|
STATIC LM_STATUS
|
||
|
LM_Test4GBoundary(PLM_DEVICE_BLOCK pDevice, PLM_PACKET pPacket,
|
||
|
PT3_SND_BD pSendBd)
|
||
|
{
|
||
|
int FragCount;
|
||
|
LM_UINT32 Idx, Base, Len;
|
||
|
|
||
|
Idx = pDevice->SendProdIdx;
|
||
|
for(FragCount = 0; ; )
|
||
|
{
|
||
|
Len = pSendBd->u1.Len_Flags >> 16;
|
||
|
if (((Base = pSendBd->HostAddr.Low) > 0xffffdcc0) &&
|
||
|
(pSendBd->HostAddr.High == 0) &&
|
||
|
((Base + 8 + Len) < Base))
|
||
|
{
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
}
|
||
|
FragCount++;
|
||
|
if (FragCount >= pPacket->u.Tx.FragCount)
|
||
|
{
|
||
|
break;
|
||
|
}
|
||
|
pSendBd++;
|
||
|
if (!pDevice->NicSendBd)
|
||
|
{
|
||
|
Idx = (Idx + 1) & T3_SEND_RCB_ENTRY_COUNT_MASK;
|
||
|
if (Idx == 0)
|
||
|
{
|
||
|
pSendBd = &pDevice->pSendBdVirt[0];
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
return LM_STATUS_FAILURE;
|
||
|
}
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
__inline static unsigned long
|
||
|
ComputeCrc32(
|
||
|
unsigned char *pBuffer,
|
||
|
unsigned long BufferSize) {
|
||
|
unsigned long Reg;
|
||
|
unsigned long Tmp;
|
||
|
unsigned long j, k;
|
||
|
|
||
|
Reg = 0xffffffff;
|
||
|
|
||
|
for(j = 0; j < BufferSize; j++)
|
||
|
{
|
||
|
Reg ^= pBuffer[j];
|
||
|
|
||
|
for(k = 0; k < 8; k++)
|
||
|
{
|
||
|
Tmp = Reg & 0x01;
|
||
|
|
||
|
Reg >>= 1;
|
||
|
|
||
|
if(Tmp)
|
||
|
{
|
||
|
Reg ^= 0xedb88320;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return ~Reg;
|
||
|
} /* ComputeCrc32 */
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* This routine sets the receive control register according to ReceiveMask */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/* LM_STATUS_SUCCESS */
|
||
|
/******************************************************************************/
|
||
|
LM_STATUS
|
||
|
LM_SetReceiveMask(
|
||
|
PLM_DEVICE_BLOCK pDevice,
|
||
|
LM_UINT32 Mask) {
|
||
|
LM_UINT32 ReceiveMask;
|
||
|
LM_UINT32 RxMode;
|
||
|
LM_UINT32 j, k;
|
||
|
|
||
|
ReceiveMask = Mask;
|
||
|
|
||
|
RxMode = pDevice->RxMode;
|
||
|
|
||
|
if(Mask & LM_ACCEPT_UNICAST)
|
||
|
{
|
||
|
Mask &= ~LM_ACCEPT_UNICAST;
|
||
|
}
|
||
|
|
||
|
if(Mask & LM_ACCEPT_MULTICAST)
|
||
|
{
|
||
|
Mask &= ~LM_ACCEPT_MULTICAST;
|
||
|
}
|
||
|
|
||
|
if(Mask & LM_ACCEPT_ALL_MULTICAST)
|
||
|
{
|
||
|
Mask &= ~LM_ACCEPT_ALL_MULTICAST;
|
||
|
}
|
||
|
|
||
|
if(Mask & LM_ACCEPT_BROADCAST)
|
||
|
{
|
||
|
Mask &= ~LM_ACCEPT_BROADCAST;
|
||
|
}
|
||
|
|
||
|
RxMode &= ~RX_MODE_PROMISCUOUS_MODE;
|
||
|
if(Mask & LM_PROMISCUOUS_MODE)
|
||
|
{
|
||
|
RxMode |= RX_MODE_PROMISCUOUS_MODE;
|
||
|
Mask &= ~LM_PROMISCUOUS_MODE;
|
||
|
}
|
||
|
|
||
|
RxMode &= ~(RX_MODE_ACCEPT_RUNTS | RX_MODE_ACCEPT_OVERSIZED);
|
||
|
if(Mask & LM_ACCEPT_ERROR_PACKET)
|
||
|
{
|
||
|
RxMode |= RX_MODE_ACCEPT_RUNTS | RX_MODE_ACCEPT_OVERSIZED;
|
||
|
Mask &= ~LM_ACCEPT_ERROR_PACKET;
|
||
|
}
|
||
|
|
||
|
/* Make sure all the bits are valid before committing changes. */
|
||
|
if(Mask)
|
||
|
{
|
||
|
return LM_STATUS_FAILURE;
|
||
|
}
|
||
|
|
||
|
/* Commit the new filter. */
|
||
|
pDevice->RxMode = RxMode;
|
||
|
REG_WR(pDevice, MacCtrl.RxMode, RxMode);
|
||
|
|
||
|
pDevice->ReceiveMask = ReceiveMask;
|
||
|
|
||
|
/* Set up the MC hash table. */
|
||
|
if(ReceiveMask & LM_ACCEPT_ALL_MULTICAST)
|
||
|
{
|
||
|
for(k = 0; k < 4; k++)
|
||
|
{
|
||
|
REG_WR(pDevice, MacCtrl.HashReg[k], 0xffffffff);
|
||
|
}
|
||
|
}
|
||
|
else if(ReceiveMask & LM_ACCEPT_MULTICAST)
|
||
|
{
|
||
|
LM_UINT32 HashReg[4];
|
||
|
|
||
|
HashReg[0] = 0; HashReg[1] = 0; HashReg[2] = 0; HashReg[3] = 0;
|
||
|
for(j = 0; j < pDevice->McEntryCount; j++)
|
||
|
{
|
||
|
LM_UINT32 RegIndex;
|
||
|
LM_UINT32 Bitpos;
|
||
|
LM_UINT32 Crc32;
|
||
|
|
||
|
Crc32 = ComputeCrc32(pDevice->McTable[j], ETHERNET_ADDRESS_SIZE);
|
||
|
|
||
|
/* The most significant 7 bits of the CRC32 (no inversion), */
|
||
|
/* are used to index into one of the possible 128 bit positions. */
|
||
|
Bitpos = ~Crc32 & 0x7f;
|
||
|
|
||
|
/* Hash register index. */
|
||
|
RegIndex = (Bitpos & 0x60) >> 5;
|
||
|
|
||
|
/* Bit to turn on within a hash register. */
|
||
|
Bitpos &= 0x1f;
|
||
|
|
||
|
/* Enable the multicast bit. */
|
||
|
HashReg[RegIndex] |= (1 << Bitpos);
|
||
|
}
|
||
|
|
||
|
/* REV_AX has problem with multicast filtering where it uses both */
|
||
|
/* DA and SA to perform hashing. */
|
||
|
for(k = 0; k < 4; k++)
|
||
|
{
|
||
|
REG_WR(pDevice, MacCtrl.HashReg[k], HashReg[k]);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
/* Reject all multicast frames. */
|
||
|
for(j = 0; j < 4; j++)
|
||
|
{
|
||
|
REG_WR(pDevice, MacCtrl.HashReg[j], 0);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* By default, Tigon3 will accept broadcast frames. We need to setup */
|
||
|
if(ReceiveMask & LM_ACCEPT_BROADCAST)
|
||
|
{
|
||
|
REG_WR(pDevice, MacCtrl.RcvRules[RCV_RULE1_REJECT_BROADCAST_IDX].Rule,
|
||
|
REJECT_BROADCAST_RULE1_RULE & RCV_DISABLE_RULE_MASK);
|
||
|
REG_WR(pDevice, MacCtrl.RcvRules[RCV_RULE1_REJECT_BROADCAST_IDX].Value,
|
||
|
REJECT_BROADCAST_RULE1_VALUE & RCV_DISABLE_RULE_MASK);
|
||
|
REG_WR(pDevice, MacCtrl.RcvRules[RCV_RULE2_REJECT_BROADCAST_IDX].Rule,
|
||
|
REJECT_BROADCAST_RULE1_RULE & RCV_DISABLE_RULE_MASK);
|
||
|
REG_WR(pDevice, MacCtrl.RcvRules[RCV_RULE2_REJECT_BROADCAST_IDX].Value,
|
||
|
REJECT_BROADCAST_RULE1_VALUE & RCV_DISABLE_RULE_MASK);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
REG_WR(pDevice, MacCtrl.RcvRules[RCV_RULE1_REJECT_BROADCAST_IDX].Rule,
|
||
|
REJECT_BROADCAST_RULE1_RULE);
|
||
|
REG_WR(pDevice, MacCtrl.RcvRules[RCV_RULE1_REJECT_BROADCAST_IDX].Value,
|
||
|
REJECT_BROADCAST_RULE1_VALUE);
|
||
|
REG_WR(pDevice, MacCtrl.RcvRules[RCV_RULE2_REJECT_BROADCAST_IDX].Rule,
|
||
|
REJECT_BROADCAST_RULE2_RULE);
|
||
|
REG_WR(pDevice, MacCtrl.RcvRules[RCV_RULE2_REJECT_BROADCAST_IDX].Value,
|
||
|
REJECT_BROADCAST_RULE2_VALUE);
|
||
|
}
|
||
|
|
||
|
/* disable the rest of the rules. */
|
||
|
for(j = RCV_LAST_RULE_IDX; j < 16; j++)
|
||
|
{
|
||
|
REG_WR(pDevice, MacCtrl.RcvRules[j].Rule, 0);
|
||
|
REG_WR(pDevice, MacCtrl.RcvRules[j].Value, 0);
|
||
|
}
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
} /* LM_SetReceiveMask */
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* Disable the interrupt and put the transmitter and receiver engines in */
|
||
|
/* an idle state. Also aborts all pending send requests and receive */
|
||
|
/* buffers. */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/* LM_STATUS_SUCCESS */
|
||
|
/******************************************************************************/
|
||
|
LM_STATUS
|
||
|
LM_Abort(
|
||
|
PLM_DEVICE_BLOCK pDevice)
|
||
|
{
|
||
|
PLM_PACKET pPacket;
|
||
|
LM_UINT Idx;
|
||
|
|
||
|
LM_DisableInterrupt(pDevice);
|
||
|
|
||
|
/* Disable all the state machines. */
|
||
|
LM_CntrlBlock(pDevice,T3_BLOCK_MAC_RX_ENGINE,LM_DISABLE);
|
||
|
LM_CntrlBlock(pDevice,T3_BLOCK_RX_BD_INITIATOR,LM_DISABLE);
|
||
|
LM_CntrlBlock(pDevice,T3_BLOCK_RX_LIST_PLMT,LM_DISABLE);
|
||
|
LM_CntrlBlock(pDevice,T3_BLOCK_RX_LIST_SELECTOR,LM_DISABLE);
|
||
|
LM_CntrlBlock(pDevice,T3_BLOCK_RX_DATA_INITIATOR,LM_DISABLE);
|
||
|
LM_CntrlBlock(pDevice,T3_BLOCK_RX_DATA_COMP,LM_DISABLE);
|
||
|
LM_CntrlBlock(pDevice,T3_BLOCK_RX_BD_COMP,LM_DISABLE);
|
||
|
|
||
|
LM_CntrlBlock(pDevice,T3_BLOCK_SEND_BD_SELECTOR,LM_DISABLE);
|
||
|
LM_CntrlBlock(pDevice,T3_BLOCK_SEND_BD_INITIATOR,LM_DISABLE);
|
||
|
LM_CntrlBlock(pDevice,T3_BLOCK_SEND_DATA_INITIATOR,LM_DISABLE);
|
||
|
LM_CntrlBlock(pDevice,T3_BLOCK_DMA_RD,LM_DISABLE);
|
||
|
LM_CntrlBlock(pDevice,T3_BLOCK_SEND_DATA_COMP,LM_DISABLE);
|
||
|
LM_CntrlBlock(pDevice,T3_BLOCK_DMA_COMP,LM_DISABLE);
|
||
|
LM_CntrlBlock(pDevice,T3_BLOCK_SEND_BD_COMP,LM_DISABLE);
|
||
|
|
||
|
/* Clear TDE bit */
|
||
|
pDevice->MacMode &= ~MAC_MODE_ENABLE_TDE;
|
||
|
REG_WR(pDevice, MacCtrl.Mode, pDevice->MacMode);
|
||
|
|
||
|
LM_CntrlBlock(pDevice,T3_BLOCK_MAC_TX_ENGINE,LM_DISABLE);
|
||
|
LM_CntrlBlock(pDevice,T3_BLOCK_HOST_COALESING,LM_DISABLE);
|
||
|
LM_CntrlBlock(pDevice,T3_BLOCK_DMA_WR,LM_DISABLE);
|
||
|
LM_CntrlBlock(pDevice,T3_BLOCK_MBUF_CLUSTER_FREE,LM_DISABLE);
|
||
|
|
||
|
/* Reset all FTQs */
|
||
|
REG_WR(pDevice, Ftq.Reset, 0xffffffff);
|
||
|
REG_WR(pDevice, Ftq.Reset, 0x0);
|
||
|
|
||
|
LM_CntrlBlock(pDevice,T3_BLOCK_MBUF_MANAGER,LM_DISABLE);
|
||
|
LM_CntrlBlock(pDevice,T3_BLOCK_MEM_ARBITOR,LM_DISABLE);
|
||
|
|
||
|
MM_ACQUIRE_INT_LOCK(pDevice);
|
||
|
|
||
|
/* Abort packets that have already queued to go out. */
|
||
|
pPacket = (PLM_PACKET) QQ_PopHead(&pDevice->TxPacketActiveQ.Container);
|
||
|
while(pPacket)
|
||
|
{
|
||
|
|
||
|
pPacket->PacketStatus = LM_STATUS_TRANSMIT_ABORTED;
|
||
|
pDevice->TxCounters.TxPacketAbortedCnt++;
|
||
|
|
||
|
atomic_add(pPacket->u.Tx.FragCount, &pDevice->SendBdLeft);
|
||
|
|
||
|
QQ_PushTail(&pDevice->TxPacketXmittedQ.Container, pPacket);
|
||
|
|
||
|
pPacket = (PLM_PACKET)
|
||
|
QQ_PopHead(&pDevice->TxPacketActiveQ.Container);
|
||
|
}
|
||
|
|
||
|
/* Cleanup the receive return rings. */
|
||
|
LM_ServiceRxInterrupt(pDevice);
|
||
|
|
||
|
/* Don't want to indicate rx packets in Ndis miniport shutdown context. */
|
||
|
/* Doing so may cause system crash. */
|
||
|
if(!pDevice->ShuttingDown)
|
||
|
{
|
||
|
/* Indicate packets to the protocol. */
|
||
|
MM_IndicateTxPackets(pDevice);
|
||
|
|
||
|
/* Indicate received packets to the protocols. */
|
||
|
MM_IndicateRxPackets(pDevice);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
/* Move the receive packet descriptors in the ReceivedQ to the */
|
||
|
/* free queue. */
|
||
|
for(; ;)
|
||
|
{
|
||
|
pPacket = (PLM_PACKET) QQ_PopHead(
|
||
|
&pDevice->RxPacketReceivedQ.Container);
|
||
|
if(pPacket == NULL)
|
||
|
{
|
||
|
break;
|
||
|
}
|
||
|
QQ_PushTail(&pDevice->RxPacketFreeQ.Container, pPacket);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Clean up the Std Receive Producer ring. */
|
||
|
Idx = pDevice->pStatusBlkVirt->RcvStdConIdx;
|
||
|
|
||
|
while(Idx != pDevice->RxStdProdIdx) {
|
||
|
pPacket = (PLM_PACKET) (MM_UINT_PTR(pDevice->pPacketDescBase) +
|
||
|
MM_UINT_PTR(pDevice->pRxStdBdVirt[Idx].Opaque));
|
||
|
|
||
|
QQ_PushTail(&pDevice->RxPacketFreeQ.Container, pPacket);
|
||
|
|
||
|
Idx = (Idx + 1) & T3_STD_RCV_RCB_ENTRY_COUNT_MASK;
|
||
|
} /* while */
|
||
|
|
||
|
/* Reinitialize our copy of the indices. */
|
||
|
pDevice->RxStdProdIdx = 0;
|
||
|
|
||
|
#if T3_JUMBO_RCV_RCB_ENTRY_COUNT
|
||
|
/* Clean up the Jumbo Receive Producer ring. */
|
||
|
Idx = pDevice->pStatusBlkVirt->RcvJumboConIdx;
|
||
|
|
||
|
while(Idx != pDevice->RxJumboProdIdx) {
|
||
|
pPacket = (PLM_PACKET) (MM_UINT_PTR(pDevice->pPacketDescBase) +
|
||
|
MM_UINT_PTR(pDevice->pRxJumboBdVirt[Idx].Opaque));
|
||
|
|
||
|
QQ_PushTail(&pDevice->RxPacketFreeQ.Container, pPacket);
|
||
|
|
||
|
Idx = (Idx + 1) & T3_JUMBO_RCV_RCB_ENTRY_COUNT_MASK;
|
||
|
} /* while */
|
||
|
|
||
|
/* Reinitialize our copy of the indices. */
|
||
|
pDevice->RxJumboProdIdx = 0;
|
||
|
#endif /* T3_JUMBO_RCV_RCB_ENTRY_COUNT */
|
||
|
|
||
|
MM_RELEASE_INT_LOCK(pDevice);
|
||
|
|
||
|
/* Initialize the statistis Block */
|
||
|
pDevice->pStatusBlkVirt->Status = 0;
|
||
|
pDevice->pStatusBlkVirt->RcvStdConIdx = 0;
|
||
|
pDevice->pStatusBlkVirt->RcvJumboConIdx = 0;
|
||
|
pDevice->pStatusBlkVirt->RcvMiniConIdx = 0;
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
} /* LM_Abort */
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* Disable the interrupt and put the transmitter and receiver engines in */
|
||
|
/* an idle state. Aborts all pending send requests and receive buffers. */
|
||
|
/* Also free all the receive buffers. */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/* LM_STATUS_SUCCESS */
|
||
|
/******************************************************************************/
|
||
|
LM_STATUS
|
||
|
LM_Halt(
|
||
|
PLM_DEVICE_BLOCK pDevice) {
|
||
|
PLM_PACKET pPacket;
|
||
|
LM_UINT32 EntryCnt;
|
||
|
|
||
|
LM_Abort(pDevice);
|
||
|
|
||
|
/* Get the number of entries in the queue. */
|
||
|
EntryCnt = QQ_GetEntryCnt(&pDevice->RxPacketFreeQ.Container);
|
||
|
|
||
|
/* Make sure all the packets have been accounted for. */
|
||
|
for(EntryCnt = 0; EntryCnt < pDevice->RxPacketDescCnt; EntryCnt++)
|
||
|
{
|
||
|
pPacket = (PLM_PACKET) QQ_PopHead(&pDevice->RxPacketFreeQ.Container);
|
||
|
if (pPacket == 0)
|
||
|
break;
|
||
|
|
||
|
MM_FreeRxBuffer(pDevice, pPacket);
|
||
|
|
||
|
QQ_PushTail(&pDevice->RxPacketFreeQ.Container, pPacket);
|
||
|
}
|
||
|
|
||
|
LM_ResetChip(pDevice);
|
||
|
|
||
|
/* Restore PCI configuration registers. */
|
||
|
MM_WriteConfig32(pDevice, PCI_CACHE_LINE_SIZE_REG,
|
||
|
pDevice->SavedCacheLineReg);
|
||
|
LM_RegWrInd(pDevice, PCI_SUBSYSTEM_VENDOR_ID_REG,
|
||
|
(pDevice->SubsystemId << 16) | pDevice->SubsystemVendorId);
|
||
|
|
||
|
/* Reprogram the MAC address. */
|
||
|
LM_SetMacAddress(pDevice, pDevice->NodeAddress);
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
} /* LM_Halt */
|
||
|
|
||
|
|
||
|
STATIC LM_STATUS
|
||
|
LM_ResetChip(PLM_DEVICE_BLOCK pDevice)
|
||
|
{
|
||
|
LM_UINT32 Value32;
|
||
|
LM_UINT32 j;
|
||
|
|
||
|
/* Wait for access to the nvram interface before resetting. This is */
|
||
|
/* a workaround to prevent EEPROM corruption. */
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) != T3_ASIC_REV_5700 &&
|
||
|
T3_ASIC_REV(pDevice->ChipRevId) != T3_ASIC_REV_5701)
|
||
|
{
|
||
|
/* Request access to the flash interface. */
|
||
|
REG_WR(pDevice, Nvram.SwArb, SW_ARB_REQ_SET1);
|
||
|
|
||
|
for(j = 0; j < 100000; j++)
|
||
|
{
|
||
|
Value32 = REG_RD(pDevice, Nvram.SwArb);
|
||
|
if(Value32 & SW_ARB_GNT1)
|
||
|
{
|
||
|
break;
|
||
|
}
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Global reset. */
|
||
|
REG_WR(pDevice, Grc.MiscCfg, GRC_MISC_CFG_CORE_CLOCK_RESET);
|
||
|
MM_Wait(40); MM_Wait(40); MM_Wait(40);
|
||
|
|
||
|
/* make sure we re-enable indirect accesses */
|
||
|
MM_WriteConfig32(pDevice, T3_PCI_MISC_HOST_CTRL_REG,
|
||
|
pDevice->MiscHostCtrl);
|
||
|
|
||
|
/* Set MAX PCI retry to zero. */
|
||
|
Value32 = T3_PCI_STATE_PCI_ROM_ENABLE | T3_PCI_STATE_PCI_ROM_RETRY_ENABLE;
|
||
|
if (pDevice->ChipRevId == T3_CHIP_ID_5704_A0)
|
||
|
{
|
||
|
if (!(pDevice->PciState & T3_PCI_STATE_CONVENTIONAL_PCI_MODE))
|
||
|
{
|
||
|
Value32 |= T3_PCI_STATE_RETRY_SAME_DMA;
|
||
|
}
|
||
|
}
|
||
|
MM_WriteConfig32(pDevice, T3_PCI_STATE_REG, Value32);
|
||
|
|
||
|
/* Restore PCI command register. */
|
||
|
MM_WriteConfig32(pDevice, PCI_COMMAND_REG,
|
||
|
pDevice->PciCommandStatusWords);
|
||
|
|
||
|
/* Disable PCI-X relaxed ordering bit. */
|
||
|
MM_ReadConfig32(pDevice, PCIX_CAP_REG, &Value32);
|
||
|
Value32 &= ~PCIX_ENABLE_RELAXED_ORDERING;
|
||
|
MM_WriteConfig32(pDevice, PCIX_CAP_REG, Value32);
|
||
|
|
||
|
/* Enable memory arbiter. */
|
||
|
REG_WR(pDevice, MemArbiter.Mode, T3_MEM_ARBITER_MODE_ENABLE);
|
||
|
|
||
|
#ifdef BIG_ENDIAN_PCI /* This from jfd */
|
||
|
Value32 = GRC_MODE_WORD_SWAP_DATA|
|
||
|
GRC_MODE_WORD_SWAP_NON_FRAME_DATA;
|
||
|
#else
|
||
|
#ifdef BIG_ENDIAN_HOST
|
||
|
/* Reconfigure the mode register. */
|
||
|
Value32 = GRC_MODE_BYTE_SWAP_NON_FRAME_DATA |
|
||
|
GRC_MODE_WORD_SWAP_NON_FRAME_DATA |
|
||
|
GRC_MODE_BYTE_SWAP_DATA |
|
||
|
GRC_MODE_WORD_SWAP_DATA;
|
||
|
#else
|
||
|
/* Reconfigure the mode register. */
|
||
|
Value32 = GRC_MODE_BYTE_SWAP_NON_FRAME_DATA | GRC_MODE_BYTE_SWAP_DATA;
|
||
|
#endif
|
||
|
#endif
|
||
|
REG_WR(pDevice, Grc.Mode, Value32);
|
||
|
|
||
|
/* Prevent PXE from restarting. */
|
||
|
MEM_WR_OFFSET(pDevice, 0x0b50, T3_MAGIC_NUM);
|
||
|
|
||
|
if(pDevice->EnableTbi) {
|
||
|
pDevice->MacMode = MAC_MODE_PORT_MODE_TBI;
|
||
|
REG_WR(pDevice, MacCtrl.Mode, MAC_MODE_PORT_MODE_TBI);
|
||
|
}
|
||
|
else {
|
||
|
REG_WR(pDevice, MacCtrl.Mode, 0);
|
||
|
}
|
||
|
|
||
|
/* Wait for the firmware to finish initialization. */
|
||
|
for(j = 0; j < 100000; j++)
|
||
|
{
|
||
|
MM_Wait(10);
|
||
|
|
||
|
Value32 = MEM_RD_OFFSET(pDevice, 0x0b50);
|
||
|
if(Value32 == ~T3_MAGIC_NUM)
|
||
|
{
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
}
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
__inline static void
|
||
|
LM_ServiceTxInterrupt(
|
||
|
PLM_DEVICE_BLOCK pDevice) {
|
||
|
PLM_PACKET pPacket;
|
||
|
LM_UINT32 HwConIdx;
|
||
|
LM_UINT32 SwConIdx;
|
||
|
|
||
|
HwConIdx = pDevice->pStatusBlkVirt->Idx[0].SendConIdx;
|
||
|
|
||
|
/* Get our copy of the consumer index. The buffer descriptors */
|
||
|
/* that are in between the consumer indices are freed. */
|
||
|
SwConIdx = pDevice->SendConIdx;
|
||
|
|
||
|
/* Move the packets from the TxPacketActiveQ that are sent out to */
|
||
|
/* the TxPacketXmittedQ. Packets that are sent use the */
|
||
|
/* descriptors that are between SwConIdx and HwConIdx. */
|
||
|
while(SwConIdx != HwConIdx)
|
||
|
{
|
||
|
/* Get the packet that was sent from the TxPacketActiveQ. */
|
||
|
pPacket = (PLM_PACKET) QQ_PopHead(
|
||
|
&pDevice->TxPacketActiveQ.Container);
|
||
|
|
||
|
/* Set the return status. */
|
||
|
pPacket->PacketStatus = LM_STATUS_SUCCESS;
|
||
|
|
||
|
/* Put the packet in the TxPacketXmittedQ for indication later. */
|
||
|
QQ_PushTail(&pDevice->TxPacketXmittedQ.Container, pPacket);
|
||
|
|
||
|
/* Move to the next packet's BD. */
|
||
|
SwConIdx = (SwConIdx + pPacket->u.Tx.FragCount) &
|
||
|
T3_SEND_RCB_ENTRY_COUNT_MASK;
|
||
|
|
||
|
/* Update the number of unused BDs. */
|
||
|
atomic_add(pPacket->u.Tx.FragCount, &pDevice->SendBdLeft);
|
||
|
|
||
|
/* Get the new updated HwConIdx. */
|
||
|
HwConIdx = pDevice->pStatusBlkVirt->Idx[0].SendConIdx;
|
||
|
} /* while */
|
||
|
|
||
|
/* Save the new SwConIdx. */
|
||
|
pDevice->SendConIdx = SwConIdx;
|
||
|
|
||
|
} /* LM_ServiceTxInterrupt */
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
__inline static void
|
||
|
LM_ServiceRxInterrupt(
|
||
|
PLM_DEVICE_BLOCK pDevice) {
|
||
|
PLM_PACKET pPacket;
|
||
|
PT3_RCV_BD pRcvBd;
|
||
|
LM_UINT32 HwRcvRetProdIdx;
|
||
|
LM_UINT32 SwRcvRetConIdx;
|
||
|
|
||
|
/* Loop thru the receive return rings for received packets. */
|
||
|
HwRcvRetProdIdx = pDevice->pStatusBlkVirt->Idx[0].RcvProdIdx;
|
||
|
|
||
|
SwRcvRetConIdx = pDevice->RcvRetConIdx;
|
||
|
while(SwRcvRetConIdx != HwRcvRetProdIdx)
|
||
|
{
|
||
|
pRcvBd = &pDevice->pRcvRetBdVirt[SwRcvRetConIdx];
|
||
|
|
||
|
/* Get the received packet descriptor. */
|
||
|
pPacket = (PLM_PACKET) (MM_UINT_PTR(pDevice->pPacketDescBase) +
|
||
|
MM_UINT_PTR(pRcvBd->Opaque));
|
||
|
|
||
|
/* Check the error flag. */
|
||
|
if(pRcvBd->ErrorFlag &&
|
||
|
pRcvBd->ErrorFlag != RCV_BD_ERR_ODD_NIBBLED_RCVD_MII)
|
||
|
{
|
||
|
pPacket->PacketStatus = LM_STATUS_FAILURE;
|
||
|
|
||
|
pDevice->RxCounters.RxPacketErrCnt++;
|
||
|
|
||
|
if(pRcvBd->ErrorFlag & RCV_BD_ERR_BAD_CRC)
|
||
|
{
|
||
|
pDevice->RxCounters.RxErrCrcCnt++;
|
||
|
}
|
||
|
|
||
|
if(pRcvBd->ErrorFlag & RCV_BD_ERR_COLL_DETECT)
|
||
|
{
|
||
|
pDevice->RxCounters.RxErrCollCnt++;
|
||
|
}
|
||
|
|
||
|
if(pRcvBd->ErrorFlag & RCV_BD_ERR_LINK_LOST_DURING_PKT)
|
||
|
{
|
||
|
pDevice->RxCounters.RxErrLinkLostCnt++;
|
||
|
}
|
||
|
|
||
|
if(pRcvBd->ErrorFlag & RCV_BD_ERR_PHY_DECODE_ERR)
|
||
|
{
|
||
|
pDevice->RxCounters.RxErrPhyDecodeCnt++;
|
||
|
}
|
||
|
|
||
|
if(pRcvBd->ErrorFlag & RCV_BD_ERR_ODD_NIBBLED_RCVD_MII)
|
||
|
{
|
||
|
pDevice->RxCounters.RxErrOddNibbleCnt++;
|
||
|
}
|
||
|
|
||
|
if(pRcvBd->ErrorFlag & RCV_BD_ERR_MAC_ABORT)
|
||
|
{
|
||
|
pDevice->RxCounters.RxErrMacAbortCnt++;
|
||
|
}
|
||
|
|
||
|
if(pRcvBd->ErrorFlag & RCV_BD_ERR_LEN_LT_64)
|
||
|
{
|
||
|
pDevice->RxCounters.RxErrShortPacketCnt++;
|
||
|
}
|
||
|
|
||
|
if(pRcvBd->ErrorFlag & RCV_BD_ERR_TRUNC_NO_RESOURCES)
|
||
|
{
|
||
|
pDevice->RxCounters.RxErrNoResourceCnt++;
|
||
|
}
|
||
|
|
||
|
if(pRcvBd->ErrorFlag & RCV_BD_ERR_GIANT_FRAME_RCVD)
|
||
|
{
|
||
|
pDevice->RxCounters.RxErrLargePacketCnt++;
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
pPacket->PacketStatus = LM_STATUS_SUCCESS;
|
||
|
pPacket->PacketSize = pRcvBd->Len - 4;
|
||
|
|
||
|
pPacket->Flags = pRcvBd->Flags;
|
||
|
if(pRcvBd->Flags & RCV_BD_FLAG_VLAN_TAG)
|
||
|
{
|
||
|
pPacket->VlanTag = pRcvBd->VlanTag;
|
||
|
}
|
||
|
|
||
|
pPacket->u.Rx.TcpUdpChecksum = pRcvBd->TcpUdpCksum;
|
||
|
}
|
||
|
|
||
|
/* Put the packet descriptor containing the received packet */
|
||
|
/* buffer in the RxPacketReceivedQ for indication later. */
|
||
|
QQ_PushTail(&pDevice->RxPacketReceivedQ.Container, pPacket);
|
||
|
|
||
|
/* Go to the next buffer descriptor. */
|
||
|
SwRcvRetConIdx = (SwRcvRetConIdx + 1) &
|
||
|
T3_RCV_RETURN_RCB_ENTRY_COUNT_MASK;
|
||
|
|
||
|
/* Get the updated HwRcvRetProdIdx. */
|
||
|
HwRcvRetProdIdx = pDevice->pStatusBlkVirt->Idx[0].RcvProdIdx;
|
||
|
} /* while */
|
||
|
|
||
|
pDevice->RcvRetConIdx = SwRcvRetConIdx;
|
||
|
|
||
|
/* Update the receive return ring consumer index. */
|
||
|
MB_REG_WR(pDevice, Mailbox.RcvRetConIdx[0].Low, SwRcvRetConIdx);
|
||
|
} /* LM_ServiceRxInterrupt */
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* This is the interrupt event handler routine. It acknowledges all */
|
||
|
/* pending interrupts and process all pending events. */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/* LM_STATUS_SUCCESS */
|
||
|
/******************************************************************************/
|
||
|
LM_STATUS
|
||
|
LM_ServiceInterrupts(
|
||
|
PLM_DEVICE_BLOCK pDevice)
|
||
|
{
|
||
|
LM_UINT32 Value32;
|
||
|
int ServicePhyInt = FALSE;
|
||
|
|
||
|
/* Setup the phy chip whenever the link status changes. */
|
||
|
if(pDevice->LinkChngMode == T3_LINK_CHNG_MODE_USE_STATUS_REG)
|
||
|
{
|
||
|
Value32 = REG_RD(pDevice, MacCtrl.Status);
|
||
|
if(pDevice->PhyIntMode == T3_PHY_INT_MODE_MI_INTERRUPT)
|
||
|
{
|
||
|
if (Value32 & MAC_STATUS_MI_INTERRUPT)
|
||
|
{
|
||
|
ServicePhyInt = TRUE;
|
||
|
}
|
||
|
}
|
||
|
else if(Value32 & MAC_STATUS_LINK_STATE_CHANGED)
|
||
|
{
|
||
|
ServicePhyInt = TRUE;
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if(pDevice->pStatusBlkVirt->Status & STATUS_BLOCK_LINK_CHANGED_STATUS)
|
||
|
{
|
||
|
pDevice->pStatusBlkVirt->Status = STATUS_BLOCK_UPDATED |
|
||
|
(pDevice->pStatusBlkVirt->Status & ~STATUS_BLOCK_LINK_CHANGED_STATUS);
|
||
|
ServicePhyInt = TRUE;
|
||
|
}
|
||
|
}
|
||
|
#if INCLUDE_TBI_SUPPORT
|
||
|
if (pDevice->IgnoreTbiLinkChange == TRUE)
|
||
|
{
|
||
|
ServicePhyInt = FALSE;
|
||
|
}
|
||
|
#endif
|
||
|
if (ServicePhyInt == TRUE)
|
||
|
{
|
||
|
LM_SetupPhy(pDevice);
|
||
|
}
|
||
|
|
||
|
/* Service receive and transmit interrupts. */
|
||
|
LM_ServiceRxInterrupt(pDevice);
|
||
|
LM_ServiceTxInterrupt(pDevice);
|
||
|
|
||
|
/* No spinlock for this queue since this routine is serialized. */
|
||
|
if(!QQ_Empty(&pDevice->RxPacketReceivedQ.Container))
|
||
|
{
|
||
|
/* Indicate receive packets. */
|
||
|
MM_IndicateRxPackets(pDevice);
|
||
|
/* LM_QueueRxPackets(pDevice); */
|
||
|
}
|
||
|
|
||
|
/* No spinlock for this queue since this routine is serialized. */
|
||
|
if(!QQ_Empty(&pDevice->TxPacketXmittedQ.Container))
|
||
|
{
|
||
|
MM_IndicateTxPackets(pDevice);
|
||
|
}
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
} /* LM_ServiceInterrupts */
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
LM_STATUS
|
||
|
LM_MulticastAdd(
|
||
|
PLM_DEVICE_BLOCK pDevice,
|
||
|
PLM_UINT8 pMcAddress) {
|
||
|
PLM_UINT8 pEntry;
|
||
|
LM_UINT32 j;
|
||
|
|
||
|
pEntry = pDevice->McTable[0];
|
||
|
for(j = 0; j < pDevice->McEntryCount; j++)
|
||
|
{
|
||
|
if(IS_ETH_ADDRESS_EQUAL(pEntry, pMcAddress))
|
||
|
{
|
||
|
/* Found a match, increment the instance count. */
|
||
|
pEntry[LM_MC_INSTANCE_COUNT_INDEX] += 1;
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
}
|
||
|
|
||
|
pEntry += LM_MC_ENTRY_SIZE;
|
||
|
}
|
||
|
|
||
|
if(pDevice->McEntryCount >= LM_MAX_MC_TABLE_SIZE)
|
||
|
{
|
||
|
return LM_STATUS_FAILURE;
|
||
|
}
|
||
|
|
||
|
pEntry = pDevice->McTable[pDevice->McEntryCount];
|
||
|
|
||
|
COPY_ETH_ADDRESS(pMcAddress, pEntry);
|
||
|
pEntry[LM_MC_INSTANCE_COUNT_INDEX] = 1;
|
||
|
|
||
|
pDevice->McEntryCount++;
|
||
|
|
||
|
LM_SetReceiveMask(pDevice, pDevice->ReceiveMask | LM_ACCEPT_MULTICAST);
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
} /* LM_MulticastAdd */
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
LM_STATUS
|
||
|
LM_MulticastDel(
|
||
|
PLM_DEVICE_BLOCK pDevice,
|
||
|
PLM_UINT8 pMcAddress) {
|
||
|
PLM_UINT8 pEntry;
|
||
|
LM_UINT32 j;
|
||
|
|
||
|
pEntry = pDevice->McTable[0];
|
||
|
for(j = 0; j < pDevice->McEntryCount; j++)
|
||
|
{
|
||
|
if(IS_ETH_ADDRESS_EQUAL(pEntry, pMcAddress))
|
||
|
{
|
||
|
/* Found a match, decrement the instance count. */
|
||
|
pEntry[LM_MC_INSTANCE_COUNT_INDEX] -= 1;
|
||
|
|
||
|
/* No more instance left, remove the address from the table. */
|
||
|
/* Move the last entry in the table to the delete slot. */
|
||
|
if(pEntry[LM_MC_INSTANCE_COUNT_INDEX] == 0 &&
|
||
|
pDevice->McEntryCount > 1)
|
||
|
{
|
||
|
|
||
|
COPY_ETH_ADDRESS(
|
||
|
pDevice->McTable[pDevice->McEntryCount-1], pEntry);
|
||
|
pEntry[LM_MC_INSTANCE_COUNT_INDEX] =
|
||
|
pDevice->McTable[pDevice->McEntryCount-1]
|
||
|
[LM_MC_INSTANCE_COUNT_INDEX];
|
||
|
}
|
||
|
pDevice->McEntryCount--;
|
||
|
|
||
|
/* Update the receive mask if the table is empty. */
|
||
|
if(pDevice->McEntryCount == 0)
|
||
|
{
|
||
|
LM_SetReceiveMask(pDevice,
|
||
|
pDevice->ReceiveMask & ~LM_ACCEPT_MULTICAST);
|
||
|
}
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
}
|
||
|
|
||
|
pEntry += LM_MC_ENTRY_SIZE;
|
||
|
}
|
||
|
|
||
|
return LM_STATUS_FAILURE;
|
||
|
} /* LM_MulticastDel */
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
LM_STATUS
|
||
|
LM_MulticastClear(
|
||
|
PLM_DEVICE_BLOCK pDevice) {
|
||
|
pDevice->McEntryCount = 0;
|
||
|
|
||
|
LM_SetReceiveMask(pDevice, pDevice->ReceiveMask & ~LM_ACCEPT_MULTICAST);
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
} /* LM_MulticastClear */
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
LM_STATUS
|
||
|
LM_SetMacAddress(
|
||
|
PLM_DEVICE_BLOCK pDevice,
|
||
|
PLM_UINT8 pMacAddress)
|
||
|
{
|
||
|
LM_UINT32 j;
|
||
|
|
||
|
for(j = 0; j < 4; j++)
|
||
|
{
|
||
|
REG_WR(pDevice, MacCtrl.MacAddr[j].High,
|
||
|
(pMacAddress[0] << 8) | pMacAddress[1]);
|
||
|
REG_WR(pDevice, MacCtrl.MacAddr[j].Low,
|
||
|
(pMacAddress[2] << 24) | (pMacAddress[3] << 16) |
|
||
|
(pMacAddress[4] << 8) | pMacAddress[5]);
|
||
|
}
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
}
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* Sets up the default line speed, and duplex modes based on the requested */
|
||
|
/* media type. */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/* None. */
|
||
|
/******************************************************************************/
|
||
|
static LM_STATUS
|
||
|
LM_TranslateRequestedMediaType(
|
||
|
LM_REQUESTED_MEDIA_TYPE RequestedMediaType,
|
||
|
PLM_MEDIA_TYPE pMediaType,
|
||
|
PLM_LINE_SPEED pLineSpeed,
|
||
|
PLM_DUPLEX_MODE pDuplexMode) {
|
||
|
*pMediaType = LM_MEDIA_TYPE_AUTO;
|
||
|
*pLineSpeed = LM_LINE_SPEED_UNKNOWN;
|
||
|
*pDuplexMode = LM_DUPLEX_MODE_UNKNOWN;
|
||
|
|
||
|
/* determine media type */
|
||
|
switch(RequestedMediaType) {
|
||
|
case LM_REQUESTED_MEDIA_TYPE_BNC:
|
||
|
*pMediaType = LM_MEDIA_TYPE_BNC;
|
||
|
*pLineSpeed = LM_LINE_SPEED_10MBPS;
|
||
|
*pDuplexMode = LM_DUPLEX_MODE_HALF;
|
||
|
break;
|
||
|
|
||
|
case LM_REQUESTED_MEDIA_TYPE_UTP_AUTO:
|
||
|
*pMediaType = LM_MEDIA_TYPE_UTP;
|
||
|
break;
|
||
|
|
||
|
case LM_REQUESTED_MEDIA_TYPE_UTP_10MBPS:
|
||
|
*pMediaType = LM_MEDIA_TYPE_UTP;
|
||
|
*pLineSpeed = LM_LINE_SPEED_10MBPS;
|
||
|
*pDuplexMode = LM_DUPLEX_MODE_HALF;
|
||
|
break;
|
||
|
|
||
|
case LM_REQUESTED_MEDIA_TYPE_UTP_10MBPS_FULL_DUPLEX:
|
||
|
*pMediaType = LM_MEDIA_TYPE_UTP;
|
||
|
*pLineSpeed = LM_LINE_SPEED_10MBPS;
|
||
|
*pDuplexMode = LM_DUPLEX_MODE_FULL;
|
||
|
break;
|
||
|
|
||
|
case LM_REQUESTED_MEDIA_TYPE_UTP_100MBPS:
|
||
|
*pMediaType = LM_MEDIA_TYPE_UTP;
|
||
|
*pLineSpeed = LM_LINE_SPEED_100MBPS;
|
||
|
*pDuplexMode = LM_DUPLEX_MODE_HALF;
|
||
|
break;
|
||
|
|
||
|
case LM_REQUESTED_MEDIA_TYPE_UTP_100MBPS_FULL_DUPLEX:
|
||
|
*pMediaType = LM_MEDIA_TYPE_UTP;
|
||
|
*pLineSpeed = LM_LINE_SPEED_100MBPS;
|
||
|
*pDuplexMode = LM_DUPLEX_MODE_FULL;
|
||
|
break;
|
||
|
|
||
|
case LM_REQUESTED_MEDIA_TYPE_UTP_1000MBPS:
|
||
|
*pMediaType = LM_MEDIA_TYPE_UTP;
|
||
|
*pLineSpeed = LM_LINE_SPEED_1000MBPS;
|
||
|
*pDuplexMode = LM_DUPLEX_MODE_HALF;
|
||
|
break;
|
||
|
|
||
|
case LM_REQUESTED_MEDIA_TYPE_UTP_1000MBPS_FULL_DUPLEX:
|
||
|
*pMediaType = LM_MEDIA_TYPE_UTP;
|
||
|
*pLineSpeed = LM_LINE_SPEED_1000MBPS;
|
||
|
*pDuplexMode = LM_DUPLEX_MODE_FULL;
|
||
|
break;
|
||
|
|
||
|
case LM_REQUESTED_MEDIA_TYPE_FIBER_100MBPS:
|
||
|
*pMediaType = LM_MEDIA_TYPE_FIBER;
|
||
|
*pLineSpeed = LM_LINE_SPEED_100MBPS;
|
||
|
*pDuplexMode = LM_DUPLEX_MODE_HALF;
|
||
|
break;
|
||
|
|
||
|
case LM_REQUESTED_MEDIA_TYPE_FIBER_100MBPS_FULL_DUPLEX:
|
||
|
*pMediaType = LM_MEDIA_TYPE_FIBER;
|
||
|
*pLineSpeed = LM_LINE_SPEED_100MBPS;
|
||
|
*pDuplexMode = LM_DUPLEX_MODE_FULL;
|
||
|
break;
|
||
|
|
||
|
case LM_REQUESTED_MEDIA_TYPE_FIBER_1000MBPS:
|
||
|
*pMediaType = LM_MEDIA_TYPE_FIBER;
|
||
|
*pLineSpeed = LM_LINE_SPEED_1000MBPS;
|
||
|
*pDuplexMode = LM_DUPLEX_MODE_HALF;
|
||
|
break;
|
||
|
|
||
|
case LM_REQUESTED_MEDIA_TYPE_FIBER_1000MBPS_FULL_DUPLEX:
|
||
|
*pMediaType = LM_MEDIA_TYPE_FIBER;
|
||
|
*pLineSpeed = LM_LINE_SPEED_1000MBPS;
|
||
|
*pDuplexMode = LM_DUPLEX_MODE_FULL;
|
||
|
break;
|
||
|
|
||
|
default:
|
||
|
break;
|
||
|
} /* switch */
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
} /* LM_TranslateRequestedMediaType */
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/* LM_STATUS_LINK_ACTIVE */
|
||
|
/* LM_STATUS_LINK_DOWN */
|
||
|
/******************************************************************************/
|
||
|
static LM_STATUS
|
||
|
LM_InitBcm540xPhy(
|
||
|
PLM_DEVICE_BLOCK pDevice)
|
||
|
{
|
||
|
LM_LINE_SPEED CurrentLineSpeed;
|
||
|
LM_DUPLEX_MODE CurrentDuplexMode;
|
||
|
LM_STATUS CurrentLinkStatus;
|
||
|
LM_UINT32 Value32;
|
||
|
LM_UINT32 j;
|
||
|
|
||
|
#if 1 /* jmb: bugfix -- moved here, out of code that sets initial pwr state */
|
||
|
LM_WritePhy(pDevice, BCM5401_AUX_CTRL, 0x2);
|
||
|
#endif
|
||
|
if((pDevice->PhyId & PHY_ID_MASK) == PHY_BCM5401_PHY_ID)
|
||
|
{
|
||
|
LM_ReadPhy(pDevice, PHY_STATUS_REG, &Value32);
|
||
|
LM_ReadPhy(pDevice, PHY_STATUS_REG, &Value32);
|
||
|
|
||
|
if(!pDevice->InitDone)
|
||
|
{
|
||
|
Value32 = 0;
|
||
|
}
|
||
|
|
||
|
if(!(Value32 & PHY_STATUS_LINK_PASS))
|
||
|
{
|
||
|
LM_WritePhy(pDevice, BCM5401_AUX_CTRL, 0x0c20);
|
||
|
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_ADDRESS_REG, 0x0012);
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_RW_PORT, 0x1804);
|
||
|
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_ADDRESS_REG, 0x0013);
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_RW_PORT, 0x1204);
|
||
|
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_ADDRESS_REG, 0x8006);
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_RW_PORT, 0x0132);
|
||
|
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_ADDRESS_REG, 0x8006);
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_RW_PORT, 0x0232);
|
||
|
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_ADDRESS_REG, 0x201f);
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_RW_PORT, 0x0a20);
|
||
|
|
||
|
LM_ReadPhy(pDevice, PHY_STATUS_REG, &Value32);
|
||
|
for(j = 0; j < 1000; j++)
|
||
|
{
|
||
|
MM_Wait(10);
|
||
|
|
||
|
LM_ReadPhy(pDevice, PHY_STATUS_REG, &Value32);
|
||
|
if(Value32 & PHY_STATUS_LINK_PASS)
|
||
|
{
|
||
|
MM_Wait(40);
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if((pDevice->PhyId & PHY_ID_REV_MASK) == PHY_BCM5401_B0_REV)
|
||
|
{
|
||
|
if(!(Value32 & PHY_STATUS_LINK_PASS) &&
|
||
|
(pDevice->OldLineSpeed == LM_LINE_SPEED_1000MBPS))
|
||
|
{
|
||
|
LM_WritePhy(pDevice, PHY_CTRL_REG, PHY_CTRL_PHY_RESET);
|
||
|
for(j = 0; j < 100; j++)
|
||
|
{
|
||
|
MM_Wait(10);
|
||
|
|
||
|
LM_ReadPhy(pDevice, PHY_CTRL_REG, &Value32);
|
||
|
if(!(Value32 & PHY_CTRL_PHY_RESET))
|
||
|
{
|
||
|
MM_Wait(40);
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
LM_WritePhy(pDevice, BCM5401_AUX_CTRL, 0x0c20);
|
||
|
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_ADDRESS_REG, 0x0012);
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_RW_PORT, 0x1804);
|
||
|
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_ADDRESS_REG, 0x0013);
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_RW_PORT, 0x1204);
|
||
|
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_ADDRESS_REG, 0x8006);
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_RW_PORT, 0x0132);
|
||
|
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_ADDRESS_REG, 0x8006);
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_RW_PORT, 0x0232);
|
||
|
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_ADDRESS_REG, 0x201f);
|
||
|
LM_WritePhy(pDevice, BCM540X_DSP_RW_PORT, 0x0a20);
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
else if(pDevice->ChipRevId == T3_CHIP_ID_5701_A0 ||
|
||
|
pDevice->ChipRevId == T3_CHIP_ID_5701_B0)
|
||
|
{
|
||
|
/* Bug: 5701 A0, B0 TX CRC workaround. */
|
||
|
LM_WritePhy(pDevice, 0x15, 0x0a75);
|
||
|
LM_WritePhy(pDevice, 0x1c, 0x8c68);
|
||
|
LM_WritePhy(pDevice, 0x1c, 0x8d68);
|
||
|
LM_WritePhy(pDevice, 0x1c, 0x8c68);
|
||
|
}
|
||
|
|
||
|
/* Acknowledge interrupts. */
|
||
|
LM_ReadPhy(pDevice, BCM540X_INT_STATUS_REG, &Value32);
|
||
|
LM_ReadPhy(pDevice, BCM540X_INT_STATUS_REG, &Value32);
|
||
|
|
||
|
/* Configure the interrupt mask. */
|
||
|
if(pDevice->PhyIntMode == T3_PHY_INT_MODE_MI_INTERRUPT)
|
||
|
{
|
||
|
LM_WritePhy(pDevice, BCM540X_INT_MASK_REG, ~BCM540X_INT_LINK_CHANGE);
|
||
|
}
|
||
|
|
||
|
/* Configure PHY led mode. */
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5701 ||
|
||
|
(T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700))
|
||
|
{
|
||
|
if(pDevice->LedMode == LED_MODE_THREE_LINK)
|
||
|
{
|
||
|
LM_WritePhy(pDevice, BCM540X_EXT_CTRL_REG,
|
||
|
BCM540X_EXT_CTRL_LINK3_LED_MODE);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
LM_WritePhy(pDevice, BCM540X_EXT_CTRL_REG, 0);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
CurrentLinkStatus = LM_STATUS_LINK_DOWN;
|
||
|
|
||
|
/* Get current link and duplex mode. */
|
||
|
for(j = 0; j < 100; j++)
|
||
|
{
|
||
|
LM_ReadPhy(pDevice, PHY_STATUS_REG, &Value32);
|
||
|
LM_ReadPhy(pDevice, PHY_STATUS_REG, &Value32);
|
||
|
|
||
|
if(Value32 & PHY_STATUS_LINK_PASS)
|
||
|
{
|
||
|
break;
|
||
|
}
|
||
|
MM_Wait(40);
|
||
|
}
|
||
|
|
||
|
if(Value32 & PHY_STATUS_LINK_PASS)
|
||
|
{
|
||
|
|
||
|
/* Determine the current line and duplex settings. */
|
||
|
LM_ReadPhy(pDevice, BCM540X_AUX_STATUS_REG, &Value32);
|
||
|
for(j = 0; j < 2000; j++)
|
||
|
{
|
||
|
MM_Wait(10);
|
||
|
|
||
|
LM_ReadPhy(pDevice, BCM540X_AUX_STATUS_REG, &Value32);
|
||
|
if(Value32)
|
||
|
{
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
switch(Value32 & BCM540X_AUX_SPEED_MASK)
|
||
|
{
|
||
|
case BCM540X_AUX_10BASET_HD:
|
||
|
CurrentLineSpeed = LM_LINE_SPEED_10MBPS;
|
||
|
CurrentDuplexMode = LM_DUPLEX_MODE_HALF;
|
||
|
break;
|
||
|
|
||
|
case BCM540X_AUX_10BASET_FD:
|
||
|
CurrentLineSpeed = LM_LINE_SPEED_10MBPS;
|
||
|
CurrentDuplexMode = LM_DUPLEX_MODE_FULL;
|
||
|
break;
|
||
|
|
||
|
case BCM540X_AUX_100BASETX_HD:
|
||
|
CurrentLineSpeed = LM_LINE_SPEED_100MBPS;
|
||
|
CurrentDuplexMode = LM_DUPLEX_MODE_HALF;
|
||
|
break;
|
||
|
|
||
|
case BCM540X_AUX_100BASETX_FD:
|
||
|
CurrentLineSpeed = LM_LINE_SPEED_100MBPS;
|
||
|
CurrentDuplexMode = LM_DUPLEX_MODE_FULL;
|
||
|
break;
|
||
|
|
||
|
case BCM540X_AUX_100BASET_HD:
|
||
|
CurrentLineSpeed = LM_LINE_SPEED_1000MBPS;
|
||
|
CurrentDuplexMode = LM_DUPLEX_MODE_HALF;
|
||
|
break;
|
||
|
|
||
|
case BCM540X_AUX_100BASET_FD:
|
||
|
CurrentLineSpeed = LM_LINE_SPEED_1000MBPS;
|
||
|
CurrentDuplexMode = LM_DUPLEX_MODE_FULL;
|
||
|
break;
|
||
|
|
||
|
default:
|
||
|
|
||
|
CurrentLineSpeed = LM_LINE_SPEED_UNKNOWN;
|
||
|
CurrentDuplexMode = LM_DUPLEX_MODE_UNKNOWN;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
/* Make sure we are in auto-neg mode. */
|
||
|
for (j = 0; j < 200; j++)
|
||
|
{
|
||
|
LM_ReadPhy(pDevice, PHY_CTRL_REG, &Value32);
|
||
|
if(Value32 && Value32 != 0x7fff)
|
||
|
{
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
if(Value32 == 0 && pDevice->RequestedMediaType ==
|
||
|
LM_REQUESTED_MEDIA_TYPE_UTP_10MBPS)
|
||
|
{
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
|
||
|
/* Use the current line settings for "auto" mode. */
|
||
|
if(pDevice->RequestedMediaType == LM_REQUESTED_MEDIA_TYPE_AUTO ||
|
||
|
pDevice->RequestedMediaType == LM_REQUESTED_MEDIA_TYPE_UTP_AUTO)
|
||
|
{
|
||
|
if(Value32 & PHY_CTRL_AUTO_NEG_ENABLE)
|
||
|
{
|
||
|
CurrentLinkStatus = LM_STATUS_LINK_ACTIVE;
|
||
|
|
||
|
/* We may be exiting low power mode and the link is in */
|
||
|
/* 10mb. In this case, we need to restart autoneg. */
|
||
|
LM_ReadPhy(pDevice, BCM540X_1000BASET_CTRL_REG, &Value32);
|
||
|
pDevice->advertising1000 = Value32;
|
||
|
/* 5702FE supports 10/100Mb only. */
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) != T3_ASIC_REV_5703 ||
|
||
|
pDevice->BondId != GRC_MISC_BD_ID_5702FE)
|
||
|
{
|
||
|
if(!(Value32 & (BCM540X_AN_AD_1000BASET_HALF |
|
||
|
BCM540X_AN_AD_1000BASET_FULL)))
|
||
|
{
|
||
|
CurrentLinkStatus = LM_STATUS_LINK_SETTING_MISMATCH;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
CurrentLinkStatus = LM_STATUS_LINK_SETTING_MISMATCH;
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
/* Force line settings. */
|
||
|
/* Use the current setting if it matches the user's requested */
|
||
|
/* setting. */
|
||
|
LM_ReadPhy(pDevice, PHY_CTRL_REG, &Value32);
|
||
|
if((pDevice->LineSpeed == CurrentLineSpeed) &&
|
||
|
(pDevice->DuplexMode == CurrentDuplexMode))
|
||
|
{
|
||
|
if ((pDevice->DisableAutoNeg &&
|
||
|
!(Value32 & PHY_CTRL_AUTO_NEG_ENABLE)) ||
|
||
|
(!pDevice->DisableAutoNeg &&
|
||
|
(Value32 & PHY_CTRL_AUTO_NEG_ENABLE)))
|
||
|
{
|
||
|
CurrentLinkStatus = LM_STATUS_LINK_ACTIVE;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
CurrentLinkStatus = LM_STATUS_LINK_SETTING_MISMATCH;
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
CurrentLinkStatus = LM_STATUS_LINK_SETTING_MISMATCH;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Save line settings. */
|
||
|
pDevice->LineSpeed = CurrentLineSpeed;
|
||
|
pDevice->DuplexMode = CurrentDuplexMode;
|
||
|
pDevice->MediaType = LM_MEDIA_TYPE_UTP;
|
||
|
}
|
||
|
|
||
|
return CurrentLinkStatus;
|
||
|
} /* LM_InitBcm540xPhy */
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
LM_STATUS
|
||
|
LM_SetFlowControl(
|
||
|
PLM_DEVICE_BLOCK pDevice,
|
||
|
LM_UINT32 LocalPhyAd,
|
||
|
LM_UINT32 RemotePhyAd)
|
||
|
{
|
||
|
LM_FLOW_CONTROL FlowCap;
|
||
|
|
||
|
/* Resolve flow control. */
|
||
|
FlowCap = LM_FLOW_CONTROL_NONE;
|
||
|
|
||
|
/* See Table 28B-3 of 802.3ab-1999 spec. */
|
||
|
if(pDevice->FlowControlCap & LM_FLOW_CONTROL_AUTO_PAUSE)
|
||
|
{
|
||
|
if(LocalPhyAd & PHY_AN_AD_PAUSE_CAPABLE)
|
||
|
{
|
||
|
if(LocalPhyAd & PHY_AN_AD_ASYM_PAUSE)
|
||
|
{
|
||
|
if(RemotePhyAd & PHY_LINK_PARTNER_PAUSE_CAPABLE)
|
||
|
{
|
||
|
FlowCap = LM_FLOW_CONTROL_TRANSMIT_PAUSE |
|
||
|
LM_FLOW_CONTROL_RECEIVE_PAUSE;
|
||
|
}
|
||
|
else if(RemotePhyAd & PHY_LINK_PARTNER_ASYM_PAUSE)
|
||
|
{
|
||
|
FlowCap = LM_FLOW_CONTROL_RECEIVE_PAUSE;
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if(RemotePhyAd & PHY_LINK_PARTNER_PAUSE_CAPABLE)
|
||
|
{
|
||
|
FlowCap = LM_FLOW_CONTROL_TRANSMIT_PAUSE |
|
||
|
LM_FLOW_CONTROL_RECEIVE_PAUSE;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
else if(LocalPhyAd & PHY_AN_AD_ASYM_PAUSE)
|
||
|
{
|
||
|
if((RemotePhyAd & PHY_LINK_PARTNER_PAUSE_CAPABLE) &&
|
||
|
(RemotePhyAd & PHY_LINK_PARTNER_ASYM_PAUSE))
|
||
|
{
|
||
|
FlowCap = LM_FLOW_CONTROL_TRANSMIT_PAUSE;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
FlowCap = pDevice->FlowControlCap;
|
||
|
}
|
||
|
|
||
|
/* Enable/disable rx PAUSE. */
|
||
|
pDevice->RxMode &= ~RX_MODE_ENABLE_FLOW_CONTROL;
|
||
|
if(FlowCap & LM_FLOW_CONTROL_RECEIVE_PAUSE &&
|
||
|
(pDevice->FlowControlCap == LM_FLOW_CONTROL_AUTO_PAUSE ||
|
||
|
pDevice->FlowControlCap & LM_FLOW_CONTROL_RECEIVE_PAUSE))
|
||
|
{
|
||
|
pDevice->FlowControl |= LM_FLOW_CONTROL_RECEIVE_PAUSE;
|
||
|
pDevice->RxMode |= RX_MODE_ENABLE_FLOW_CONTROL;
|
||
|
|
||
|
}
|
||
|
REG_WR(pDevice, MacCtrl.RxMode, pDevice->RxMode);
|
||
|
|
||
|
/* Enable/disable tx PAUSE. */
|
||
|
pDevice->TxMode &= ~TX_MODE_ENABLE_FLOW_CONTROL;
|
||
|
if(FlowCap & LM_FLOW_CONTROL_TRANSMIT_PAUSE &&
|
||
|
(pDevice->FlowControlCap == LM_FLOW_CONTROL_AUTO_PAUSE ||
|
||
|
pDevice->FlowControlCap & LM_FLOW_CONTROL_TRANSMIT_PAUSE))
|
||
|
{
|
||
|
pDevice->FlowControl |= LM_FLOW_CONTROL_TRANSMIT_PAUSE;
|
||
|
pDevice->TxMode |= TX_MODE_ENABLE_FLOW_CONTROL;
|
||
|
|
||
|
}
|
||
|
REG_WR(pDevice, MacCtrl.TxMode, pDevice->TxMode);
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
}
|
||
|
|
||
|
|
||
|
#if INCLUDE_TBI_SUPPORT
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
STATIC LM_STATUS
|
||
|
LM_InitBcm800xPhy(
|
||
|
PLM_DEVICE_BLOCK pDevice)
|
||
|
{
|
||
|
LM_UINT32 Value32;
|
||
|
LM_UINT32 j;
|
||
|
|
||
|
Value32 = REG_RD(pDevice, MacCtrl.Status);
|
||
|
|
||
|
/* Reset the SERDES during init and when we have link. */
|
||
|
if(!pDevice->InitDone || Value32 & MAC_STATUS_PCS_SYNCED)
|
||
|
{
|
||
|
/* Set PLL lock range. */
|
||
|
LM_WritePhy(pDevice, 0x16, 0x8007);
|
||
|
|
||
|
/* Software reset. */
|
||
|
LM_WritePhy(pDevice, 0x00, 0x8000);
|
||
|
|
||
|
/* Wait for reset to complete. */
|
||
|
for(j = 0; j < 500; j++)
|
||
|
{
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
|
||
|
/* Config mode; seletct PMA/Ch 1 regs. */
|
||
|
LM_WritePhy(pDevice, 0x10, 0x8411);
|
||
|
|
||
|
/* Enable auto-lock and comdet, select txclk for tx. */
|
||
|
LM_WritePhy(pDevice, 0x11, 0x0a10);
|
||
|
|
||
|
LM_WritePhy(pDevice, 0x18, 0x00a0);
|
||
|
LM_WritePhy(pDevice, 0x16, 0x41ff);
|
||
|
|
||
|
/* Assert and deassert POR. */
|
||
|
LM_WritePhy(pDevice, 0x13, 0x0400);
|
||
|
MM_Wait(40);
|
||
|
LM_WritePhy(pDevice, 0x13, 0x0000);
|
||
|
|
||
|
LM_WritePhy(pDevice, 0x11, 0x0a50);
|
||
|
MM_Wait(40);
|
||
|
LM_WritePhy(pDevice, 0x11, 0x0a10);
|
||
|
|
||
|
/* Delay for signal to stabilize. */
|
||
|
for(j = 0; j < 15000; j++)
|
||
|
{
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
|
||
|
/* Deselect the channel register so we can read the PHY id later. */
|
||
|
LM_WritePhy(pDevice, 0x10, 0x8011);
|
||
|
}
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
}
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
STATIC LM_STATUS
|
||
|
LM_SetupFiberPhy(
|
||
|
PLM_DEVICE_BLOCK pDevice)
|
||
|
{
|
||
|
LM_STATUS CurrentLinkStatus;
|
||
|
AUTONEG_STATUS AnStatus = 0;
|
||
|
LM_UINT32 Value32;
|
||
|
LM_UINT32 Cnt;
|
||
|
LM_UINT32 j, k;
|
||
|
|
||
|
pDevice->MacMode &= ~(MAC_MODE_HALF_DUPLEX | MAC_MODE_PORT_MODE_MASK);
|
||
|
|
||
|
/* Initialize the send_config register. */
|
||
|
REG_WR(pDevice, MacCtrl.TxAutoNeg, 0);
|
||
|
|
||
|
/* Enable TBI and full duplex mode. */
|
||
|
pDevice->MacMode |= MAC_MODE_PORT_MODE_TBI;
|
||
|
REG_WR(pDevice, MacCtrl.Mode, pDevice->MacMode);
|
||
|
|
||
|
/* Initialize the BCM8002 SERDES PHY. */
|
||
|
switch(pDevice->PhyId & PHY_ID_MASK)
|
||
|
{
|
||
|
case PHY_BCM8002_PHY_ID:
|
||
|
LM_InitBcm800xPhy(pDevice);
|
||
|
break;
|
||
|
|
||
|
default:
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
/* Enable link change interrupt. */
|
||
|
REG_WR(pDevice, MacCtrl.MacEvent, MAC_EVENT_ENABLE_LINK_STATE_CHANGED_ATTN);
|
||
|
|
||
|
/* Default to link down. */
|
||
|
CurrentLinkStatus = LM_STATUS_LINK_DOWN;
|
||
|
|
||
|
/* Get the link status. */
|
||
|
Value32 = REG_RD(pDevice, MacCtrl.Status);
|
||
|
if(Value32 & MAC_STATUS_PCS_SYNCED)
|
||
|
{
|
||
|
if((pDevice->RequestedMediaType == LM_REQUESTED_MEDIA_TYPE_AUTO) ||
|
||
|
(pDevice->DisableAutoNeg == FALSE))
|
||
|
{
|
||
|
/* auto-negotiation mode. */
|
||
|
/* Initialize the autoneg default capaiblities. */
|
||
|
AutonegInit(&pDevice->AnInfo);
|
||
|
|
||
|
/* Set the context pointer to point to the main device structure. */
|
||
|
pDevice->AnInfo.pContext = pDevice;
|
||
|
|
||
|
/* Setup flow control advertisement register. */
|
||
|
Value32 = GetPhyAdFlowCntrlSettings(pDevice);
|
||
|
if(Value32 & PHY_AN_AD_PAUSE_CAPABLE)
|
||
|
{
|
||
|
pDevice->AnInfo.mr_adv_sym_pause = 1;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
pDevice->AnInfo.mr_adv_sym_pause = 0;
|
||
|
}
|
||
|
|
||
|
if(Value32 & PHY_AN_AD_ASYM_PAUSE)
|
||
|
{
|
||
|
pDevice->AnInfo.mr_adv_asym_pause = 1;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
pDevice->AnInfo.mr_adv_asym_pause = 0;
|
||
|
}
|
||
|
|
||
|
/* Try to autoneg up to six times. */
|
||
|
if (pDevice->IgnoreTbiLinkChange)
|
||
|
{
|
||
|
Cnt = 1;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
Cnt = 6;
|
||
|
}
|
||
|
for (j = 0; j < Cnt; j++)
|
||
|
{
|
||
|
REG_WR(pDevice, MacCtrl.TxAutoNeg, 0);
|
||
|
|
||
|
Value32 = pDevice->MacMode & ~MAC_MODE_PORT_MODE_MASK;
|
||
|
REG_WR(pDevice, MacCtrl.Mode, Value32);
|
||
|
MM_Wait(20);
|
||
|
|
||
|
REG_WR(pDevice, MacCtrl.Mode, pDevice->MacMode |
|
||
|
MAC_MODE_SEND_CONFIGS);
|
||
|
|
||
|
MM_Wait(20);
|
||
|
|
||
|
pDevice->AnInfo.State = AN_STATE_UNKNOWN;
|
||
|
pDevice->AnInfo.CurrentTime_us = 0;
|
||
|
|
||
|
REG_WR(pDevice, Grc.Timer, 0);
|
||
|
for(k = 0; (pDevice->AnInfo.CurrentTime_us < 75000) &&
|
||
|
(k < 75000); k++)
|
||
|
{
|
||
|
AnStatus = Autoneg8023z(&pDevice->AnInfo);
|
||
|
|
||
|
if((AnStatus == AUTONEG_STATUS_DONE) ||
|
||
|
(AnStatus == AUTONEG_STATUS_FAILED))
|
||
|
{
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
pDevice->AnInfo.CurrentTime_us = REG_RD(pDevice, Grc.Timer);
|
||
|
|
||
|
}
|
||
|
if((AnStatus == AUTONEG_STATUS_DONE) ||
|
||
|
(AnStatus == AUTONEG_STATUS_FAILED))
|
||
|
{
|
||
|
break;
|
||
|
}
|
||
|
if (j >= 1)
|
||
|
{
|
||
|
if (!(REG_RD(pDevice, MacCtrl.Status) &
|
||
|
MAC_STATUS_PCS_SYNCED)) {
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Stop sending configs. */
|
||
|
MM_AnTxIdle(&pDevice->AnInfo);
|
||
|
|
||
|
/* Resolve flow control settings. */
|
||
|
if((AnStatus == AUTONEG_STATUS_DONE) &&
|
||
|
pDevice->AnInfo.mr_an_complete && pDevice->AnInfo.mr_link_ok &&
|
||
|
pDevice->AnInfo.mr_lp_adv_full_duplex)
|
||
|
{
|
||
|
LM_UINT32 RemotePhyAd;
|
||
|
LM_UINT32 LocalPhyAd;
|
||
|
|
||
|
LocalPhyAd = 0;
|
||
|
if(pDevice->AnInfo.mr_adv_sym_pause)
|
||
|
{
|
||
|
LocalPhyAd |= PHY_AN_AD_PAUSE_CAPABLE;
|
||
|
}
|
||
|
|
||
|
if(pDevice->AnInfo.mr_adv_asym_pause)
|
||
|
{
|
||
|
LocalPhyAd |= PHY_AN_AD_ASYM_PAUSE;
|
||
|
}
|
||
|
|
||
|
RemotePhyAd = 0;
|
||
|
if(pDevice->AnInfo.mr_lp_adv_sym_pause)
|
||
|
{
|
||
|
RemotePhyAd |= PHY_LINK_PARTNER_PAUSE_CAPABLE;
|
||
|
}
|
||
|
|
||
|
if(pDevice->AnInfo.mr_lp_adv_asym_pause)
|
||
|
{
|
||
|
RemotePhyAd |= PHY_LINK_PARTNER_ASYM_PAUSE;
|
||
|
}
|
||
|
|
||
|
LM_SetFlowControl(pDevice, LocalPhyAd, RemotePhyAd);
|
||
|
|
||
|
CurrentLinkStatus = LM_STATUS_LINK_ACTIVE;
|
||
|
}
|
||
|
for (j = 0; j < 30; j++)
|
||
|
{
|
||
|
MM_Wait(20);
|
||
|
REG_WR(pDevice, MacCtrl.Status, MAC_STATUS_SYNC_CHANGED |
|
||
|
MAC_STATUS_CFG_CHANGED);
|
||
|
MM_Wait(20);
|
||
|
if ((REG_RD(pDevice, MacCtrl.Status) &
|
||
|
(MAC_STATUS_SYNC_CHANGED | MAC_STATUS_CFG_CHANGED)) == 0)
|
||
|
break;
|
||
|
}
|
||
|
if (pDevice->PollTbiLink)
|
||
|
{
|
||
|
Value32 = REG_RD(pDevice, MacCtrl.Status);
|
||
|
if (Value32 & MAC_STATUS_RECEIVING_CFG)
|
||
|
{
|
||
|
pDevice->IgnoreTbiLinkChange = TRUE;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
pDevice->IgnoreTbiLinkChange = FALSE;
|
||
|
}
|
||
|
}
|
||
|
Value32 = REG_RD(pDevice, MacCtrl.Status);
|
||
|
if (CurrentLinkStatus == LM_STATUS_LINK_DOWN &&
|
||
|
(Value32 & MAC_STATUS_PCS_SYNCED) &&
|
||
|
((Value32 & MAC_STATUS_RECEIVING_CFG) == 0))
|
||
|
{
|
||
|
CurrentLinkStatus = LM_STATUS_LINK_ACTIVE;
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
/* We are forcing line speed. */
|
||
|
pDevice->FlowControlCap &= ~LM_FLOW_CONTROL_AUTO_PAUSE;
|
||
|
LM_SetFlowControl(pDevice, 0, 0);
|
||
|
|
||
|
CurrentLinkStatus = LM_STATUS_LINK_ACTIVE;
|
||
|
REG_WR(pDevice, MacCtrl.Mode, pDevice->MacMode |
|
||
|
MAC_MODE_SEND_CONFIGS);
|
||
|
}
|
||
|
}
|
||
|
/* Set the link polarity bit. */
|
||
|
pDevice->MacMode &= ~MAC_MODE_LINK_POLARITY;
|
||
|
REG_WR(pDevice, MacCtrl.Mode, pDevice->MacMode);
|
||
|
|
||
|
pDevice->pStatusBlkVirt->Status = STATUS_BLOCK_UPDATED |
|
||
|
(pDevice->pStatusBlkVirt->Status & ~STATUS_BLOCK_LINK_CHANGED_STATUS);
|
||
|
|
||
|
for (j = 0; j < 100; j++)
|
||
|
{
|
||
|
REG_WR(pDevice, MacCtrl.Status, MAC_STATUS_SYNC_CHANGED |
|
||
|
MAC_STATUS_CFG_CHANGED);
|
||
|
MM_Wait(5);
|
||
|
if ((REG_RD(pDevice, MacCtrl.Status) &
|
||
|
(MAC_STATUS_SYNC_CHANGED | MAC_STATUS_CFG_CHANGED)) == 0)
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
Value32 = REG_RD(pDevice, MacCtrl.Status);
|
||
|
if((Value32 & MAC_STATUS_PCS_SYNCED) == 0)
|
||
|
{
|
||
|
CurrentLinkStatus = LM_STATUS_LINK_DOWN;
|
||
|
if (pDevice->DisableAutoNeg == FALSE)
|
||
|
{
|
||
|
REG_WR(pDevice, MacCtrl.Mode, pDevice->MacMode |
|
||
|
MAC_MODE_SEND_CONFIGS);
|
||
|
MM_Wait(1);
|
||
|
REG_WR(pDevice, MacCtrl.Mode, pDevice->MacMode);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Initialize the current link status. */
|
||
|
if(CurrentLinkStatus == LM_STATUS_LINK_ACTIVE)
|
||
|
{
|
||
|
pDevice->LineSpeed = LM_LINE_SPEED_1000MBPS;
|
||
|
pDevice->DuplexMode = LM_DUPLEX_MODE_FULL;
|
||
|
REG_WR(pDevice, MacCtrl.LedCtrl, LED_CTRL_OVERRIDE_LINK_LED |
|
||
|
LED_CTRL_1000MBPS_LED_ON);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
pDevice->LineSpeed = LM_LINE_SPEED_UNKNOWN;
|
||
|
pDevice->DuplexMode = LM_DUPLEX_MODE_UNKNOWN;
|
||
|
REG_WR(pDevice, MacCtrl.LedCtrl, LED_CTRL_OVERRIDE_LINK_LED |
|
||
|
LED_CTRL_OVERRIDE_TRAFFIC_LED);
|
||
|
}
|
||
|
|
||
|
/* Indicate link status. */
|
||
|
if (pDevice->LinkStatus != CurrentLinkStatus) {
|
||
|
pDevice->LinkStatus = CurrentLinkStatus;
|
||
|
MM_IndicateStatus(pDevice, CurrentLinkStatus);
|
||
|
}
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
}
|
||
|
#endif /* INCLUDE_TBI_SUPPORT */
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
LM_STATUS
|
||
|
LM_SetupCopperPhy(
|
||
|
PLM_DEVICE_BLOCK pDevice)
|
||
|
{
|
||
|
LM_STATUS CurrentLinkStatus;
|
||
|
LM_UINT32 Value32;
|
||
|
|
||
|
/* Assume there is not link first. */
|
||
|
CurrentLinkStatus = LM_STATUS_LINK_DOWN;
|
||
|
|
||
|
/* Disable phy link change attention. */
|
||
|
REG_WR(pDevice, MacCtrl.MacEvent, 0);
|
||
|
|
||
|
/* Clear link change attention. */
|
||
|
REG_WR(pDevice, MacCtrl.Status, MAC_STATUS_SYNC_CHANGED |
|
||
|
MAC_STATUS_CFG_CHANGED);
|
||
|
|
||
|
/* Disable auto-polling for the moment. */
|
||
|
pDevice->MiMode = 0xc0000;
|
||
|
REG_WR(pDevice, MacCtrl.MiMode, pDevice->MiMode);
|
||
|
MM_Wait(40);
|
||
|
|
||
|
/* Determine the requested line speed and duplex. */
|
||
|
pDevice->OldLineSpeed = pDevice->LineSpeed;
|
||
|
LM_TranslateRequestedMediaType(pDevice->RequestedMediaType,
|
||
|
&pDevice->MediaType, &pDevice->LineSpeed, &pDevice->DuplexMode);
|
||
|
|
||
|
/* Initialize the phy chip. */
|
||
|
switch(pDevice->PhyId & PHY_ID_MASK)
|
||
|
{
|
||
|
case PHY_BCM5400_PHY_ID:
|
||
|
case PHY_BCM5401_PHY_ID:
|
||
|
case PHY_BCM5411_PHY_ID:
|
||
|
case PHY_BCM5701_PHY_ID:
|
||
|
case PHY_BCM5703_PHY_ID:
|
||
|
case PHY_BCM5704_PHY_ID:
|
||
|
CurrentLinkStatus = LM_InitBcm540xPhy(pDevice);
|
||
|
break;
|
||
|
|
||
|
default:
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
if(CurrentLinkStatus == LM_STATUS_LINK_SETTING_MISMATCH)
|
||
|
{
|
||
|
CurrentLinkStatus = LM_STATUS_LINK_DOWN;
|
||
|
}
|
||
|
|
||
|
/* Setup flow control. */
|
||
|
pDevice->FlowControl = LM_FLOW_CONTROL_NONE;
|
||
|
if(CurrentLinkStatus == LM_STATUS_LINK_ACTIVE)
|
||
|
{
|
||
|
LM_FLOW_CONTROL FlowCap; /* Flow control capability. */
|
||
|
|
||
|
FlowCap = LM_FLOW_CONTROL_NONE;
|
||
|
|
||
|
if(pDevice->DuplexMode == LM_DUPLEX_MODE_FULL)
|
||
|
{
|
||
|
if(pDevice->DisableAutoNeg == FALSE ||
|
||
|
pDevice->RequestedMediaType == LM_REQUESTED_MEDIA_TYPE_AUTO ||
|
||
|
pDevice->RequestedMediaType == LM_REQUESTED_MEDIA_TYPE_UTP_AUTO)
|
||
|
{
|
||
|
LM_UINT32 ExpectedPhyAd;
|
||
|
LM_UINT32 LocalPhyAd;
|
||
|
LM_UINT32 RemotePhyAd;
|
||
|
|
||
|
LM_ReadPhy(pDevice, PHY_AN_AD_REG, &LocalPhyAd);
|
||
|
pDevice->advertising = LocalPhyAd;
|
||
|
LocalPhyAd &= (PHY_AN_AD_ASYM_PAUSE | PHY_AN_AD_PAUSE_CAPABLE);
|
||
|
|
||
|
ExpectedPhyAd = GetPhyAdFlowCntrlSettings(pDevice);
|
||
|
|
||
|
if(LocalPhyAd != ExpectedPhyAd)
|
||
|
{
|
||
|
CurrentLinkStatus = LM_STATUS_LINK_DOWN;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
LM_ReadPhy(pDevice, PHY_LINK_PARTNER_ABILITY_REG,
|
||
|
&RemotePhyAd);
|
||
|
|
||
|
LM_SetFlowControl(pDevice, LocalPhyAd, RemotePhyAd);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
pDevice->FlowControlCap &= ~LM_FLOW_CONTROL_AUTO_PAUSE;
|
||
|
LM_SetFlowControl(pDevice, 0, 0);
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if(CurrentLinkStatus == LM_STATUS_LINK_DOWN)
|
||
|
{
|
||
|
LM_ForceAutoNeg(pDevice, pDevice->RequestedMediaType);
|
||
|
|
||
|
/* If we force line speed, we make get link right away. */
|
||
|
LM_ReadPhy(pDevice, PHY_STATUS_REG, &Value32);
|
||
|
LM_ReadPhy(pDevice, PHY_STATUS_REG, &Value32);
|
||
|
if(Value32 & PHY_STATUS_LINK_PASS)
|
||
|
{
|
||
|
CurrentLinkStatus = LM_STATUS_LINK_ACTIVE;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* GMII interface. */
|
||
|
pDevice->MacMode &= ~MAC_MODE_PORT_MODE_MASK;
|
||
|
if(CurrentLinkStatus == LM_STATUS_LINK_ACTIVE)
|
||
|
{
|
||
|
if(pDevice->LineSpeed == LM_LINE_SPEED_100MBPS ||
|
||
|
pDevice->LineSpeed == LM_LINE_SPEED_10MBPS)
|
||
|
{
|
||
|
pDevice->MacMode |= MAC_MODE_PORT_MODE_MII;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
pDevice->MacMode |= MAC_MODE_PORT_MODE_GMII;
|
||
|
}
|
||
|
}
|
||
|
else {
|
||
|
pDevice->MacMode |= MAC_MODE_PORT_MODE_GMII;
|
||
|
}
|
||
|
|
||
|
/* Set the MAC to operate in the appropriate duplex mode. */
|
||
|
pDevice->MacMode &= ~MAC_MODE_HALF_DUPLEX;
|
||
|
if(pDevice->DuplexMode == LM_DUPLEX_MODE_HALF)
|
||
|
{
|
||
|
pDevice->MacMode |= MAC_MODE_HALF_DUPLEX;
|
||
|
}
|
||
|
|
||
|
/* Set the link polarity bit. */
|
||
|
pDevice->MacMode &= ~MAC_MODE_LINK_POLARITY;
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700)
|
||
|
{
|
||
|
if((pDevice->LedMode == LED_MODE_LINK10) ||
|
||
|
(CurrentLinkStatus == LM_STATUS_LINK_ACTIVE &&
|
||
|
pDevice->LineSpeed == LM_LINE_SPEED_10MBPS))
|
||
|
{
|
||
|
pDevice->MacMode |= MAC_MODE_LINK_POLARITY;
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if (CurrentLinkStatus == LM_STATUS_LINK_ACTIVE)
|
||
|
{
|
||
|
pDevice->MacMode |= MAC_MODE_LINK_POLARITY;
|
||
|
}
|
||
|
|
||
|
/* Set LED mode. */
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700 ||
|
||
|
T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5701)
|
||
|
{
|
||
|
Value32 = LED_CTRL_PHY_MODE_1;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if(pDevice->LedMode == LED_MODE_OUTPUT)
|
||
|
{
|
||
|
Value32 = LED_CTRL_PHY_MODE_2;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
Value32 = LED_CTRL_PHY_MODE_1;
|
||
|
}
|
||
|
}
|
||
|
REG_WR(pDevice, MacCtrl.LedCtrl, Value32);
|
||
|
}
|
||
|
|
||
|
REG_WR(pDevice, MacCtrl.Mode, pDevice->MacMode);
|
||
|
|
||
|
/* Enable auto polling. */
|
||
|
if(pDevice->PhyIntMode == T3_PHY_INT_MODE_AUTO_POLLING)
|
||
|
{
|
||
|
pDevice->MiMode |= MI_MODE_AUTO_POLLING_ENABLE;
|
||
|
REG_WR(pDevice, MacCtrl.MiMode, pDevice->MiMode);
|
||
|
}
|
||
|
|
||
|
/* Enable phy link change attention. */
|
||
|
if(pDevice->PhyIntMode == T3_PHY_INT_MODE_MI_INTERRUPT)
|
||
|
{
|
||
|
REG_WR(pDevice, MacCtrl.MacEvent, MAC_EVENT_ENABLE_MI_INTERRUPT);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
REG_WR(pDevice, MacCtrl.MacEvent,
|
||
|
MAC_EVENT_ENABLE_LINK_STATE_CHANGED_ATTN);
|
||
|
}
|
||
|
if ((T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700) &&
|
||
|
(CurrentLinkStatus == LM_STATUS_LINK_ACTIVE) &&
|
||
|
(pDevice->LineSpeed == LM_LINE_SPEED_1000MBPS) &&
|
||
|
(((pDevice->PciState & T3_PCI_STATE_CONVENTIONAL_PCI_MODE) &&
|
||
|
(pDevice->PciState & T3_PCI_STATE_BUS_SPEED_HIGH)) ||
|
||
|
!(pDevice->PciState & T3_PCI_STATE_CONVENTIONAL_PCI_MODE)))
|
||
|
{
|
||
|
MM_Wait(120);
|
||
|
REG_WR(pDevice, MacCtrl.Status, MAC_STATUS_SYNC_CHANGED |
|
||
|
MAC_STATUS_CFG_CHANGED);
|
||
|
MEM_WR_OFFSET(pDevice, T3_FIRMWARE_MAILBOX,
|
||
|
T3_MAGIC_NUM_DISABLE_DMAW_ON_LINK_CHANGE);
|
||
|
}
|
||
|
|
||
|
/* Indicate link status. */
|
||
|
if (pDevice->LinkStatus != CurrentLinkStatus) {
|
||
|
pDevice->LinkStatus = CurrentLinkStatus;
|
||
|
MM_IndicateStatus(pDevice, CurrentLinkStatus);
|
||
|
}
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
} /* LM_SetupCopperPhy */
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
LM_STATUS
|
||
|
LM_SetupPhy(
|
||
|
PLM_DEVICE_BLOCK pDevice)
|
||
|
{
|
||
|
LM_STATUS LmStatus;
|
||
|
LM_UINT32 Value32;
|
||
|
|
||
|
#if INCLUDE_TBI_SUPPORT
|
||
|
if(pDevice->EnableTbi)
|
||
|
{
|
||
|
LmStatus = LM_SetupFiberPhy(pDevice);
|
||
|
}
|
||
|
else
|
||
|
#endif /* INCLUDE_TBI_SUPPORT */
|
||
|
{
|
||
|
LmStatus = LM_SetupCopperPhy(pDevice);
|
||
|
}
|
||
|
if (pDevice->ChipRevId == T3_CHIP_ID_5704_A0)
|
||
|
{
|
||
|
if (!(pDevice->PciState & T3_PCI_STATE_CONVENTIONAL_PCI_MODE))
|
||
|
{
|
||
|
Value32 = REG_RD(pDevice, PciCfg.PciState);
|
||
|
REG_WR(pDevice, PciCfg.PciState,
|
||
|
Value32 | T3_PCI_STATE_RETRY_SAME_DMA);
|
||
|
}
|
||
|
}
|
||
|
if ((pDevice->LineSpeed == LM_LINE_SPEED_1000MBPS) &&
|
||
|
(pDevice->DuplexMode == LM_DUPLEX_MODE_HALF))
|
||
|
{
|
||
|
REG_WR(pDevice, MacCtrl.TxLengths, 0x26ff);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
REG_WR(pDevice, MacCtrl.TxLengths, 0x2620);
|
||
|
}
|
||
|
|
||
|
return LmStatus;
|
||
|
}
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
LM_VOID
|
||
|
LM_ReadPhy(
|
||
|
PLM_DEVICE_BLOCK pDevice,
|
||
|
LM_UINT32 PhyReg,
|
||
|
PLM_UINT32 pData32) {
|
||
|
LM_UINT32 Value32;
|
||
|
LM_UINT32 j;
|
||
|
|
||
|
if(pDevice->PhyIntMode == T3_PHY_INT_MODE_AUTO_POLLING)
|
||
|
{
|
||
|
REG_WR(pDevice, MacCtrl.MiMode, pDevice->MiMode &
|
||
|
~MI_MODE_AUTO_POLLING_ENABLE);
|
||
|
MM_Wait(40);
|
||
|
}
|
||
|
|
||
|
Value32 = (pDevice->PhyAddr << MI_COM_FIRST_PHY_ADDR_BIT) |
|
||
|
((PhyReg & MI_COM_PHY_REG_ADDR_MASK) << MI_COM_FIRST_PHY_REG_ADDR_BIT) |
|
||
|
MI_COM_CMD_READ | MI_COM_START;
|
||
|
|
||
|
REG_WR(pDevice, MacCtrl.MiCom, Value32);
|
||
|
|
||
|
for(j = 0; j < 20; j++)
|
||
|
{
|
||
|
MM_Wait(25);
|
||
|
|
||
|
Value32 = REG_RD(pDevice, MacCtrl.MiCom);
|
||
|
|
||
|
if(!(Value32 & MI_COM_BUSY))
|
||
|
{
|
||
|
MM_Wait(5);
|
||
|
Value32 = REG_RD(pDevice, MacCtrl.MiCom);
|
||
|
Value32 &= MI_COM_PHY_DATA_MASK;
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if(Value32 & MI_COM_BUSY)
|
||
|
{
|
||
|
Value32 = 0;
|
||
|
}
|
||
|
|
||
|
*pData32 = Value32;
|
||
|
|
||
|
if(pDevice->PhyIntMode == T3_PHY_INT_MODE_AUTO_POLLING)
|
||
|
{
|
||
|
REG_WR(pDevice, MacCtrl.MiMode, pDevice->MiMode);
|
||
|
MM_Wait(40);
|
||
|
}
|
||
|
} /* LM_ReadPhy */
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
LM_VOID
|
||
|
LM_WritePhy(
|
||
|
PLM_DEVICE_BLOCK pDevice,
|
||
|
LM_UINT32 PhyReg,
|
||
|
LM_UINT32 Data32) {
|
||
|
LM_UINT32 Value32;
|
||
|
LM_UINT32 j;
|
||
|
|
||
|
if(pDevice->PhyIntMode == T3_PHY_INT_MODE_AUTO_POLLING)
|
||
|
{
|
||
|
REG_WR(pDevice, MacCtrl.MiMode, pDevice->MiMode &
|
||
|
~MI_MODE_AUTO_POLLING_ENABLE);
|
||
|
MM_Wait(40);
|
||
|
}
|
||
|
|
||
|
Value32 = (pDevice->PhyAddr << MI_COM_FIRST_PHY_ADDR_BIT) |
|
||
|
((PhyReg & MI_COM_PHY_REG_ADDR_MASK) << MI_COM_FIRST_PHY_REG_ADDR_BIT) |
|
||
|
(Data32 & MI_COM_PHY_DATA_MASK) | MI_COM_CMD_WRITE | MI_COM_START;
|
||
|
|
||
|
REG_WR(pDevice, MacCtrl.MiCom, Value32);
|
||
|
|
||
|
for(j = 0; j < 20; j++)
|
||
|
{
|
||
|
MM_Wait(25);
|
||
|
|
||
|
Value32 = REG_RD(pDevice, MacCtrl.MiCom);
|
||
|
|
||
|
if(!(Value32 & MI_COM_BUSY))
|
||
|
{
|
||
|
MM_Wait(5);
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if(pDevice->PhyIntMode == T3_PHY_INT_MODE_AUTO_POLLING)
|
||
|
{
|
||
|
REG_WR(pDevice, MacCtrl.MiMode, pDevice->MiMode);
|
||
|
MM_Wait(40);
|
||
|
}
|
||
|
} /* LM_WritePhy */
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
LM_STATUS
|
||
|
LM_SetPowerState(
|
||
|
PLM_DEVICE_BLOCK pDevice,
|
||
|
LM_POWER_STATE PowerLevel) {
|
||
|
LM_UINT32 PmeSupport;
|
||
|
LM_UINT32 Value32;
|
||
|
LM_UINT32 PmCtrl;
|
||
|
|
||
|
/* make sureindirect accesses are enabled*/
|
||
|
MM_WriteConfig32(pDevice, T3_PCI_MISC_HOST_CTRL_REG, pDevice->MiscHostCtrl);
|
||
|
|
||
|
/* Clear the PME_ASSERT bit and the power state bits. Also enable */
|
||
|
/* the PME bit. */
|
||
|
MM_ReadConfig32(pDevice, T3_PCI_PM_STATUS_CTRL_REG, &PmCtrl);
|
||
|
|
||
|
PmCtrl |= T3_PM_PME_ASSERTED;
|
||
|
PmCtrl &= ~T3_PM_POWER_STATE_MASK;
|
||
|
|
||
|
/* Set the appropriate power state. */
|
||
|
if(PowerLevel == LM_POWER_STATE_D0)
|
||
|
{
|
||
|
|
||
|
/* Bring the card out of low power mode. */
|
||
|
PmCtrl |= T3_PM_POWER_STATE_D0;
|
||
|
MM_WriteConfig32(pDevice, T3_PCI_PM_STATUS_CTRL_REG, PmCtrl);
|
||
|
|
||
|
REG_WR(pDevice, Grc.LocalCtrl, pDevice->GrcLocalCtrl);
|
||
|
MM_Wait (40);
|
||
|
#if 0 /* Bugfix by jmb...can't call WritePhy here because pDevice not fully initialized */
|
||
|
LM_WritePhy(pDevice, BCM5401_AUX_CTRL, 0x02);
|
||
|
#endif
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
}
|
||
|
else if(PowerLevel == LM_POWER_STATE_D1)
|
||
|
{
|
||
|
PmCtrl |= T3_PM_POWER_STATE_D1;
|
||
|
}
|
||
|
else if(PowerLevel == LM_POWER_STATE_D2)
|
||
|
{
|
||
|
PmCtrl |= T3_PM_POWER_STATE_D2;
|
||
|
}
|
||
|
else if(PowerLevel == LM_POWER_STATE_D3)
|
||
|
{
|
||
|
PmCtrl |= T3_PM_POWER_STATE_D3;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
return LM_STATUS_FAILURE;
|
||
|
}
|
||
|
PmCtrl |= T3_PM_PME_ENABLE;
|
||
|
|
||
|
/* Mask out all interrupts so LM_SetupPhy won't be called while we are */
|
||
|
/* setting new line speed. */
|
||
|
Value32 = REG_RD(pDevice, PciCfg.MiscHostCtrl);
|
||
|
REG_WR(pDevice, PciCfg.MiscHostCtrl, Value32 | MISC_HOST_CTRL_MASK_PCI_INT);
|
||
|
|
||
|
if(!pDevice->RestoreOnWakeUp)
|
||
|
{
|
||
|
pDevice->RestoreOnWakeUp = TRUE;
|
||
|
pDevice->WakeUpDisableAutoNeg = pDevice->DisableAutoNeg;
|
||
|
pDevice->WakeUpRequestedMediaType = pDevice->RequestedMediaType;
|
||
|
}
|
||
|
|
||
|
/* Force auto-negotiation to 10 line speed. */
|
||
|
pDevice->DisableAutoNeg = FALSE;
|
||
|
pDevice->RequestedMediaType = LM_REQUESTED_MEDIA_TYPE_UTP_10MBPS;
|
||
|
LM_SetupPhy(pDevice);
|
||
|
|
||
|
/* Put the driver in the initial state, and go through the power down */
|
||
|
/* sequence. */
|
||
|
LM_Halt(pDevice);
|
||
|
|
||
|
MM_ReadConfig32(pDevice, T3_PCI_PM_CAP_REG, &PmeSupport);
|
||
|
|
||
|
if (pDevice->WakeUpModeCap != LM_WAKE_UP_MODE_NONE)
|
||
|
{
|
||
|
|
||
|
/* Enable WOL. */
|
||
|
LM_WritePhy(pDevice, BCM5401_AUX_CTRL, 0x5a);
|
||
|
MM_Wait(40);
|
||
|
|
||
|
/* Set LED mode. */
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700 ||
|
||
|
T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5701)
|
||
|
{
|
||
|
Value32 = LED_CTRL_PHY_MODE_1;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if(pDevice->LedMode == LED_MODE_OUTPUT)
|
||
|
{
|
||
|
Value32 = LED_CTRL_PHY_MODE_2;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
Value32 = LED_CTRL_PHY_MODE_1;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
Value32 = MAC_MODE_PORT_MODE_MII;
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700)
|
||
|
{
|
||
|
if(pDevice->LedMode == LED_MODE_LINK10 ||
|
||
|
pDevice->WolSpeed == WOL_SPEED_10MB)
|
||
|
{
|
||
|
Value32 |= MAC_MODE_LINK_POLARITY;
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
Value32 |= MAC_MODE_LINK_POLARITY;
|
||
|
}
|
||
|
REG_WR(pDevice, MacCtrl.Mode, Value32);
|
||
|
MM_Wait(40); MM_Wait(40); MM_Wait(40);
|
||
|
|
||
|
/* Always enable magic packet wake-up if we have vaux. */
|
||
|
if((PmeSupport & T3_PCI_PM_CAP_PME_D3COLD) &&
|
||
|
(pDevice->WakeUpModeCap & LM_WAKE_UP_MODE_MAGIC_PACKET))
|
||
|
{
|
||
|
Value32 |= MAC_MODE_DETECT_MAGIC_PACKET_ENABLE;
|
||
|
}
|
||
|
|
||
|
REG_WR(pDevice, MacCtrl.Mode, Value32);
|
||
|
|
||
|
/* Enable the receiver. */
|
||
|
REG_WR(pDevice, MacCtrl.RxMode, RX_MODE_ENABLE);
|
||
|
}
|
||
|
|
||
|
/* Disable tx/rx clocks, and seletect an alternate clock. */
|
||
|
if(pDevice->WolSpeed == WOL_SPEED_100MB)
|
||
|
{
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700 ||
|
||
|
T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5701)
|
||
|
{
|
||
|
Value32 = T3_PCI_DISABLE_RX_CLOCK | T3_PCI_DISABLE_TX_CLOCK |
|
||
|
T3_PCI_SELECT_ALTERNATE_CLOCK;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
Value32 = T3_PCI_SELECT_ALTERNATE_CLOCK;
|
||
|
}
|
||
|
REG_WR(pDevice, PciCfg.ClockCtrl, Value32);
|
||
|
|
||
|
MM_Wait(40);
|
||
|
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700 ||
|
||
|
T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5701)
|
||
|
{
|
||
|
Value32 = T3_PCI_DISABLE_RX_CLOCK | T3_PCI_DISABLE_TX_CLOCK |
|
||
|
T3_PCI_SELECT_ALTERNATE_CLOCK | T3_PCI_44MHZ_CORE_CLOCK;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
Value32 = T3_PCI_SELECT_ALTERNATE_CLOCK |
|
||
|
T3_PCI_44MHZ_CORE_CLOCK;
|
||
|
}
|
||
|
|
||
|
REG_WR(pDevice, PciCfg.ClockCtrl, Value32);
|
||
|
|
||
|
MM_Wait(40);
|
||
|
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700 ||
|
||
|
T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5701)
|
||
|
{
|
||
|
Value32 = T3_PCI_DISABLE_RX_CLOCK | T3_PCI_DISABLE_TX_CLOCK |
|
||
|
T3_PCI_44MHZ_CORE_CLOCK;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
Value32 = T3_PCI_44MHZ_CORE_CLOCK;
|
||
|
}
|
||
|
|
||
|
REG_WR(pDevice, PciCfg.ClockCtrl, Value32);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700 ||
|
||
|
T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5701)
|
||
|
{
|
||
|
Value32 = T3_PCI_DISABLE_RX_CLOCK | T3_PCI_DISABLE_TX_CLOCK |
|
||
|
T3_PCI_SELECT_ALTERNATE_CLOCK |
|
||
|
T3_PCI_POWER_DOWN_PCI_PLL133;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
Value32 = T3_PCI_SELECT_ALTERNATE_CLOCK |
|
||
|
T3_PCI_POWER_DOWN_PCI_PLL133;
|
||
|
}
|
||
|
|
||
|
REG_WR(pDevice, PciCfg.ClockCtrl, Value32);
|
||
|
}
|
||
|
|
||
|
MM_Wait(40);
|
||
|
|
||
|
if(!pDevice->EepromWp && (pDevice->WakeUpModeCap != LM_WAKE_UP_MODE_NONE))
|
||
|
{
|
||
|
/* Switch adapter to auxilliary power. */
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5700 ||
|
||
|
T3_ASIC_REV(pDevice->ChipRevId) == T3_ASIC_REV_5701)
|
||
|
{
|
||
|
/* GPIO0 = 1, GPIO1 = 1, GPIO2 = 0. */
|
||
|
REG_WR(pDevice, Grc.LocalCtrl, pDevice->GrcLocalCtrl |
|
||
|
GRC_MISC_LOCAL_CTRL_GPIO_OE0 |
|
||
|
GRC_MISC_LOCAL_CTRL_GPIO_OE1 |
|
||
|
GRC_MISC_LOCAL_CTRL_GPIO_OE2 |
|
||
|
GRC_MISC_LOCAL_CTRL_GPIO_OUTPUT0 |
|
||
|
GRC_MISC_LOCAL_CTRL_GPIO_OUTPUT1);
|
||
|
MM_Wait(40);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
/* GPIO0 = 0, GPIO1 = 1, GPIO2 = 1. */
|
||
|
REG_WR(pDevice, Grc.LocalCtrl, pDevice->GrcLocalCtrl |
|
||
|
GRC_MISC_LOCAL_CTRL_GPIO_OE0 |
|
||
|
GRC_MISC_LOCAL_CTRL_GPIO_OE1 |
|
||
|
GRC_MISC_LOCAL_CTRL_GPIO_OE2 |
|
||
|
GRC_MISC_LOCAL_CTRL_GPIO_OUTPUT1 |
|
||
|
GRC_MISC_LOCAL_CTRL_GPIO_OUTPUT2);
|
||
|
MM_Wait(40);
|
||
|
|
||
|
/* GPIO0 = 1, GPIO1 = 1, GPIO2 = 1. */
|
||
|
REG_WR(pDevice, Grc.LocalCtrl, pDevice->GrcLocalCtrl |
|
||
|
GRC_MISC_LOCAL_CTRL_GPIO_OE0 |
|
||
|
GRC_MISC_LOCAL_CTRL_GPIO_OE1 |
|
||
|
GRC_MISC_LOCAL_CTRL_GPIO_OE2 |
|
||
|
GRC_MISC_LOCAL_CTRL_GPIO_OUTPUT0 |
|
||
|
GRC_MISC_LOCAL_CTRL_GPIO_OUTPUT1 |
|
||
|
GRC_MISC_LOCAL_CTRL_GPIO_OUTPUT2);
|
||
|
MM_Wait(40);
|
||
|
|
||
|
/* GPIO0 = 1, GPIO1 = 1, GPIO2 = 0. */
|
||
|
REG_WR(pDevice, Grc.LocalCtrl, pDevice->GrcLocalCtrl |
|
||
|
GRC_MISC_LOCAL_CTRL_GPIO_OE0 |
|
||
|
GRC_MISC_LOCAL_CTRL_GPIO_OE1 |
|
||
|
GRC_MISC_LOCAL_CTRL_GPIO_OE2 |
|
||
|
GRC_MISC_LOCAL_CTRL_GPIO_OUTPUT0 |
|
||
|
GRC_MISC_LOCAL_CTRL_GPIO_OUTPUT1);
|
||
|
MM_Wait(40);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Set the phy to low power mode. */
|
||
|
/* Put the the hardware in low power mode. */
|
||
|
MM_WriteConfig32(pDevice, T3_PCI_PM_STATUS_CTRL_REG, PmCtrl);
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
} /* LM_SetPowerState */
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
static LM_UINT32
|
||
|
GetPhyAdFlowCntrlSettings(
|
||
|
PLM_DEVICE_BLOCK pDevice)
|
||
|
{
|
||
|
LM_UINT32 Value32;
|
||
|
|
||
|
Value32 = 0;
|
||
|
|
||
|
/* Auto negotiation flow control only when autonegotiation is enabled. */
|
||
|
if(pDevice->DisableAutoNeg == FALSE ||
|
||
|
pDevice->RequestedMediaType == LM_REQUESTED_MEDIA_TYPE_AUTO ||
|
||
|
pDevice->RequestedMediaType == LM_REQUESTED_MEDIA_TYPE_UTP_AUTO)
|
||
|
{
|
||
|
/* Please refer to Table 28B-3 of the 802.3ab-1999 spec. */
|
||
|
if((pDevice->FlowControlCap == LM_FLOW_CONTROL_AUTO_PAUSE) ||
|
||
|
((pDevice->FlowControlCap & LM_FLOW_CONTROL_RECEIVE_PAUSE) &&
|
||
|
(pDevice->FlowControlCap & LM_FLOW_CONTROL_TRANSMIT_PAUSE)))
|
||
|
{
|
||
|
Value32 |= PHY_AN_AD_PAUSE_CAPABLE;
|
||
|
}
|
||
|
else if(pDevice->FlowControlCap & LM_FLOW_CONTROL_TRANSMIT_PAUSE)
|
||
|
{
|
||
|
Value32 |= PHY_AN_AD_ASYM_PAUSE;
|
||
|
}
|
||
|
else if(pDevice->FlowControlCap & LM_FLOW_CONTROL_RECEIVE_PAUSE)
|
||
|
{
|
||
|
Value32 |= PHY_AN_AD_PAUSE_CAPABLE | PHY_AN_AD_ASYM_PAUSE;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return Value32;
|
||
|
}
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/* LM_STATUS_FAILURE */
|
||
|
/* LM_STATUS_SUCCESS */
|
||
|
/* */
|
||
|
/******************************************************************************/
|
||
|
static LM_STATUS
|
||
|
LM_ForceAutoNegBcm540xPhy(
|
||
|
PLM_DEVICE_BLOCK pDevice,
|
||
|
LM_REQUESTED_MEDIA_TYPE RequestedMediaType)
|
||
|
{
|
||
|
LM_MEDIA_TYPE MediaType;
|
||
|
LM_LINE_SPEED LineSpeed;
|
||
|
LM_DUPLEX_MODE DuplexMode;
|
||
|
LM_UINT32 NewPhyCtrl;
|
||
|
LM_UINT32 Value32;
|
||
|
LM_UINT32 Cnt;
|
||
|
|
||
|
/* Get the interface type, line speed, and duplex mode. */
|
||
|
LM_TranslateRequestedMediaType(RequestedMediaType, &MediaType, &LineSpeed,
|
||
|
&DuplexMode);
|
||
|
|
||
|
if (pDevice->RestoreOnWakeUp)
|
||
|
{
|
||
|
LM_WritePhy(pDevice, BCM540X_1000BASET_CTRL_REG, 0);
|
||
|
pDevice->advertising1000 = 0;
|
||
|
Value32 = PHY_AN_AD_10BASET_FULL | PHY_AN_AD_10BASET_HALF;
|
||
|
if (pDevice->WolSpeed == WOL_SPEED_100MB)
|
||
|
{
|
||
|
Value32 |= PHY_AN_AD_100BASETX_FULL | PHY_AN_AD_100BASETX_HALF;
|
||
|
}
|
||
|
Value32 |= PHY_AN_AD_PROTOCOL_802_3_CSMA_CD;
|
||
|
Value32 |= GetPhyAdFlowCntrlSettings(pDevice);
|
||
|
LM_WritePhy(pDevice, PHY_AN_AD_REG, Value32);
|
||
|
pDevice->advertising = Value32;
|
||
|
}
|
||
|
/* Setup the auto-negotiation advertisement register. */
|
||
|
else if(LineSpeed == LM_LINE_SPEED_UNKNOWN)
|
||
|
{
|
||
|
/* Setup the 10/100 Mbps auto-negotiation advertisement register. */
|
||
|
Value32 = PHY_AN_AD_PROTOCOL_802_3_CSMA_CD |
|
||
|
PHY_AN_AD_10BASET_HALF | PHY_AN_AD_10BASET_FULL |
|
||
|
PHY_AN_AD_100BASETX_FULL | PHY_AN_AD_100BASETX_HALF;
|
||
|
Value32 |= GetPhyAdFlowCntrlSettings(pDevice);
|
||
|
|
||
|
LM_WritePhy(pDevice, PHY_AN_AD_REG, Value32);
|
||
|
pDevice->advertising = Value32;
|
||
|
|
||
|
/* Advertise 1000Mbps */
|
||
|
Value32 = BCM540X_AN_AD_1000BASET_HALF | BCM540X_AN_AD_1000BASET_FULL;
|
||
|
|
||
|
#if INCLUDE_5701_AX_FIX
|
||
|
/* Bug: workaround for CRC error in gigabit mode when we are in */
|
||
|
/* slave mode. This will force the PHY to operate in */
|
||
|
/* master mode. */
|
||
|
if(pDevice->ChipRevId == T3_CHIP_ID_5701_A0 ||
|
||
|
pDevice->ChipRevId == T3_CHIP_ID_5701_B0)
|
||
|
{
|
||
|
Value32 |= BCM540X_CONFIG_AS_MASTER |
|
||
|
BCM540X_ENABLE_CONFIG_AS_MASTER;
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
LM_WritePhy(pDevice, BCM540X_1000BASET_CTRL_REG, Value32);
|
||
|
pDevice->advertising1000 = Value32;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
if(LineSpeed == LM_LINE_SPEED_1000MBPS)
|
||
|
{
|
||
|
Value32 = PHY_AN_AD_PROTOCOL_802_3_CSMA_CD;
|
||
|
Value32 |= GetPhyAdFlowCntrlSettings(pDevice);
|
||
|
|
||
|
LM_WritePhy(pDevice, PHY_AN_AD_REG, Value32);
|
||
|
pDevice->advertising = Value32;
|
||
|
|
||
|
if(DuplexMode != LM_DUPLEX_MODE_FULL)
|
||
|
{
|
||
|
Value32 = BCM540X_AN_AD_1000BASET_HALF;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
Value32 = BCM540X_AN_AD_1000BASET_FULL;
|
||
|
}
|
||
|
|
||
|
LM_WritePhy(pDevice, BCM540X_1000BASET_CTRL_REG, Value32);
|
||
|
pDevice->advertising1000 = Value32;
|
||
|
}
|
||
|
else if(LineSpeed == LM_LINE_SPEED_100MBPS)
|
||
|
{
|
||
|
LM_WritePhy(pDevice, BCM540X_1000BASET_CTRL_REG, 0);
|
||
|
pDevice->advertising1000 = 0;
|
||
|
|
||
|
if(DuplexMode != LM_DUPLEX_MODE_FULL)
|
||
|
{
|
||
|
Value32 = PHY_AN_AD_100BASETX_HALF;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
Value32 = PHY_AN_AD_100BASETX_FULL;
|
||
|
}
|
||
|
|
||
|
Value32 |= PHY_AN_AD_PROTOCOL_802_3_CSMA_CD;
|
||
|
Value32 |= GetPhyAdFlowCntrlSettings(pDevice);
|
||
|
|
||
|
LM_WritePhy(pDevice, PHY_AN_AD_REG, Value32);
|
||
|
pDevice->advertising = Value32;
|
||
|
}
|
||
|
else if(LineSpeed == LM_LINE_SPEED_10MBPS)
|
||
|
{
|
||
|
LM_WritePhy(pDevice, BCM540X_1000BASET_CTRL_REG, 0);
|
||
|
pDevice->advertising1000 = 0;
|
||
|
|
||
|
if(DuplexMode != LM_DUPLEX_MODE_FULL)
|
||
|
{
|
||
|
Value32 = PHY_AN_AD_10BASET_HALF;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
Value32 = PHY_AN_AD_10BASET_FULL;
|
||
|
}
|
||
|
|
||
|
Value32 |= PHY_AN_AD_PROTOCOL_802_3_CSMA_CD;
|
||
|
Value32 |= GetPhyAdFlowCntrlSettings(pDevice);
|
||
|
|
||
|
LM_WritePhy(pDevice, PHY_AN_AD_REG, Value32);
|
||
|
pDevice->advertising = Value32;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Force line speed if auto-negotiation is disabled. */
|
||
|
if(pDevice->DisableAutoNeg && LineSpeed != LM_LINE_SPEED_UNKNOWN)
|
||
|
{
|
||
|
/* This code path is executed only when there is link. */
|
||
|
pDevice->MediaType = MediaType;
|
||
|
pDevice->LineSpeed = LineSpeed;
|
||
|
pDevice->DuplexMode = DuplexMode;
|
||
|
|
||
|
/* Force line seepd. */
|
||
|
NewPhyCtrl = 0;
|
||
|
switch(LineSpeed)
|
||
|
{
|
||
|
case LM_LINE_SPEED_10MBPS:
|
||
|
NewPhyCtrl |= PHY_CTRL_SPEED_SELECT_10MBPS;
|
||
|
break;
|
||
|
case LM_LINE_SPEED_100MBPS:
|
||
|
NewPhyCtrl |= PHY_CTRL_SPEED_SELECT_100MBPS;
|
||
|
break;
|
||
|
case LM_LINE_SPEED_1000MBPS:
|
||
|
NewPhyCtrl |= PHY_CTRL_SPEED_SELECT_1000MBPS;
|
||
|
break;
|
||
|
default:
|
||
|
NewPhyCtrl |= PHY_CTRL_SPEED_SELECT_1000MBPS;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
if(DuplexMode == LM_DUPLEX_MODE_FULL)
|
||
|
{
|
||
|
NewPhyCtrl |= PHY_CTRL_FULL_DUPLEX_MODE;
|
||
|
}
|
||
|
|
||
|
/* Don't do anything if the PHY_CTRL is already what we wanted. */
|
||
|
LM_ReadPhy(pDevice, PHY_CTRL_REG, &Value32);
|
||
|
if(Value32 != NewPhyCtrl)
|
||
|
{
|
||
|
/* Temporary bring the link down before forcing line speed. */
|
||
|
LM_WritePhy(pDevice, PHY_CTRL_REG, PHY_CTRL_LOOPBACK_MODE);
|
||
|
|
||
|
/* Wait for link to go down. */
|
||
|
for(Cnt = 0; Cnt < 15000; Cnt++)
|
||
|
{
|
||
|
MM_Wait(10);
|
||
|
|
||
|
LM_ReadPhy(pDevice, PHY_STATUS_REG, &Value32);
|
||
|
LM_ReadPhy(pDevice, PHY_STATUS_REG, &Value32);
|
||
|
|
||
|
if(!(Value32 & PHY_STATUS_LINK_PASS))
|
||
|
{
|
||
|
MM_Wait(40);
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
LM_WritePhy(pDevice, PHY_CTRL_REG, NewPhyCtrl);
|
||
|
MM_Wait(40);
|
||
|
}
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
LM_WritePhy(pDevice, PHY_CTRL_REG, PHY_CTRL_AUTO_NEG_ENABLE |
|
||
|
PHY_CTRL_RESTART_AUTO_NEG);
|
||
|
}
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
} /* LM_ForceAutoNegBcm540xPhy */
|
||
|
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
static LM_STATUS
|
||
|
LM_ForceAutoNeg(
|
||
|
PLM_DEVICE_BLOCK pDevice,
|
||
|
LM_REQUESTED_MEDIA_TYPE RequestedMediaType)
|
||
|
{
|
||
|
LM_STATUS LmStatus;
|
||
|
|
||
|
/* Initialize the phy chip. */
|
||
|
switch(pDevice->PhyId & PHY_ID_MASK)
|
||
|
{
|
||
|
case PHY_BCM5400_PHY_ID:
|
||
|
case PHY_BCM5401_PHY_ID:
|
||
|
case PHY_BCM5411_PHY_ID:
|
||
|
case PHY_BCM5701_PHY_ID:
|
||
|
case PHY_BCM5703_PHY_ID:
|
||
|
case PHY_BCM5704_PHY_ID:
|
||
|
LmStatus = LM_ForceAutoNegBcm540xPhy(pDevice, RequestedMediaType);
|
||
|
break;
|
||
|
|
||
|
default:
|
||
|
LmStatus = LM_STATUS_FAILURE;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
return LmStatus;
|
||
|
} /* LM_ForceAutoNeg */
|
||
|
|
||
|
/******************************************************************************/
|
||
|
/* Description: */
|
||
|
/* */
|
||
|
/* Return: */
|
||
|
/******************************************************************************/
|
||
|
LM_STATUS LM_LoadFirmware(PLM_DEVICE_BLOCK pDevice,
|
||
|
PT3_FWIMG_INFO pFwImg,
|
||
|
LM_UINT32 LoadCpu,
|
||
|
LM_UINT32 StartCpu)
|
||
|
{
|
||
|
LM_UINT32 i;
|
||
|
LM_UINT32 address;
|
||
|
|
||
|
if (LoadCpu & T3_RX_CPU_ID)
|
||
|
{
|
||
|
if (LM_HaltCpu(pDevice,T3_RX_CPU_ID) != LM_STATUS_SUCCESS)
|
||
|
{
|
||
|
return LM_STATUS_FAILURE;
|
||
|
}
|
||
|
|
||
|
/* First of all clear scrach pad memory */
|
||
|
for (i = 0; i < T3_RX_CPU_SPAD_SIZE; i+=4)
|
||
|
{
|
||
|
LM_RegWrInd(pDevice,T3_RX_CPU_SPAD_ADDR+i,0);
|
||
|
}
|
||
|
|
||
|
/* Copy code first */
|
||
|
address = T3_RX_CPU_SPAD_ADDR + (pFwImg->Text.Offset & 0xffff);
|
||
|
for (i = 0; i <= pFwImg->Text.Length; i+=4)
|
||
|
{
|
||
|
LM_RegWrInd(pDevice,address+i,
|
||
|
((LM_UINT32 *)pFwImg->Text.Buffer)[i/4]);
|
||
|
}
|
||
|
|
||
|
address = T3_RX_CPU_SPAD_ADDR + (pFwImg->ROnlyData.Offset & 0xffff);
|
||
|
for (i = 0; i <= pFwImg->ROnlyData.Length; i+=4)
|
||
|
{
|
||
|
LM_RegWrInd(pDevice,address+i,
|
||
|
((LM_UINT32 *)pFwImg->ROnlyData.Buffer)[i/4]);
|
||
|
}
|
||
|
|
||
|
address = T3_RX_CPU_SPAD_ADDR + (pFwImg->Data.Offset & 0xffff);
|
||
|
for (i= 0; i <= pFwImg->Data.Length; i+=4)
|
||
|
{
|
||
|
LM_RegWrInd(pDevice,address+i,
|
||
|
((LM_UINT32 *)pFwImg->Data.Buffer)[i/4]);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if (LoadCpu & T3_TX_CPU_ID)
|
||
|
{
|
||
|
if (LM_HaltCpu(pDevice,T3_TX_CPU_ID) != LM_STATUS_SUCCESS)
|
||
|
{
|
||
|
return LM_STATUS_FAILURE;
|
||
|
}
|
||
|
|
||
|
/* First of all clear scrach pad memory */
|
||
|
for (i = 0; i < T3_TX_CPU_SPAD_SIZE; i+=4)
|
||
|
{
|
||
|
LM_RegWrInd(pDevice,T3_TX_CPU_SPAD_ADDR+i,0);
|
||
|
}
|
||
|
|
||
|
/* Copy code first */
|
||
|
address = T3_TX_CPU_SPAD_ADDR + (pFwImg->Text.Offset & 0xffff);
|
||
|
for (i= 0; i <= pFwImg->Text.Length; i+=4)
|
||
|
{
|
||
|
LM_RegWrInd(pDevice,address+i,
|
||
|
((LM_UINT32 *)pFwImg->Text.Buffer)[i/4]);
|
||
|
}
|
||
|
|
||
|
address = T3_TX_CPU_SPAD_ADDR + (pFwImg->ROnlyData.Offset & 0xffff);
|
||
|
for (i= 0; i <= pFwImg->ROnlyData.Length; i+=4)
|
||
|
{
|
||
|
LM_RegWrInd(pDevice,address+i,
|
||
|
((LM_UINT32 *)pFwImg->ROnlyData.Buffer)[i/4]);
|
||
|
}
|
||
|
|
||
|
address = T3_TX_CPU_SPAD_ADDR + (pFwImg->Data.Offset & 0xffff);
|
||
|
for (i= 0; i <= pFwImg->Data.Length; i+=4)
|
||
|
{
|
||
|
LM_RegWrInd(pDevice,address+i,
|
||
|
((LM_UINT32 *)pFwImg->Data.Buffer)[i/4]);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if (StartCpu & T3_RX_CPU_ID)
|
||
|
{
|
||
|
/* Start Rx CPU */
|
||
|
REG_WR(pDevice,rxCpu.reg.state, 0xffffffff);
|
||
|
REG_WR(pDevice,rxCpu.reg.PC,pFwImg->StartAddress);
|
||
|
for (i = 0 ; i < 5; i++)
|
||
|
{
|
||
|
if (pFwImg->StartAddress == REG_RD(pDevice,rxCpu.reg.PC))
|
||
|
break;
|
||
|
|
||
|
REG_WR(pDevice,rxCpu.reg.state, 0xffffffff);
|
||
|
REG_WR(pDevice,rxCpu.reg.mode,CPU_MODE_HALT);
|
||
|
REG_WR(pDevice,rxCpu.reg.PC,pFwImg->StartAddress);
|
||
|
MM_Wait(1000);
|
||
|
}
|
||
|
|
||
|
REG_WR(pDevice,rxCpu.reg.state, 0xffffffff);
|
||
|
REG_WR(pDevice,rxCpu.reg.mode, 0);
|
||
|
}
|
||
|
|
||
|
if (StartCpu & T3_TX_CPU_ID)
|
||
|
{
|
||
|
/* Start Tx CPU */
|
||
|
REG_WR(pDevice,txCpu.reg.state, 0xffffffff);
|
||
|
REG_WR(pDevice,txCpu.reg.PC,pFwImg->StartAddress);
|
||
|
for (i = 0 ; i < 5; i++)
|
||
|
{
|
||
|
if (pFwImg->StartAddress == REG_RD(pDevice,txCpu.reg.PC))
|
||
|
break;
|
||
|
|
||
|
REG_WR(pDevice,txCpu.reg.state, 0xffffffff);
|
||
|
REG_WR(pDevice,txCpu.reg.mode,CPU_MODE_HALT);
|
||
|
REG_WR(pDevice,txCpu.reg.PC,pFwImg->StartAddress);
|
||
|
MM_Wait(1000);
|
||
|
}
|
||
|
|
||
|
REG_WR(pDevice,txCpu.reg.state, 0xffffffff);
|
||
|
REG_WR(pDevice,txCpu.reg.mode, 0);
|
||
|
}
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
}
|
||
|
|
||
|
STATIC LM_STATUS LM_HaltCpu(PLM_DEVICE_BLOCK pDevice,LM_UINT32 cpu_number)
|
||
|
{
|
||
|
LM_UINT32 i;
|
||
|
|
||
|
if (cpu_number == T3_RX_CPU_ID)
|
||
|
{
|
||
|
for (i = 0 ; i < 10000; i++)
|
||
|
{
|
||
|
REG_WR(pDevice,rxCpu.reg.state, 0xffffffff);
|
||
|
REG_WR(pDevice,rxCpu.reg.mode,CPU_MODE_HALT);
|
||
|
|
||
|
if (REG_RD(pDevice,rxCpu.reg.mode) & CPU_MODE_HALT)
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
REG_WR(pDevice,rxCpu.reg.state, 0xffffffff);
|
||
|
REG_WR(pDevice,rxCpu.reg.mode,CPU_MODE_HALT);
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
for (i = 0 ; i < 10000; i++)
|
||
|
{
|
||
|
REG_WR(pDevice,txCpu.reg.state, 0xffffffff);
|
||
|
REG_WR(pDevice,txCpu.reg.mode,CPU_MODE_HALT);
|
||
|
|
||
|
if (REG_RD(pDevice,txCpu.reg.mode) & CPU_MODE_HALT)
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
return (( i == 10000) ? LM_STATUS_FAILURE : LM_STATUS_SUCCESS);
|
||
|
}
|
||
|
|
||
|
|
||
|
int
|
||
|
LM_BlinkLED(PLM_DEVICE_BLOCK pDevice, LM_UINT32 BlinkDurationSec)
|
||
|
{
|
||
|
LM_UINT32 Oldcfg;
|
||
|
int j;
|
||
|
int ret = 0;
|
||
|
|
||
|
if(BlinkDurationSec == 0)
|
||
|
{
|
||
|
return 0;
|
||
|
}
|
||
|
if(BlinkDurationSec > 120)
|
||
|
{
|
||
|
BlinkDurationSec = 120;
|
||
|
}
|
||
|
|
||
|
Oldcfg = REG_RD(pDevice, MacCtrl.LedCtrl);
|
||
|
for(j = 0; j < BlinkDurationSec * 2; j++)
|
||
|
{
|
||
|
if(j % 2)
|
||
|
{
|
||
|
/* Turn on the LEDs. */
|
||
|
REG_WR(pDevice, MacCtrl.LedCtrl,
|
||
|
LED_CTRL_OVERRIDE_LINK_LED |
|
||
|
LED_CTRL_1000MBPS_LED_ON |
|
||
|
LED_CTRL_100MBPS_LED_ON |
|
||
|
LED_CTRL_10MBPS_LED_ON |
|
||
|
LED_CTRL_OVERRIDE_TRAFFIC_LED |
|
||
|
LED_CTRL_BLINK_TRAFFIC_LED |
|
||
|
LED_CTRL_TRAFFIC_LED);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
/* Turn off the LEDs. */
|
||
|
REG_WR(pDevice, MacCtrl.LedCtrl,
|
||
|
LED_CTRL_OVERRIDE_LINK_LED |
|
||
|
LED_CTRL_OVERRIDE_TRAFFIC_LED);
|
||
|
}
|
||
|
|
||
|
#ifndef EMBEDDED
|
||
|
current->state = TASK_INTERRUPTIBLE;
|
||
|
if (schedule_timeout(HZ/2) != 0) {
|
||
|
ret = -EINTR;
|
||
|
break;
|
||
|
}
|
||
|
#else
|
||
|
udelay(100000); /* 1s sleep */
|
||
|
#endif
|
||
|
}
|
||
|
REG_WR(pDevice, MacCtrl.LedCtrl, Oldcfg);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
int t3_do_dma(PLM_DEVICE_BLOCK pDevice,
|
||
|
LM_PHYSICAL_ADDRESS host_addr_phy, int length,
|
||
|
int dma_read)
|
||
|
{
|
||
|
T3_DMA_DESC dma_desc;
|
||
|
int i;
|
||
|
LM_UINT32 dma_desc_addr;
|
||
|
LM_UINT32 value32;
|
||
|
|
||
|
REG_WR(pDevice, BufMgr.Mode, 0);
|
||
|
REG_WR(pDevice, Ftq.Reset, 0);
|
||
|
|
||
|
dma_desc.host_addr.High = host_addr_phy.High;
|
||
|
dma_desc.host_addr.Low = host_addr_phy.Low;
|
||
|
dma_desc.nic_mbuf = 0x2100;
|
||
|
dma_desc.len = length;
|
||
|
dma_desc.flags = 0x00000004; /* Generate Rx-CPU event */
|
||
|
|
||
|
if (dma_read)
|
||
|
{
|
||
|
dma_desc.cqid_sqid = (T3_QID_RX_BD_COMP << 8) |
|
||
|
T3_QID_DMA_HIGH_PRI_READ;
|
||
|
REG_WR(pDevice, DmaRead.Mode, DMA_READ_MODE_ENABLE);
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
dma_desc.cqid_sqid = (T3_QID_RX_DATA_COMP << 8) |
|
||
|
T3_QID_DMA_HIGH_PRI_WRITE;
|
||
|
REG_WR(pDevice, DmaWrite.Mode, DMA_WRITE_MODE_ENABLE);
|
||
|
}
|
||
|
|
||
|
dma_desc_addr = T3_NIC_DMA_DESC_POOL_ADDR;
|
||
|
|
||
|
/* Writing this DMA descriptor to DMA memory */
|
||
|
for (i = 0; i < sizeof(T3_DMA_DESC); i += 4)
|
||
|
{
|
||
|
value32 = *((PLM_UINT32) (((PLM_UINT8) &dma_desc) + i));
|
||
|
MM_WriteConfig32(pDevice, T3_PCI_MEM_WIN_ADDR_REG, dma_desc_addr+i);
|
||
|
MM_WriteConfig32(pDevice, T3_PCI_MEM_WIN_DATA_REG, cpu_to_le32(value32));
|
||
|
}
|
||
|
MM_WriteConfig32(pDevice, T3_PCI_MEM_WIN_ADDR_REG, 0);
|
||
|
|
||
|
if (dma_read)
|
||
|
REG_WR(pDevice, Ftq.DmaHighReadFtqFifoEnqueueDequeue, dma_desc_addr);
|
||
|
else
|
||
|
REG_WR(pDevice, Ftq.DmaHighWriteFtqFifoEnqueueDequeue, dma_desc_addr);
|
||
|
|
||
|
for (i = 0; i < 40; i++)
|
||
|
{
|
||
|
if (dma_read)
|
||
|
value32 = REG_RD(pDevice, Ftq.RcvBdCompFtqFifoEnqueueDequeue);
|
||
|
else
|
||
|
value32 = REG_RD(pDevice, Ftq.RcvDataCompFtqFifoEnqueueDequeue);
|
||
|
|
||
|
if ((value32 & 0xffff) == dma_desc_addr)
|
||
|
break;
|
||
|
|
||
|
MM_Wait(10);
|
||
|
}
|
||
|
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
}
|
||
|
|
||
|
STATIC LM_STATUS
|
||
|
LM_DmaTest(PLM_DEVICE_BLOCK pDevice, PLM_UINT8 pBufferVirt,
|
||
|
LM_PHYSICAL_ADDRESS BufferPhy, LM_UINT32 BufferSize)
|
||
|
{
|
||
|
int j;
|
||
|
LM_UINT32 *ptr;
|
||
|
int dma_success = 0;
|
||
|
|
||
|
if(T3_ASIC_REV(pDevice->ChipRevId) != T3_ASIC_REV_5700 &&
|
||
|
T3_ASIC_REV(pDevice->ChipRevId) != T3_ASIC_REV_5701)
|
||
|
{
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
}
|
||
|
while (!dma_success)
|
||
|
{
|
||
|
/* Fill data with incremental patterns */
|
||
|
ptr = (LM_UINT32 *)pBufferVirt;
|
||
|
for (j = 0; j < BufferSize/4; j++)
|
||
|
*ptr++ = j;
|
||
|
|
||
|
if (t3_do_dma(pDevice,BufferPhy,BufferSize, 1) == LM_STATUS_FAILURE)
|
||
|
{
|
||
|
return LM_STATUS_FAILURE;
|
||
|
}
|
||
|
|
||
|
MM_Wait(40);
|
||
|
ptr = (LM_UINT32 *)pBufferVirt;
|
||
|
/* Fill data with zero */
|
||
|
for (j = 0; j < BufferSize/4; j++)
|
||
|
*ptr++ = 0;
|
||
|
|
||
|
if (t3_do_dma(pDevice,BufferPhy,BufferSize, 0) == LM_STATUS_FAILURE)
|
||
|
{
|
||
|
return LM_STATUS_FAILURE;
|
||
|
}
|
||
|
|
||
|
MM_Wait(40);
|
||
|
/* Check for data */
|
||
|
ptr = (LM_UINT32 *)pBufferVirt;
|
||
|
for (j = 0; j < BufferSize/4; j++)
|
||
|
{
|
||
|
if (*ptr++ != j)
|
||
|
{
|
||
|
if ((pDevice->DmaReadWriteCtrl & DMA_CTRL_WRITE_BOUNDARY_MASK)
|
||
|
== DMA_CTRL_WRITE_BOUNDARY_DISABLE)
|
||
|
{
|
||
|
pDevice->DmaReadWriteCtrl = (pDevice->DmaReadWriteCtrl &
|
||
|
~DMA_CTRL_WRITE_BOUNDARY_MASK) |
|
||
|
DMA_CTRL_WRITE_BOUNDARY_16;
|
||
|
REG_WR(pDevice, PciCfg.DmaReadWriteCtrl,
|
||
|
pDevice->DmaReadWriteCtrl);
|
||
|
break;
|
||
|
}
|
||
|
else
|
||
|
{
|
||
|
return LM_STATUS_FAILURE;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
if (j == (BufferSize/4))
|
||
|
dma_success = 1;
|
||
|
}
|
||
|
return LM_STATUS_SUCCESS;
|
||
|
}
|
||
|
#endif /* CFG_CMD_NET, !CONFIG_NET_MULTI, CONFIG_TIGON3 */
|