void ksz8041Tick(NetInterface *interface) { //No external interrupt line driver? if(interface->extIntDriver == NULL) { uint16_t value; bool_t linkState; //Read basic status register value = ksz8041ReadPhyReg(interface, KSZ8041_PHY_REG_BMSR); //Retrieve current link state linkState = (value & BMSR_LINK_STATUS) ? TRUE : FALSE; //Link up event? if(linkState && !interface->linkState) { //A PHY event is pending... interface->phyEvent = TRUE; //Notify the user that the link state has changed osSetEvent(&interface->nicRxEvent); } //Link down event? else if(!linkState && interface->linkState) { //A PHY event is pending... interface->phyEvent = TRUE; //Notify the user that the link state has changed osSetEvent(&interface->nicRxEvent); } } }
void ksz8041Tick(NetInterface *interface) { uint16_t value; bool_t linkState; //No external interrupt line driver? if(interface->extIntDriver == NULL) { //Read basic status register value = ksz8041ReadPhyReg(interface, KSZ8041_PHY_REG_BMSR); //Retrieve current link state linkState = (value & BMSR_LINK_STATUS) ? TRUE : FALSE; //Link up event? if(linkState && !interface->linkState) { //Set event flag interface->phyEvent = TRUE; //Notify the TCP/IP stack of the event osSetEvent(&netEvent); } //Link down event? else if(!linkState && interface->linkState) { //Set event flag interface->phyEvent = TRUE; //Notify the TCP/IP stack of the event osSetEvent(&netEvent); } } }
error_t ksz8041Init(NetInterface *interface) { //Debug message TRACE_INFO("Initializing KSZ8041...\r\n"); //Initialize external interrupt line driver if(interface->extIntDriver != NULL) interface->extIntDriver->init(); //Reset PHY transceiver ksz8041WritePhyReg(interface, KSZ8041_PHY_REG_BMCR, BMCR_RESET); //Wait for the reset to complete while(ksz8041ReadPhyReg(interface, KSZ8041_PHY_REG_BMCR) & BMCR_RESET); //Dump PHY registers for debugging purpose ksz8041DumpPhyReg(interface); //The PHY will generate interrupts when link status changes are detected ksz8041WritePhyReg(interface, KSZ8041_PHY_REG_ICSR, ICSR_LINK_DOWN_IE | ICSR_LINK_UP_IE); //Force the TCP/IP stack to poll the link state at startup interface->phyEvent = TRUE; //Notify the TCP/IP stack of the event osSetEvent(&netEvent); //Successful initialization return NO_ERROR; }
void ksz8041DumpPhyReg(NetInterface *interface) { uint8_t i; //Loop through PHY registers for(i = 0; i < 32; i++) { //Display current PHY register TRACE_DEBUG("%02" PRIu8 ": 0x%04" PRIX16 "\r\n", i, ksz8041ReadPhyReg(interface, i)); } //Terminate with a line feed TRACE_DEBUG("\r\n"); }
bool_t ksz8041EventHandler(NetInterface *interface) { uint16_t value; //Read status register to acknowledge the interrupt value = ksz8041ReadPhyReg(interface, KSZ8041_PHY_REG_ICSR); //Link status change? if(value & (ICSR_LINK_DOWN_IF | ICSR_LINK_UP_IF)) { //Read basic status register value = ksz8041ReadPhyReg(interface, KSZ8041_PHY_REG_BMSR); //Link is up? if(value & BMSR_LINK_STATUS) { //Read PHY control register value = ksz8041ReadPhyReg(interface, KSZ8041_PHY_REG_PHYCON2); //Check current operation mode switch(value & PHYCON2_OP_MODE_MASK) { //10BASE-T case PHYCON2_OP_MODE_10BT: interface->speed100 = FALSE; interface->fullDuplex = FALSE; break; //10BASE-T full-duplex case PHYCON2_OP_MODE_10BT_FD: interface->speed100 = FALSE; interface->fullDuplex = TRUE; break; //100BASE-TX case PHYCON2_OP_MODE_100BTX: interface->speed100 = TRUE; interface->fullDuplex = FALSE; break; //100BASE-TX full-duplex case PHYCON2_OP_MODE_100BTX_FD: interface->speed100 = TRUE; interface->fullDuplex = TRUE; break; //Unknown operation mode default: //Debug message TRACE_WARNING("Invalid Duplex mode\r\n"); break; } //Update link state interface->linkState = TRUE; //Display link state TRACE_INFO("Link is up (%s)...\r\n", interface->name); //Display actual speed and duplex mode TRACE_INFO("%s %s\r\n", interface->speed100 ? "100BASE-TX" : "10BASE-T", interface->fullDuplex ? "Full-Duplex" : "Half-Duplex"); } else { //Update link state interface->linkState = FALSE; //Display link state TRACE_INFO("Link is down (%s)...\r\n", interface->name); } //Notify the user that the link state has changed return TRUE; } else { //No link state change... return FALSE; } }
void ksz8041EventHandler(NetInterface *interface) { uint16_t value; //Read status register to acknowledge the interrupt value = ksz8041ReadPhyReg(interface, KSZ8041_PHY_REG_ICSR); //Link status change? if(value & (ICSR_LINK_DOWN_IF | ICSR_LINK_UP_IF)) { //Any link failure condition is latched in the BMSR register... Reading //the register twice will always return the actual link status value = ksz8041ReadPhyReg(interface, KSZ8041_PHY_REG_BMSR); value = ksz8041ReadPhyReg(interface, KSZ8041_PHY_REG_BMSR); //Link is up? if(value & BMSR_LINK_STATUS) { //Read PHY control register value = ksz8041ReadPhyReg(interface, KSZ8041_PHY_REG_PHYCON2); //Check current operation mode switch(value & PHYCON2_OP_MODE_MASK) { //10BASE-T case PHYCON2_OP_MODE_10BT: interface->linkSpeed = NIC_LINK_SPEED_10MBPS; interface->duplexMode = NIC_HALF_DUPLEX_MODE; break; //10BASE-T full-duplex case PHYCON2_OP_MODE_10BT_FD: interface->linkSpeed = NIC_LINK_SPEED_10MBPS; interface->duplexMode = NIC_FULL_DUPLEX_MODE; break; //100BASE-TX case PHYCON2_OP_MODE_100BTX: interface->linkSpeed = NIC_LINK_SPEED_100MBPS; interface->duplexMode = NIC_HALF_DUPLEX_MODE; break; //100BASE-TX full-duplex case PHYCON2_OP_MODE_100BTX_FD: interface->linkSpeed = NIC_LINK_SPEED_100MBPS; interface->duplexMode = NIC_FULL_DUPLEX_MODE; break; //Unknown operation mode default: //Debug message TRACE_WARNING("Invalid Duplex mode\r\n"); break; } //Update link state interface->linkState = TRUE; //Adjust MAC configuration parameters for proper operation interface->nicDriver->updateMacConfig(interface); } else { //Update link state interface->linkState = FALSE; } //Process link state change event nicNotifyLinkChange(interface); } }