uboot-phytec

// SPDX-License-Identifier: GPL-2.0+

/*

 * Aquantia PHY drivers

 *

 * Copyright 2014 Freescale Semiconductor, Inc.

 */

#include <config.h>

#include <common.h>

#include <dm.h>

#include <phy.h>

​

#ifndef CONFIG_PHYLIB_10G

#error The Aquantia PHY needs 10G support

#endif

​

#define AQUNTIA_10G_CTL     0x20

#define AQUNTIA_VENDOR_P1   0xc400

​

#define AQUNTIA_SPEED_LSB_MASK  0x2000

#define AQUNTIA_SPEED_MSB_MASK  0x40

​

int aquantia_config(struct phy_device *phydev)

{

    u32 val = phy_read(phydev, MDIO_MMD_PMAPMD, MII_BMCR);

​

    if (phydev->interface == PHY_INTERFACE_MODE_SGMII) {

        /* 1000BASE-T mode */

        phydev->advertising = SUPPORTED_1000baseT_Full;

        phydev->supported = phydev->advertising;

​

        val = (val & ~AQUNTIA_SPEED_LSB_MASK) | AQUNTIA_SPEED_MSB_MASK;

        phy_write(phydev, MDIO_MMD_PMAPMD, MII_BMCR, val);

    } else if (phydev->interface == PHY_INTERFACE_MODE_XGMII) {

        /* 10GBASE-T mode */

        phydev->advertising = SUPPORTED_10000baseT_Full;

        phydev->supported = phydev->advertising;

​

        if (!(val & AQUNTIA_SPEED_LSB_MASK) ||

            !(val & AQUNTIA_SPEED_MSB_MASK))

            phy_write(phydev, MDIO_MMD_PMAPMD, MII_BMCR,

                  AQUNTIA_SPEED_LSB_MASK |

                  AQUNTIA_SPEED_MSB_MASK);

    } else if (phydev->interface == PHY_INTERFACE_MODE_SGMII_2500) {

        /* 2.5GBASE-T mode */

        phydev->advertising = SUPPORTED_1000baseT_Full;

        phydev->supported = phydev->advertising;

​

        phy_write(phydev, MDIO_MMD_AN, AQUNTIA_10G_CTL, 1);

        phy_write(phydev, MDIO_MMD_AN, AQUNTIA_VENDOR_P1, 0x9440);

    } else if (phydev->interface == PHY_INTERFACE_MODE_MII) {

        /* 100BASE-TX mode */

        phydev->advertising = SUPPORTED_100baseT_Full;

        phydev->supported = phydev->advertising;

​

        val = (val & ~AQUNTIA_SPEED_MSB_MASK) | AQUNTIA_SPEED_LSB_MASK;

        phy_write(phydev, MDIO_MMD_PMAPMD, MII_BMCR, val);

    }

    return 0;

}

​

int aquantia_startup(struct phy_device *phydev)

{

    u32 reg, speed;