root/drivers/net/phy/ax88796b.c
// SPDX-License-Identifier: GPL-2.0+
/* Driver for Asix PHYs
 *
 * Author: Michael Schmitz <schmitzmic@gmail.com>
 */
#include <linux/kernel.h>
#include <linux/errno.h>
#include <linux/init.h>
#include <linux/module.h>
#include <linux/mii.h>
#include <linux/phy.h>

#define PHY_ID_ASIX_AX88772A            0x003b1861
#define PHY_ID_ASIX_AX88772C            0x003b1881
#define PHY_ID_ASIX_AX88796B            0x003b1841

MODULE_DESCRIPTION("Asix PHY driver");
MODULE_AUTHOR("Michael Schmitz <schmitzmic@gmail.com>");
MODULE_LICENSE("GPL");

/**
 * asix_soft_reset - software reset the PHY via BMCR_RESET bit
 * @phydev: target phy_device struct
 *
 * Description: Perform a software PHY reset using the standard
 * BMCR_RESET bit and poll for the reset bit to be cleared.
 * Toggle BMCR_RESET bit off to accommodate broken AX8796B PHY implementation
 * such as used on the Individual Computers' X-Surf 100 Zorro card.
 *
 * Returns: 0 on success, < 0 on failure
 */
static int asix_soft_reset(struct phy_device *phydev)
{
        int ret;

        /* Asix PHY won't reset unless reset bit toggles */
        ret = phy_write(phydev, MII_BMCR, 0);
        if (ret < 0)
                return ret;

        return genphy_soft_reset(phydev);
}

/* AX88772A is not working properly with some old switches (NETGEAR EN 108TP):
 * after autoneg is done and the link status is reported as active, the MII_LPA
 * register is 0. This issue is not reproducible on AX88772C.
 */
static int asix_ax88772a_read_status(struct phy_device *phydev)
{
        int ret, val;

        ret = genphy_update_link(phydev);
        if (ret)
                return ret;

        if (!phydev->link)
                return 0;

        /* If MII_LPA is 0, phy_resolve_aneg_linkmode() will fail to resolve
         * linkmode so use MII_BMCR as default values.
         */
        val = phy_read(phydev, MII_BMCR);
        if (val < 0)
                return val;

        if (val & BMCR_SPEED100)
                phydev->speed = SPEED_100;
        else
                phydev->speed = SPEED_10;

        if (val & BMCR_FULLDPLX)
                phydev->duplex = DUPLEX_FULL;
        else
                phydev->duplex = DUPLEX_HALF;

        ret = genphy_read_lpa(phydev);
        if (ret < 0)
                return ret;

        if (phydev->autoneg == AUTONEG_ENABLE && phydev->autoneg_complete)
                phy_resolve_aneg_linkmode(phydev);

        return 0;
}

static void asix_ax88772a_link_change_notify(struct phy_device *phydev)
{
        /* Reset PHY, otherwise MII_LPA will provide outdated information.
         * This issue is reproducible only with some link partner PHYs
         */
        if (phydev->state == PHY_NOLINK) {
                phy_init_hw(phydev);
                _phy_start_aneg(phydev);
        }
}

static struct phy_driver asix_driver[] = {
{
        PHY_ID_MATCH_EXACT(PHY_ID_ASIX_AX88772A),
        .name           = "Asix Electronics AX88772A",
        .flags          = PHY_IS_INTERNAL,
        .read_status    = asix_ax88772a_read_status,
        .suspend        = genphy_suspend,
        .resume         = genphy_resume,
        .soft_reset     = asix_soft_reset,
        .link_change_notify     = asix_ax88772a_link_change_notify,
}, {
        PHY_ID_MATCH_EXACT(PHY_ID_ASIX_AX88772C),
        .name           = "Asix Electronics AX88772C",
        .flags          = PHY_IS_INTERNAL,
        .suspend        = genphy_suspend,
        .resume         = genphy_resume,
        .soft_reset     = asix_soft_reset,
}, {
        PHY_ID_MATCH_MODEL(PHY_ID_ASIX_AX88796B),
        .name           = "Asix Electronics AX88796B",
        /* PHY_BASIC_FEATURES */
        .soft_reset     = asix_soft_reset,
} };

module_phy_driver(asix_driver);

static const struct mdio_device_id __maybe_unused asix_tbl[] = {
        { PHY_ID_MATCH_EXACT(PHY_ID_ASIX_AX88772A) },
        { PHY_ID_MATCH_EXACT(PHY_ID_ASIX_AX88772C) },
        { PHY_ID_MATCH_MODEL(PHY_ID_ASIX_AX88796B) },
        { }
};

MODULE_DEVICE_TABLE(mdio, asix_tbl);