unsigned configure_IEEE_phy_speed_emaclite(XEmacLite *xemaclitep, unsigned speed) { u16 control; u16 status; u16 phylinkspeed; u32 phy_addr = detect_phy_emaclite(xemaclitep); XEmacLite_PhyRead(xemaclitep, phy_addr, IEEE_CONTROL_REG_OFFSET, &control); control &= ~IEEE_CTRL_LINKSPEED_100M; control &= ~IEEE_CTRL_LINKSPEED_10M; if (speed == 100) { control |= IEEE_CTRL_LINKSPEED_100M; /* Dont advertise PHY speed of 1000 Mbps */ XEmacLite_PhyWrite(xemaclitep, phy_addr, IEEE_1000_ADVERTISE_REG_OFFSET, 0); /* Dont advertise PHY speed of 10 Mbps */ XEmacLite_PhyWrite(xemaclitep, phy_addr, IEEE_AUTONEGO_ADVERTISE_REG, ADVERTISE_100); } else if (speed == 10) { control |= IEEE_CTRL_LINKSPEED_10M; /* Dont advertise PHY speed of 1000 Mbps */ XEmacLite_PhyWrite(xemaclitep, phy_addr, IEEE_1000_ADVERTISE_REG_OFFSET, 0); /* Dont advertise PHY speed of 100 Mbps */ XEmacLite_PhyWrite(xemaclitep, phy_addr, IEEE_AUTONEGO_ADVERTISE_REG, ADVERTISE_10); } XEmacLite_PhyWrite(xemaclitep, phy_addr, IEEE_CONTROL_REG_OFFSET, control | IEEE_CTRL_RESET_MASK); { volatile int wait; for (wait=0; wait < 100000; wait++); for (wait=0; wait < 100000; wait++); } return 0; }
static int detect_phy_emaclite(XEmacLite *xemaclitep) { u16 phy_reg; u32 phy_addr; for (phy_addr = 31; phy_addr > 0; phy_addr--) { XEmacLite_PhyRead(xemaclitep, phy_addr, PHY_DETECT_REG, &phy_reg); if ((phy_reg != 0xFFFF) && ((phy_reg & PHY_DETECT_MASK) == PHY_DETECT_MASK)) { /* Found a valid PHY address */ LWIP_DEBUGF(NETIF_DEBUG, ("XEMacLite detect_phy: PHY detected at address %d.\r\n", phy_addr)); LWIP_DEBUGF(NETIF_DEBUG, ("XEMacLite detect_phy: PHY detected.\r\n")); return phy_addr; } } LWIP_DEBUGF(NETIF_DEBUG, ("XEMacLite detect_phy: No PHY detected. Assuming a PHY at address 0\r\n")); /* default to zero */ return 0; }
static int ael2005_read (struct nf10_card *card, uint32_t PhyAddr, uint32_t PhyDev, uint16_t address, uint16_t *data){ XEmacLite_PhyWrite(card, PhyAddr, PhyDev, XEL_MDIO_OP_45_ADDRESS, XEL_MDIO_CLAUSE_45, address); XEmacLite_PhyRead(card, PhyAddr, PhyDev, XEL_MDIO_OP_45_READ, XEL_MDIO_CLAUSE_45, data); ael2005_sleep(5); return 0; }
unsigned get_IEEE_phy_speed_emaclite(XEmacLite *xemaclitep) { u16 control; u16 status; u16 partner_capabilities; u16 partner_capabilities_1000; u16 phylinkspeed; u32 phy_addr = detect_phy_emaclite(xemaclitep); const TickType_t xSmallDelay = pdMS_TO_TICKS( 200UL ); /* Dont advertise PHY speed of 1000 Mbps */ XEmacLite_PhyWrite(xemaclitep, phy_addr, IEEE_1000_ADVERTISE_REG_OFFSET, 0); /* Advertise PHY speed of 100 and 10 Mbps */ XEmacLite_PhyWrite(xemaclitep, phy_addr, IEEE_AUTONEGO_ADVERTISE_REG, ADVERTISE_100_AND_10); XEmacLite_PhyRead(xemaclitep, phy_addr, IEEE_CONTROL_REG_OFFSET, &control); control |= (IEEE_CTRL_AUTONEGOTIATE_ENABLE | IEEE_STAT_AUTONEGOTIATE_RESTART); XEmacLite_PhyWrite(xemaclitep, phy_addr, IEEE_CONTROL_REG_OFFSET, control); /* Read PHY control and status registers is successful. */ XEmacLite_PhyRead(xemaclitep, phy_addr, IEEE_CONTROL_REG_OFFSET, &control); XEmacLite_PhyRead(xemaclitep, phy_addr, IEEE_STATUS_REG_OFFSET, &status); if ((control & IEEE_CTRL_AUTONEGOTIATE_ENABLE) && (status & IEEE_STAT_AUTONEGOTIATE_CAPABLE)) { while ( !(status & IEEE_STAT_AUTONEGOTIATE_COMPLETE) ) { #if !NO_SYS vTaskDelay( xSmallDelay ); #endif XEmacLite_PhyRead(xemaclitep, phy_addr, IEEE_STATUS_REG_OFFSET, &status); } XEmacLite_PhyRead(xemaclitep, phy_addr, IEEE_PARTNER_ABILITIES_1_REG_OFFSET, &partner_capabilities); if (status & IEEE_STAT_1GBPS_EXTENSIONS) { XEmacLite_PhyRead(xemaclitep, phy_addr, IEEE_PARTNER_ABILITIES_3_REG_OFFSET, &partner_capabilities_1000); if (partner_capabilities_1000 & IEEE_AN3_ABILITY_MASK_1GBPS) return 1000; } if (partner_capabilities & IEEE_AN1_ABILITY_MASK_100MBPS) return 100; if (partner_capabilities & IEEE_AN1_ABILITY_MASK_10MBPS) return 10; xil_printf("%s: unknown PHY link speed, setting TEMAC speed to be 10 Mbps\r\n", __FUNCTION__); return 10; } else { /* Update TEMAC speed accordingly */ if (status & IEEE_STAT_1GBPS_EXTENSIONS) { /* Get commanded link speed */ phylinkspeed = control & IEEE_CTRL_1GBPS_LINKSPEED_MASK; switch (phylinkspeed) { case (IEEE_CTRL_LINKSPEED_1000M): return 1000; case (IEEE_CTRL_LINKSPEED_100M): return 100; case (IEEE_CTRL_LINKSPEED_10M): return 10; default: xil_printf("%s: unknown PHY link speed (%d), setting TEMAC speed to be 10 Mbps\r\n", __FUNCTION__, phylinkspeed); return 10; } } else { return (control & IEEE_CTRL_LINKSPEED_MASK) ? 100 : 10; } } }