diff options
| author | Jean-Christophe PLAGNIOL-VILLARD <plagnioj@jcrosoft.com> | 2007-11-21 21:19:24 +0100 | 
|---|---|---|
| committer | Jean-Christophe PLAGNIOL-VILLARD <plagnioj@jcrosoft.com> | 2007-11-25 18:35:17 +0100 | 
| commit | 2439e4bfa111babf4bc07ba20efbf3e36036813e (patch) | |
| tree | 21e94282acdc681bdde2ccc270bd401254124d00 /drivers/net/tigon3.c | |
| parent | 352d259130b349fe9593b8dada641bd78a9659e5 (diff) | |
| download | olio-uboot-2014.01-2439e4bfa111babf4bc07ba20efbf3e36036813e.tar.xz olio-uboot-2014.01-2439e4bfa111babf4bc07ba20efbf3e36036813e.zip | |
drivers/net : move net drivers to drivers/net
Signed-off-by: Jean-Christophe PLAGNIOL-VILLARD <plagnioj@jcrosoft.com>
Diffstat (limited to 'drivers/net/tigon3.c')
| -rw-r--r-- | drivers/net/tigon3.c | 5699 | 
1 files changed, 5699 insertions, 0 deletions
| diff --git a/drivers/net/tigon3.c b/drivers/net/tigon3.c new file mode 100644 index 000000000..5f6a4ecd0 --- /dev/null +++ b/drivers/net/tigon3.c @@ -0,0 +1,5699 @@ +/******************************************************************************/ +/*                                                                            */ +/* 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 defined(CONFIG_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 |