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);
}
}
