| /******************************************************************************/ | |
| /* */ | |
| /* 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> | |
| #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; | |
| } |