#include "UniNEnet.h"
#include "UniNEnetMII.h"
#include <libkern/OSByteOrder.h>
bool UniNEnet::miiReadWord( UInt16 *dataPtr, UInt16 reg, UInt8 phy )
{
UInt32 i;
UInt32 miiReg;
WRITE_REGISTER( MIFBitBangFrame_Output,
kMIFBitBangFrame_Output_ST_default
| kMIFBitBangFrame_Output_OP_read
| phy << kMIFBitBangFrame_Output_PHYAD_shift
| reg << kMIFBitBangFrame_Output_REGAD_shift
| kMIFBitBangFrame_Output_TA_MSB );
for (i=0; i < 20; i++ )
{
miiReg = READ_REGISTER( MIFBitBangFrame_Output );
if ( miiReg & kMIFBitBangFrame_Output_TA_LSB )
{
ELG( reg << 16 | phy, miiReg, 'miRW', "miiReadWord" );
*dataPtr = (UInt16) miiReg;
return true;
}
IODelay(10);
}
ELG( reg << 16 | phy, miiReg, 'miR-', "miiReadWord - failed" );
return false;
}
bool UniNEnet::miiWriteWord( UInt16 data, UInt16 reg, UInt8 phy )
{
UInt32 i;
UInt32 miiReg;
WRITE_REGISTER( MIFBitBangFrame_Output,
kMIFBitBangFrame_Output_ST_default
| kMIFBitBangFrame_Output_OP_write
| phy << kMIFBitBangFrame_Output_PHYAD_shift
| reg << kMIFBitBangFrame_Output_REGAD_shift
| kMIFBitBangFrame_Output_TA_MSB
| data );
for ( i=0; i < 20; i++ )
{
miiReg = READ_REGISTER( MIFBitBangFrame_Output );
if ( miiReg & kMIFBitBangFrame_Output_TA_LSB )
{
ELG( reg << 16 | phy, data, 'miWW', "miiWriteWord" );
return true;
}
IODelay(10);
}
ELG( reg << 16 | phy, data, 'miW-', "miiWriteWord - failed" );
return false;
}
bool UniNEnet::miiResetPHY( UInt8 phy )
{
int i = MII_RESET_TIMEOUT;
UInt16 mii_control;
ELG( i, phy, 'RstP', "miiResetPHY" );
miiWriteWord( MII_CONTROL_RESET, MII_CONTROL, phy );
IOSleep(MII_RESET_DELAY);
while ( i > 0 )
{
if ( miiReadWord( &mii_control, MII_CONTROL, phy) == false )
return false;
if (!(mii_control & MII_CONTROL_RESET))
{
miiReadWord( &mii_control, MII_CONTROL, phy);
mii_control &= ~MII_CONTROL_ISOLATE;
miiWriteWord( mii_control, MII_CONTROL, phy );
return true;
}
IOSleep(MII_RESET_DELAY);
i -= MII_RESET_DELAY;
}
return false;
}
bool UniNEnet::miiWaitForLink( UInt8 phy )
{
int i = MII_LINK_TIMEOUT;
unsigned short mii_status;
ELG( i, phy, 'miWL', "miiWaitForLink" );
while (i > 0)
{
if ( miiReadWord( &mii_status, MII_STATUS, phy ) == false)
return false;
if (mii_status & MII_STATUS_LINK_STATUS)
return true;
IOSleep(MII_LINK_DELAY);
i -= MII_LINK_DELAY;
}
return false;
}
bool UniNEnet::miiWaitForAutoNegotiation( UInt8 phy )
{
int i = MII_LINK_TIMEOUT;
unsigned short mii_status;
ELG( i, phy, 'miWA', "miiWaitForAutoNegotiation" );
while (i > 0)
{
if ( miiReadWord( &mii_status, MII_STATUS, phy ) == false)
return false;
if (mii_status & MII_STATUS_NEGOTIATION_COMPLETE)
return true;
IOSleep(MII_LINK_DELAY);
i -= MII_LINK_DELAY;
}
return false;
}
bool UniNEnet::miiFindPHY( UInt8 *phy )
{
int i;
UInt16 phyWord;
ELG( MII_MAX_PHY, *phy, 'miFP', "miiFindPHY" );
*phy = 0xFF;
for ( i = 0; i < MII_MAX_PHY; i++ )
{
if ( miiReadWord( &phyWord, MII_STATUS, i ) == false ) continue;
if ( miiReadWord( &fPHYControl, MII_CONTROL, i ) == false ) continue;
if ( phyWord == 0xFFFF && fPHYControl == 0xFFFF ) continue;
*phy = i;
return true;
}
return false;
}
bool UniNEnet::miiInitializePHY( UInt8 phy )
{
UInt16 phyWord;
ELG( fPHYType, phy, 'miIP', "miiInitializePHY" );
miiReadWord( &phyWord, MII_CONTROL, phy );
phyWord &= ~MII_CONTROL_AUTONEGOTIATION;
miiWriteWord( phyWord, MII_CONTROL, phy );
miiReadWord( &phyWord, MII_ADVERTISEMENT, phy );
phyWord |= MII_ANAR_100BASETX_FD | MII_ANAR_100BASETX
| MII_ANAR_10BASET_FD | MII_ANAR_10BASET
| MII_ANAR_PAUSE;
miiWriteWord( phyWord, MII_ADVERTISEMENT, phy );
miiReadWord( &phyWord, MII_CONTROL, phy );
phyWord |= MII_CONTROL_AUTONEGOTIATION;
miiWriteWord( phyWord, MII_CONTROL, phy );
miiReadWord( &phyWord, MII_CONTROL, phy );
phyWord |= MII_CONTROL_RESTART_NEGOTIATION;
miiWriteWord( phyWord, MII_CONTROL, phy );
#if 0
while ( 1 )
{
miiReadWord( &phyWord, MII_CONTROL, phy );
if ( (phyWord & MII_CONTROL_RESTART_NEGOTIATION) == 0 )
break;
}
#endif
return true;
}