mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-07-05 10:46:15 +09:00
ee8fa20f54
gen10g_startup() had 2 bugs: 1) It had a boolean logic error in checking the MMD mask, and always checked all of them. 2) It checked devices which don't actually report link state, which meant that it would never believe the link was fully up. Fix the boolean logic, and then mask the MMD mask so only link-reporting devices are checked. Signed-off-by: Andy Fleming <afleming@freescale.com> Reported-by: Ed Swarthout <Ed.Swarthout@freescale.com>
109 lines
2.8 KiB
C
109 lines
2.8 KiB
C
/*
|
|
* Generic PHY Management code
|
|
*
|
|
* 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., 59 Temple Place, Suite 330, Boston,
|
|
* MA 02111-1307 USA
|
|
*
|
|
*
|
|
* Copyright 2011 Freescale Semiconductor, Inc.
|
|
* author Andy Fleming
|
|
*
|
|
* Based loosely off of Linux's PHY Lib
|
|
*/
|
|
|
|
#include <config.h>
|
|
#include <common.h>
|
|
#include <miiphy.h>
|
|
#include <phy.h>
|
|
|
|
int gen10g_shutdown(struct phy_device *phydev)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
int gen10g_startup(struct phy_device *phydev)
|
|
{
|
|
int devad, reg;
|
|
u32 mmd_mask = phydev->mmds & MDIO_DEVS_LINK;
|
|
|
|
phydev->link = 1;
|
|
|
|
/* For now just lie and say it's 10G all the time */
|
|
phydev->speed = SPEED_10000;
|
|
phydev->duplex = DUPLEX_FULL;
|
|
|
|
/*
|
|
* Go through all the link-reporting devices, and make sure
|
|
* they're all up and happy
|
|
*/
|
|
for (devad = 0; mmd_mask; devad++, mmd_mask = mmd_mask >> 1) {
|
|
if (!(mmd_mask & 1))
|
|
continue;
|
|
|
|
/* Read twice because link state is latched and a
|
|
* read moves the current state into the register */
|
|
phy_read(phydev, devad, MDIO_STAT1);
|
|
reg = phy_read(phydev, devad, MDIO_STAT1);
|
|
if (reg < 0 || !(reg & MDIO_STAT1_LSTATUS))
|
|
phydev->link = 0;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int gen10g_discover_mmds(struct phy_device *phydev)
|
|
{
|
|
int mmd, stat2, devs1, devs2;
|
|
|
|
/* Assume PHY must have at least one of PMA/PMD, WIS, PCS, PHY
|
|
* XS or DTE XS; give up if none is present. */
|
|
for (mmd = 1; mmd <= 5; mmd++) {
|
|
/* Is this MMD present? */
|
|
stat2 = phy_read(phydev, mmd, MDIO_STAT2);
|
|
if (stat2 < 0 ||
|
|
(stat2 & MDIO_STAT2_DEVPRST) != MDIO_STAT2_DEVPRST_VAL)
|
|
continue;
|
|
|
|
/* It should tell us about all the other MMDs */
|
|
devs1 = phy_read(phydev, mmd, MDIO_DEVS1);
|
|
devs2 = phy_read(phydev, mmd, MDIO_DEVS2);
|
|
if (devs1 < 0 || devs2 < 0)
|
|
continue;
|
|
|
|
phydev->mmds = devs1 | (devs2 << 16);
|
|
return 0;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int gen10g_config(struct phy_device *phydev)
|
|
{
|
|
/* For now, assume 10000baseT. Fill in later */
|
|
phydev->supported = phydev->advertising = SUPPORTED_10000baseT_Full;
|
|
|
|
return gen10g_discover_mmds(phydev);
|
|
}
|
|
|
|
struct phy_driver gen10g_driver = {
|
|
.uid = 0xffffffff,
|
|
.mask = 0xffffffff,
|
|
.name = "Generic 10G PHY",
|
|
.features = 0,
|
|
.config = gen10g_config,
|
|
.startup = gen10g_startup,
|
|
.shutdown = gen10g_shutdown,
|
|
};
|