150 lines
3.5 KiB
C
150 lines
3.5 KiB
C
/*
|
|
* Copyright (C) 2012 Michael Brown <mbrown@fensystems.co.uk>.
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License as
|
|
* published by the Free Software Foundation; either version 2 of the
|
|
* License, or (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful, but
|
|
* WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
* General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
|
|
* 02110-1301, USA.
|
|
*
|
|
* You can also choose to distribute this program under the terms of
|
|
* the Unmodified Binary Distribution Licence (as given in the file
|
|
* COPYING.UBDL), provided that you have satisfied its requirements.
|
|
*/
|
|
|
|
FILE_LICENCE ( GPL2_OR_LATER_OR_UBDL );
|
|
|
|
#include <string.h>
|
|
#include <unistd.h>
|
|
#include <errno.h>
|
|
#include <ipxe/mii.h>
|
|
|
|
/** @file
|
|
*
|
|
* Media Independent Interface
|
|
*
|
|
*/
|
|
|
|
/**
|
|
* Restart autonegotiation
|
|
*
|
|
* @v mii MII interface
|
|
* @ret rc Return status code
|
|
*/
|
|
int mii_restart ( struct mii_interface *mii ) {
|
|
int bmcr;
|
|
int rc;
|
|
|
|
/* Read BMCR */
|
|
bmcr = mii_read ( mii, MII_BMCR );
|
|
if ( bmcr < 0 ) {
|
|
rc = bmcr;
|
|
DBGC ( mii, "MII %p could not read BMCR: %s\n",
|
|
mii, strerror ( rc ) );
|
|
return rc;
|
|
}
|
|
|
|
/* Enable and restart autonegotiation */
|
|
bmcr |= ( BMCR_ANENABLE | BMCR_ANRESTART );
|
|
if ( ( rc = mii_write ( mii, MII_BMCR, bmcr ) ) != 0 ) {
|
|
DBGC ( mii, "MII %p could not write BMCR: %s\n",
|
|
mii, strerror ( rc ) );
|
|
return rc;
|
|
}
|
|
|
|
DBGC ( mii, "MII %p restarted autonegotiation\n", mii );
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* Reset MII interface
|
|
*
|
|
* @v mii MII interface
|
|
* @ret rc Return status code
|
|
*/
|
|
int mii_reset ( struct mii_interface *mii ) {
|
|
unsigned int i;
|
|
int bmcr;
|
|
int rc;
|
|
|
|
/* Power-up, enable autonegotiation and initiate reset */
|
|
if ( ( rc = mii_write ( mii, MII_BMCR,
|
|
( BMCR_RESET | BMCR_ANENABLE ) ) ) != 0 ) {
|
|
DBGC ( mii, "MII %p could not write BMCR: %s\n",
|
|
mii, strerror ( rc ) );
|
|
return rc;
|
|
}
|
|
|
|
/* Wait for reset to complete */
|
|
for ( i = 0 ; i < MII_RESET_MAX_WAIT_MS ; i++ ) {
|
|
|
|
/* Check if reset has completed */
|
|
bmcr = mii_read ( mii, MII_BMCR );
|
|
if ( bmcr < 0 ) {
|
|
rc = bmcr;
|
|
DBGC ( mii, "MII %p could not read BMCR: %s\n",
|
|
mii, strerror ( rc ) );
|
|
return rc;
|
|
}
|
|
|
|
/* If reset is not complete, delay 1ms and retry */
|
|
if ( bmcr & BMCR_RESET ) {
|
|
mdelay ( 1 );
|
|
continue;
|
|
}
|
|
|
|
/* Force autonegotation on again, in case it was
|
|
* cleared by the reset.
|
|
*/
|
|
if ( ( rc = mii_restart ( mii ) ) != 0 )
|
|
return rc;
|
|
|
|
DBGC ( mii, "MII %p reset after %dms\n", mii, i );
|
|
return 0;
|
|
}
|
|
|
|
DBGC ( mii, "MII %p timed out waiting for reset\n", mii );
|
|
return -ETIMEDOUT;
|
|
}
|
|
|
|
/**
|
|
* Update link status via MII
|
|
*
|
|
* @v mii MII interface
|
|
* @v netdev Network device
|
|
* @ret rc Return status code
|
|
*/
|
|
int mii_check_link ( struct mii_interface *mii, struct net_device *netdev ) {
|
|
int bmsr;
|
|
int link;
|
|
int rc;
|
|
|
|
/* Read BMSR */
|
|
bmsr = mii_read ( mii, MII_BMSR );
|
|
if ( bmsr < 0 ) {
|
|
rc = bmsr;
|
|
return rc;
|
|
}
|
|
|
|
/* Report link status */
|
|
link = ( bmsr & BMSR_LSTATUS );
|
|
DBGC ( mii, "MII %p link %s (BMSR %#04x)\n",
|
|
mii, ( link ? "up" : "down" ), bmsr );
|
|
if ( link ) {
|
|
netdev_link_up ( netdev );
|
|
} else {
|
|
netdev_link_down ( netdev );
|
|
}
|
|
|
|
return 0;
|
|
}
|