#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( miiReg, phy << 16 | reg, 'miiR', "miiReadWord" );
*dataPtr = (UInt16) miiReg;
return true;
}
IODelay( 10 );
}
ELG( miiReg, phy << 16 | reg, '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( data, phy << 16 | reg, 'miiW', "miiWriteWord" );
return true;
}
IODelay( 10 );
}
ELG( data, phy << 16 | reg, '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::miiWaitForAutoNegotiation( UInt8 phy )
{
int i = MII_LINK_TIMEOUT;
UInt16 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 );
if ( fPHYType == 0x1011 )
{ ELG( 0, 0, 'mrvl', "miiInitializePHY" );
miiReadWord( &phyWord, MII_1000BASETCONTROL, phy );
phyWord |= MII_1000BASETCONTROL_FULLDUPLEXCAP
| MII_1000BASETCONTROL_HALFDUPLEXCAP;
miiWriteWord( phyWord, MII_1000BASETCONTROL, phy );
miiReadWord( &phyWord, MII_CONTROL, phy );
phyWord |= MII_CONTROL_AUTONEGOTIATION
| MII_CONTROL_RESTART_NEGOTIATION
| MII_CONTROL_RESET;
miiWriteWord( phyWord, MII_CONTROL, phy );
IOSleep( 1 );
return true;
}
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;
}