#include "UniNEnet.h"
#include "UniNEnetMII.h"
bool UniNEnet::miiReadWord( UInt16 *dataPtr, UInt16 reg )
{
UInt32 i;
UInt32 miiReg;
if ( phyId == 0xFF )
{
ALRT( 0, phyId << 16 | reg, 'IdR-', "UniNEnet::miiReadWord - phyId not established yet." );
return false;
}
WRITE_REGISTER( MIFBitBangFrame_Output,
kMIFBitBangFrame_Output_ST_default
| kMIFBitBangFrame_Output_OP_read
| phyId << 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( miiReg, phyId << 16 | reg, 'miiR', "UniNEnet::miiReadWord" );
*dataPtr = (UInt16) miiReg;
return true;
}
IODelay( 10 );
}
ELG( miiReg, phyId << 16 | reg, 'miR-', "UniNEnet::miiReadWord - failed" );
return false;
}
bool UniNEnet::miiWriteWord( UInt16 data, UInt16 reg )
{
UInt32 i;
UInt32 miiReg;
if ( phyId == 0xFF )
{
ALRT( data, phyId << 16 | reg, 'IdW-', "UniNEnet::miiWriteWord - phyId not established yet." );
return false;
}
WRITE_REGISTER( MIFBitBangFrame_Output,
kMIFBitBangFrame_Output_ST_default
| kMIFBitBangFrame_Output_OP_write
| phyId << 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( data, phyId << 16 | reg, 'miiW', "UniNEnet::miiWriteWord" );
return true;
}
IODelay( 10 );
}
ELG( data, phyId << 16 | reg, 'miW-', "UniNEnet::miiWriteWord - failed" );
return false;
}
bool UniNEnet::miiResetPHY()
{
int i = MII_RESET_TIMEOUT;
UInt16 mii_control;
ELG( i, phyId, 'RstP', "UniNEnet::miiResetPHY" );
miiWriteWord( MII_CONTROL_RESET, MII_CONTROL ); IOSleep( MII_RESET_DELAY );
while ( i > 0 )
{
if ( miiReadWord( &mii_control, MII_CONTROL ) == false )
return false;
if ( !(mii_control & MII_CONTROL_RESET) )
{
miiReadWord( &mii_control, MII_CONTROL );
mii_control &= ~MII_CONTROL_ISOLATE;
miiWriteWord( mii_control, MII_CONTROL );
return true;
}
IOSleep( MII_RESET_DELAY );
i -= MII_RESET_DELAY;
}
return false;
}
bool UniNEnet::miiWaitForAutoNegotiation()
{
int i = MII_LINK_TIMEOUT;
UInt16 mii_status;
ELG( i, phyId, 'miWA', "UniNEnet::miiWaitForAutoNegotiation" );
while ( i > 0 )
{
if ( miiReadWord( &mii_status, MII_STATUS ) == false )
return false;
if ( mii_status & MII_STATUS_NEGOTIATION_COMPLETE )
return true;
IOSleep( MII_LINK_DELAY );
i -= MII_LINK_DELAY;
}
return false;
}