|  | /******************************************************************************/ | 
|  | /*                                                                            */ | 
|  | /* 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 /* CFG_CMD_NET, !CONFIG_NET_MULTI, CONFIG_TIGON3 */ |