// SPDX-License-Identifier: GPL-2.0/* * Copyright (C) 2015-2017 Broadcom */ #include "bcm-phy-lib.h"#include <linux/bitfield.h>#include <linux/brcmphy.h>#include <linux/etherdevice.h>#include <linux/export.h>#include <linux/mdio.h>#include <linux/module.h>#include <linux/phy.h>#include <linux/ethtool.h>#include <linux/ethtool_netlink.h>#include <linux/netdevice.h> #define MII_BCM_CHANNEL_WIDTH 0x2000#define BCM_CL45VEN_EEE_ADV 0x3c int __bcm_phy_write_exp(struct phy_device *phydev, u16 reg, u16 val){ int rc; rc = __phy_write(phydev, MII_BCM54XX_EXP_SEL, reg); if (rc < 0) return rc; return __phy_write(phydev, MII_BCM54XX_EXP_DATA, val);}EXPORT_SYMBOL_GPL(__bcm_phy_write_exp); int bcm_phy_write_exp(struct phy_device *phydev, u16 reg, u16 val){ int rc; phy_lock_mdio_bus(phydev); rc = __bcm_phy_write_exp(phydev, reg, val); phy_unlock_mdio_bus(phydev); return rc;}EXPORT_SYMBOL_GPL(bcm_phy_write_exp); int __bcm_phy_read_exp(struct phy_device *phydev, u16 reg){ int val; val = __phy_write(phydev, MII_BCM54XX_EXP_SEL, reg); if (val < 0) return val; val = __phy_read(phydev, MII_BCM54XX_EXP_DATA); /* Restore default value. It's O.K. if this write fails. */ __phy_write(phydev, MII_BCM54XX_EXP_SEL, 0); return val;}EXPORT_SYMBOL_GPL(__bcm_phy_read_exp); int bcm_phy_read_exp(struct phy_device *phydev, u16 reg){ int rc; phy_lock_mdio_bus(phydev); rc = __bcm_phy_read_exp(phydev, reg); phy_unlock_mdio_bus(phydev); return rc;}EXPORT_SYMBOL_GPL(bcm_phy_read_exp); int __bcm_phy_modify_exp(struct phy_device *phydev, u16 reg, u16 mask, u16 set){ int new, ret; ret = __phy_write(phydev, MII_BCM54XX_EXP_SEL, reg); if (ret < 0) return ret; ret = __phy_read(phydev, MII_BCM54XX_EXP_DATA); if (ret < 0) return ret; new = (ret & ~mask) | set; if (new == ret) return 0; return __phy_write(phydev, MII_BCM54XX_EXP_DATA, new);}EXPORT_SYMBOL_GPL(__bcm_phy_modify_exp); int bcm_phy_modify_exp(struct phy_device *phydev, u16 reg, u16 mask, u16 set){ int ret; phy_lock_mdio_bus(phydev); ret = __bcm_phy_modify_exp(phydev, reg, mask, set); phy_unlock_mdio_bus(phydev); return ret;}EXPORT_SYMBOL_GPL(bcm_phy_modify_exp); int bcm54xx_auxctl_read(struct phy_device *phydev, u16 regnum){ /* The register must be written to both the Shadow Register Select and * the Shadow Read Register Selector */ phy_write(phydev, MII_BCM54XX_AUX_CTL, MII_BCM54XX_AUXCTL_SHDWSEL_MASK | regnum << MII_BCM54XX_AUXCTL_SHDWSEL_READ_SHIFT); return phy_read(phydev, MII_BCM54XX_AUX_CTL);}EXPORT_SYMBOL_GPL(bcm54xx_auxctl_read); int bcm54xx_auxctl_write(struct phy_device *phydev, u16 regnum, u16 val){ return phy_write(phydev, MII_BCM54XX_AUX_CTL, regnum | val);}EXPORT_SYMBOL(bcm54xx_auxctl_write); int bcm_phy_write_misc(struct phy_device *phydev, u16 reg, u16 chl, u16 val){ int rc; int tmp; rc = phy_write(phydev, MII_BCM54XX_AUX_CTL, MII_BCM54XX_AUXCTL_SHDWSEL_MISC); if (rc < 0) return rc; tmp = phy_read(phydev, MII_BCM54XX_AUX_CTL); tmp |= MII_BCM54XX_AUXCTL_ACTL_SMDSP_ENA; rc = phy_write(phydev, MII_BCM54XX_AUX_CTL, tmp); if (rc < 0) return rc; tmp = (chl * MII_BCM_CHANNEL_WIDTH) | reg; rc = bcm_phy_write_exp(phydev, tmp, val); return rc;}EXPORT_SYMBOL_GPL(bcm_phy_write_misc); int bcm_phy_read_misc(struct phy_device *phydev, u16 reg, u16 chl){ int rc; int tmp; rc = phy_write(phydev, MII_BCM54XX_AUX_CTL, MII_BCM54XX_AUXCTL_SHDWSEL_MISC); if (rc < 0) return rc; tmp = phy_read(phydev, MII_BCM54XX_AUX_CTL); tmp |= MII_BCM54XX_AUXCTL_ACTL_SMDSP_ENA; rc = phy_write(phydev, MII_BCM54XX_AUX_CTL, tmp); if (rc < 0) return rc; tmp = (chl * MII_BCM_CHANNEL_WIDTH) | reg; rc = bcm_phy_read_exp(phydev, tmp); return rc;}EXPORT_SYMBOL_GPL(bcm_phy_read_misc); int bcm_phy_ack_intr(struct phy_device *phydev){ int reg; /* Clear pending interrupts. */ reg = phy_read(phydev, MII_BCM54XX_ISR); if (reg < 0) return reg; return 0;}EXPORT_SYMBOL_GPL(bcm_phy_ack_intr); int bcm_phy_config_intr(struct phy_device *phydev){ int reg, err; reg = phy_read(phydev, MII_BCM54XX_ECR); if (reg < 0) return reg; if (phydev->interrupts == PHY_INTERRUPT_ENABLED) { err = bcm_phy_ack_intr(phydev); if (err) return err; reg &= ~MII_BCM54XX_ECR_IM; err = phy_write(phydev, MII_BCM54XX_ECR, reg); } else { reg |= MII_BCM54XX_ECR_IM; err = phy_write(phydev, MII_BCM54XX_ECR, reg); if (err) return err; err = bcm_phy_ack_intr(phydev); } return err;}EXPORT_SYMBOL_GPL(bcm_phy_config_intr); irqreturn_t bcm_phy_handle_interrupt(struct phy_device *phydev){ int irq_status, irq_mask; irq_status = phy_read(phydev, MII_BCM54XX_ISR); if (irq_status < 0) { phy_error(phydev); return IRQ_NONE; } /* If a bit from the Interrupt Mask register is set, the corresponding * bit from the Interrupt Status register is masked. So read the IMR * and then flip the bits to get the list of possible interrupt * sources. */ irq_mask = phy_read(phydev, MII_BCM54XX_IMR); if (irq_mask < 0) { phy_error(phydev); return IRQ_NONE; } irq_mask = ~irq_mask; if (!(irq_status & irq_mask)) return IRQ_NONE; phy_trigger_machine(phydev); return IRQ_HANDLED;}EXPORT_SYMBOL_GPL(bcm_phy_handle_interrupt); int bcm_phy_read_shadow(struct phy_device *phydev, u16 shadow){ phy_write(phydev, MII_BCM54XX_SHD, MII_BCM54XX_SHD_VAL(shadow)); return MII_BCM54XX_SHD_DATA(phy_read(phydev, MII_BCM54XX_SHD));}EXPORT_SYMBOL_GPL(bcm_phy_read_shadow); int bcm_phy_write_shadow(struct phy_device *phydev, u16 shadow, u16 val){ return phy_write(phydev, MII_BCM54XX_SHD, MII_BCM54XX_SHD_WRITE | MII_BCM54XX_SHD_VAL(shadow) | MII_BCM54XX_SHD_DATA(val));}EXPORT_SYMBOL_GPL(bcm_phy_write_shadow); int __bcm_phy_read_rdb(struct phy_device *phydev, u16 rdb){ int val; val = __phy_write(phydev, MII_BCM54XX_RDB_ADDR, rdb); if (val < 0) return val; return __phy_read(phydev, MII_BCM54XX_RDB_DATA);}EXPORT_SYMBOL_GPL(__bcm_phy_read_rdb); int bcm_phy_read_rdb(struct phy_device *phydev, u16 rdb){ int ret; phy_lock_mdio_bus(phydev); ret = __bcm_phy_read_rdb(phydev, rdb); phy_unlock_mdio_bus(phydev); return ret;}EXPORT_SYMBOL_GPL(bcm_phy_read_rdb); int __bcm_phy_write_rdb(struct phy_device *phydev, u16 rdb, u16 val){ int ret; ret = __phy_write(phydev, MII_BCM54XX_RDB_ADDR, rdb); if (ret < 0) return ret; return __phy_write(phydev, MII_BCM54XX_RDB_DATA, val);}EXPORT_SYMBOL_GPL(__bcm_phy_write_rdb); int bcm_phy_write_rdb(struct phy_device *phydev, u16 rdb, u16 val){ int ret; phy_lock_mdio_bus(phydev); ret = __bcm_phy_write_rdb(phydev, rdb, val); phy_unlock_mdio_bus(phydev); return ret;}EXPORT_SYMBOL_GPL(bcm_phy_write_rdb); int __bcm_phy_modify_rdb(struct phy_device *phydev, u16 rdb, u16 mask, u16 set){ int new, ret; ret = __phy_write(phydev, MII_BCM54XX_RDB_ADDR, rdb); if (ret < 0) return ret; ret = __phy_read(phydev, MII_BCM54XX_RDB_DATA); if (ret < 0) return ret; new = (ret & ~mask) | set; if (new == ret) return 0; return __phy_write(phydev, MII_BCM54XX_RDB_DATA, new);}EXPORT_SYMBOL_GPL(__bcm_phy_modify_rdb); int bcm_phy_modify_rdb(struct phy_device *phydev, u16 rdb, u16 mask, u16 set){ int ret; phy_lock_mdio_bus(phydev); ret = __bcm_phy_modify_rdb(phydev, rdb, mask, set); phy_unlock_mdio_bus(phydev); return ret;}EXPORT_SYMBOL_GPL(bcm_phy_modify_rdb); int bcm_phy_enable_apd(struct phy_device *phydev, bool dll_pwr_down){ int val; if (dll_pwr_down) { val = bcm_phy_read_shadow(phydev, BCM54XX_SHD_SCR3); if (val < 0) return val; val |= BCM54XX_SHD_SCR3_DLLAPD_DIS; bcm_phy_write_shadow(phydev, BCM54XX_SHD_SCR3, val); } val = bcm_phy_read_shadow(phydev, BCM54XX_SHD_APD); if (val < 0) return val; /* Clear APD bits */ val &= BCM_APD_CLR_MASK; if (phydev->autoneg == AUTONEG_ENABLE) val |= BCM54XX_SHD_APD_EN; else val |= BCM_NO_ANEG_APD_EN; /* Enable energy detect single link pulse for easy wakeup */ val |= BCM_APD_SINGLELP_EN; /* Enable Auto Power-Down (APD) for the PHY */ return bcm_phy_write_shadow(phydev, BCM54XX_SHD_APD, val);}EXPORT_SYMBOL_GPL(bcm_phy_enable_apd); int bcm_phy_set_eee(struct phy_device *phydev, bool enable){ int val, mask = 0; /* Enable EEE at PHY level */ val = phy_read_mmd(phydev, MDIO_MMD_AN, BRCM_CL45VEN_EEE_CONTROL); if (val < 0) return val; if (enable) val |= LPI_FEATURE_EN | LPI_FEATURE_EN_DIG1000X; else val &= ~(LPI_FEATURE_EN | LPI_FEATURE_EN_DIG1000X); phy_write_mmd(phydev, MDIO_MMD_AN, BRCM_CL45VEN_EEE_CONTROL, (u32)val); /* Advertise EEE */ val = phy_read_mmd(phydev, MDIO_MMD_AN, BCM_CL45VEN_EEE_ADV); if (val < 0) return val; if (linkmode_test_bit(ETHTOOL_LINK_MODE_1000baseT_Full_BIT, phydev->supported)) mask |= MDIO_EEE_1000T; if (linkmode_test_bit(ETHTOOL_LINK_MODE_100baseT_Full_BIT, phydev->supported)) mask |= MDIO_EEE_100TX; if (enable) val |= mask; else val &= ~mask; phy_write_mmd(phydev, MDIO_MMD_AN, BCM_CL45VEN_EEE_ADV, (u32)val); return 0;}EXPORT_SYMBOL_GPL(bcm_phy_set_eee); int bcm_phy_downshift_get(struct phy_device *phydev, u8 *count){ int val; val = bcm54xx_auxctl_read(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC); if (val < 0) return val; /* Check if wirespeed is enabled or not */ if (!(val & MII_BCM54XX_AUXCTL_SHDWSEL_MISC_WIRESPEED_EN)) { *count = DOWNSHIFT_DEV_DISABLE; return 0; } val = bcm_phy_read_shadow(phydev, BCM54XX_SHD_SCR2); if (val < 0) return val; /* Downgrade after one link attempt */ if (val & BCM54XX_SHD_SCR2_WSPD_RTRY_DIS) { *count = 1; } else { /* Downgrade after configured retry count */ val >>= BCM54XX_SHD_SCR2_WSPD_RTRY_LMT_SHIFT; val &= BCM54XX_SHD_SCR2_WSPD_RTRY_LMT_MASK; *count = val + BCM54XX_SHD_SCR2_WSPD_RTRY_LMT_OFFSET; } return 0;}EXPORT_SYMBOL_GPL(bcm_phy_downshift_get); int bcm_phy_downshift_set(struct phy_device *phydev, u8 count){ int val = 0, ret = 0; /* Range check the number given */ if (count - BCM54XX_SHD_SCR2_WSPD_RTRY_LMT_OFFSET > BCM54XX_SHD_SCR2_WSPD_RTRY_LMT_MASK && count != DOWNSHIFT_DEV_DEFAULT_COUNT) { return -ERANGE; } val = bcm54xx_auxctl_read(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC); if (val < 0) return val; /* Se the write enable bit */ val |= MII_BCM54XX_AUXCTL_MISC_WREN; if (count == DOWNSHIFT_DEV_DISABLE) { val &= ~MII_BCM54XX_AUXCTL_SHDWSEL_MISC_WIRESPEED_EN; return bcm54xx_auxctl_write(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC, val); } else { val |= MII_BCM54XX_AUXCTL_SHDWSEL_MISC_WIRESPEED_EN; ret = bcm54xx_auxctl_write(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC, val); if (ret < 0) return ret; } val = bcm_phy_read_shadow(phydev, BCM54XX_SHD_SCR2); val &= ~(BCM54XX_SHD_SCR2_WSPD_RTRY_LMT_MASK << BCM54XX_SHD_SCR2_WSPD_RTRY_LMT_SHIFT | BCM54XX_SHD_SCR2_WSPD_RTRY_DIS); switch (count) { case 1: val |= BCM54XX_SHD_SCR2_WSPD_RTRY_DIS; break; case DOWNSHIFT_DEV_DEFAULT_COUNT: val |= 1 << BCM54XX_SHD_SCR2_WSPD_RTRY_LMT_SHIFT; break; default: val |= (count - BCM54XX_SHD_SCR2_WSPD_RTRY_LMT_OFFSET) << BCM54XX_SHD_SCR2_WSPD_RTRY_LMT_SHIFT; break; } return bcm_phy_write_shadow(phydev, BCM54XX_SHD_SCR2, val);}EXPORT_SYMBOL_GPL(bcm_phy_downshift_set); struct bcm_phy_hw_stat { const char *string; int devad; u16 reg;Lines 1–500 of 1194. Load more
// SPDX-License-Identifier: GPL-2.0 /* * Copyright (C) 2015-2017 Broadcom */ #include "bcm-phy-lib.h" #include <linux/bitfield.h> #include <linux/brcmphy.h> #include <linux/etherdevice.h> #include <linux/export.h> #include <linux/mdio.h> #include <linux/module.h> #include <linux/phy.h> #include <linux/ethtool.h> #include <linux/ethtool_netlink.h> #include <linux/netdevice.h> #define MII_BCM_CHANNEL_WIDTH 0x2000 #define BCM_CL45VEN_EEE_ADV 0x3c int __bcm_phy_write_exp(struct phy_device *phydev, u16 reg, u16 val) { int rc; rc = __phy_write(phydev, MII_BCM54XX_EXP_SEL, reg); if (rc < 0) return rc; return __phy_write(phydev, MII_BCM54XX_EXP_DATA, val); } EXPORT_SYMBOL_GPL(__bcm_phy_write_exp); int bcm_phy_write_exp(struct phy_device *phydev, u16 reg, u16 val) { int rc; phy_lock_mdio_bus(phydev); rc = __bcm_phy_write_exp(phydev, reg, val); phy_unlock_mdio_bus(phydev); return rc; } EXPORT_SYMBOL_GPL(bcm_phy_write_exp); int __bcm_phy_read_exp(struct phy_device *phydev, u16 reg) { int val; val = __phy_write(phydev, MII_BCM54XX_EXP_SEL, reg); if (val < 0) return val; val = __phy_read(phydev, MII_BCM54XX_EXP_DATA); /* Restore default value. It's O.K. if this write fails. */ __phy_write(phydev, MII_BCM54XX_EXP_SEL, 0); return val; } EXPORT_SYMBOL_GPL(__bcm_phy_read_exp); int bcm_phy_read_exp(struct phy_device *phydev, u16 reg) { int rc; phy_lock_mdio_bus(phydev); rc = __bcm_phy_read_exp(phydev, reg); phy_unlock_mdio_bus(phydev); return rc; } EXPORT_SYMBOL_GPL(bcm_phy_read_exp); int __bcm_phy_modify_exp(struct phy_device *phydev, u16 reg, u16 mask, u16 set) { int new, ret; ret = __phy_write(phydev, MII_BCM54XX_EXP_SEL, reg); if (ret < 0) return ret; ret = __phy_read(phydev, MII_BCM54XX_EXP_DATA); if (ret < 0) return ret; new = (ret & ~mask) | set; if (new == ret) return 0; return __phy_write(phydev, MII_BCM54XX_EXP_DATA, new); } EXPORT_SYMBOL_GPL(__bcm_phy_modify_exp); int bcm_phy_modify_exp(struct phy_device *phydev, u16 reg, u16 mask, u16 set) { int ret; phy_lock_mdio_bus(phydev); ret = __bcm_phy_modify_exp(phydev, reg, mask, set); phy_unlock_mdio_bus(phydev); return ret; } EXPORT_SYMBOL_GPL(bcm_phy_modify_exp); int bcm54xx_auxctl_read(struct phy_device *phydev, u16 regnum) { /* The register must be written to both the Shadow Register Select and * the Shadow Read Register Selector */ phy_write(phydev, MII_BCM54XX_AUX_CTL, MII_BCM54XX_AUXCTL_SHDWSEL_MASK | regnum << MII_BCM54XX_AUXCTL_SHDWSEL_READ_SHIFT); return phy_read(phydev, MII_BCM54XX_AUX_CTL); } EXPORT_SYMBOL_GPL(bcm54xx_auxctl_read); int bcm54xx_auxctl_write(struct phy_device *phydev, u16 regnum, u16 val) { return phy_write(phydev, MII_BCM54XX_AUX_CTL, regnum | val); } EXPORT_SYMBOL(bcm54xx_auxctl_write); int bcm_phy_write_misc(struct phy_device *phydev, u16 reg, u16 chl, u16 val) { int rc; int tmp; rc = phy_write(phydev, MII_BCM54XX_AUX_CTL, MII_BCM54XX_AUXCTL_SHDWSEL_MISC); if (rc < 0) return rc; tmp = phy_read(phydev, MII_BCM54XX_AUX_CTL); tmp |= MII_BCM54XX_AUXCTL_ACTL_SMDSP_ENA; rc = phy_write(phydev, MII_BCM54XX_AUX_CTL, tmp); if (rc < 0) return rc; tmp = (chl * MII_BCM_CHANNEL_WIDTH) | reg; rc = bcm_phy_write_exp(phydev, tmp, val); return rc; } EXPORT_SYMBOL_GPL(bcm_phy_write_misc); int bcm_phy_read_misc(struct phy_device *phydev, u16 reg, u16 chl) { int rc; int tmp; rc = phy_write(phydev, MII_BCM54XX_AUX_CTL, MII_BCM54XX_AUXCTL_SHDWSEL_MISC); if (rc < 0) return rc; tmp = phy_read(phydev, MII_BCM54XX_AUX_CTL); tmp |= MII_BCM54XX_AUXCTL_ACTL_SMDSP_ENA; rc = phy_write(phydev, MII_BCM54XX_AUX_CTL, tmp); if (rc < 0) return rc; tmp = (chl * MII_BCM_CHANNEL_WIDTH) | reg; rc = bcm_phy_read_exp(phydev, tmp); return rc; } EXPORT_SYMBOL_GPL(bcm_phy_read_misc); int bcm_phy_ack_intr(struct phy_device *phydev) { int reg; /* Clear pending interrupts. */ reg = phy_read(phydev, MII_BCM54XX_ISR); if (reg < 0) return reg; return 0; } EXPORT_SYMBOL_GPL(bcm_phy_ack_intr); int bcm_phy_config_intr(struct phy_device *phydev) { int reg, err; reg = phy_read(phydev, MII_BCM54XX_ECR); if (reg < 0) return reg; if (phydev->interrupts == PHY_INTERRUPT_ENABLED) { err = bcm_phy_ack_intr(phydev); if (err) return err; reg &= ~MII_BCM54XX_ECR_IM; err = phy_write(phydev, MII_BCM54XX_ECR, reg); } else { reg |= MII_BCM54XX_ECR_IM; err = phy_write(phydev, MII_BCM54XX_ECR, reg); if (err) return err; err = bcm_phy_ack_intr(phydev); } return err; } EXPORT_SYMBOL_GPL(bcm_phy_config_intr); irqreturn_t bcm_phy_handle_interrupt(struct phy_device *phydev) { int irq_status, irq_mask; irq_status = phy_read(phydev, MII_BCM54XX_ISR); if (irq_status < 0) { phy_error(phydev); return IRQ_NONE; } /* If a bit from the Interrupt Mask register is set, the corresponding * bit from the Interrupt Status register is masked. So read the IMR * and then flip the bits to get the list of possible interrupt * sources. */ irq_mask = phy_read(phydev, MII_BCM54XX_IMR); if (irq_mask < 0) { phy_error(phydev); return IRQ_NONE; } irq_mask = ~irq_mask; if (!(irq_status & irq_mask)) return IRQ_NONE; phy_trigger_machine(phydev); return IRQ_HANDLED; } EXPORT_SYMBOL_GPL(bcm_phy_handle_interrupt); int bcm_phy_read_shadow(struct phy_device *phydev, u16 shadow) { phy_write(phydev, MII_BCM54XX_SHD, MII_BCM54XX_SHD_VAL(shadow)); return MII_BCM54XX_SHD_DATA(phy_read(phydev, MII_BCM54XX_SHD)); } EXPORT_SYMBOL_GPL(bcm_phy_read_shadow); int bcm_phy_write_shadow(struct phy_device *phydev, u16 shadow, u16 val) { return phy_write(phydev, MII_BCM54XX_SHD, MII_BCM54XX_SHD_WRITE | MII_BCM54XX_SHD_VAL(shadow) | MII_BCM54XX_SHD_DATA(val)); } EXPORT_SYMBOL_GPL(bcm_phy_write_shadow); int __bcm_phy_read_rdb(struct phy_device *phydev, u16 rdb) { int val; val = __phy_write(phydev, MII_BCM54XX_RDB_ADDR, rdb); if (val < 0) return val; return __phy_read(phydev, MII_BCM54XX_RDB_DATA); } EXPORT_SYMBOL_GPL(__bcm_phy_read_rdb); int bcm_phy_read_rdb(struct phy_device *phydev, u16 rdb) { int ret; phy_lock_mdio_bus(phydev); ret = __bcm_phy_read_rdb(phydev, rdb); phy_unlock_mdio_bus(phydev); return ret; } EXPORT_SYMBOL_GPL(bcm_phy_read_rdb); int __bcm_phy_write_rdb(struct phy_device *phydev, u16 rdb, u16 val) { int ret; ret = __phy_write(phydev, MII_BCM54XX_RDB_ADDR, rdb); if (ret < 0) return ret; return __phy_write(phydev, MII_BCM54XX_RDB_DATA, val); } EXPORT_SYMBOL_GPL(__bcm_phy_write_rdb); int bcm_phy_write_rdb(struct phy_device *phydev, u16 rdb, u16 val) { int ret; phy_lock_mdio_bus(phydev); ret = __bcm_phy_write_rdb(phydev, rdb, val); phy_unlock_mdio_bus(phydev); return ret; } EXPORT_SYMBOL_GPL(bcm_phy_write_rdb); int __bcm_phy_modify_rdb(struct phy_device *phydev, u16 rdb, u16 mask, u16 set) { int new, ret; ret = __phy_write(phydev, MII_BCM54XX_RDB_ADDR, rdb); if (ret < 0) return ret; ret = __phy_read(phydev, MII_BCM54XX_RDB_DATA); if (ret < 0) return ret; new = (ret & ~mask) | set; if (new == ret) return 0; return __phy_write(phydev, MII_BCM54XX_RDB_DATA, new); } EXPORT_SYMBOL_GPL(__bcm_phy_modify_rdb); int bcm_phy_modify_rdb(struct phy_device *phydev, u16 rdb, u16 mask, u16 set) { int ret; phy_lock_mdio_bus(phydev); ret = __bcm_phy_modify_rdb(phydev, rdb, mask, set); phy_unlock_mdio_bus(phydev); return ret; } EXPORT_SYMBOL_GPL(bcm_phy_modify_rdb); int bcm_phy_enable_apd(struct phy_device *phydev, bool dll_pwr_down) { int val; if (dll_pwr_down) { val = bcm_phy_read_shadow(phydev, BCM54XX_SHD_SCR3); if (val < 0) return val; val |= BCM54XX_SHD_SCR3_DLLAPD_DIS; bcm_phy_write_shadow(phydev, BCM54XX_SHD_SCR3, val); } val = bcm_phy_read_shadow(phydev, BCM54XX_SHD_APD); if (val < 0) return val; /* Clear APD bits */ val &= BCM_APD_CLR_MASK; if (phydev->autoneg == AUTONEG_ENABLE) val |= BCM54XX_SHD_APD_EN; else val |= BCM_NO_ANEG_APD_EN; /* Enable energy detect single link pulse for easy wakeup */ val |= BCM_APD_SINGLELP_EN; /* Enable Auto Power-Down (APD) for the PHY */ return bcm_phy_write_shadow(phydev, BCM54XX_SHD_APD, val); } EXPORT_SYMBOL_GPL(bcm_phy_enable_apd); int bcm_phy_set_eee(struct phy_device *phydev, bool enable) { int val, mask = 0; /* Enable EEE at PHY level */ val = phy_read_mmd(phydev, MDIO_MMD_AN, BRCM_CL45VEN_EEE_CONTROL); if (val < 0) return val; if (enable) val |= LPI_FEATURE_EN | LPI_FEATURE_EN_DIG1000X; else val &= ~(LPI_FEATURE_EN | LPI_FEATURE_EN_DIG1000X); phy_write_mmd(phydev, MDIO_MMD_AN, BRCM_CL45VEN_EEE_CONTROL, (u32)val); /* Advertise EEE */ val = phy_read_mmd(phydev, MDIO_MMD_AN, BCM_CL45VEN_EEE_ADV); if (val < 0) return val; if (linkmode_test_bit(ETHTOOL_LINK_MODE_1000baseT_Full_BIT, phydev->supported)) mask |= MDIO_EEE_1000T; if (linkmode_test_bit(ETHTOOL_LINK_MODE_100baseT_Full_BIT, phydev->supported)) mask |= MDIO_EEE_100TX; if (enable) val |= mask; else val &= ~mask; phy_write_mmd(phydev, MDIO_MMD_AN, BCM_CL45VEN_EEE_ADV, (u32)val); return 0; } EXPORT_SYMBOL_GPL(bcm_phy_set_eee); int bcm_phy_downshift_get(struct phy_device *phydev, u8 *count) { int val; val = bcm54xx_auxctl_read(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC); if (val < 0) return val; /* Check if wirespeed is enabled or not */ if (!(val & MII_BCM54XX_AUXCTL_SHDWSEL_MISC_WIRESPEED_EN)) { *count = DOWNSHIFT_DEV_DISABLE; return 0; } val = bcm_phy_read_shadow(phydev, BCM54XX_SHD_SCR2); if (val < 0) return val; /* Downgrade after one link attempt */ if (val & BCM54XX_SHD_SCR2_WSPD_RTRY_DIS) { *count = 1; } else { /* Downgrade after configured retry count */ val >>= BCM54XX_SHD_SCR2_WSPD_RTRY_LMT_SHIFT; val &= BCM54XX_SHD_SCR2_WSPD_RTRY_LMT_MASK; *count = val + BCM54XX_SHD_SCR2_WSPD_RTRY_LMT_OFFSET; } return 0; } EXPORT_SYMBOL_GPL(bcm_phy_downshift_get); int bcm_phy_downshift_set(struct phy_device *phydev, u8 count) { int val = 0, ret = 0; /* Range check the number given */ if (count - BCM54XX_SHD_SCR2_WSPD_RTRY_LMT_OFFSET > BCM54XX_SHD_SCR2_WSPD_RTRY_LMT_MASK && count != DOWNSHIFT_DEV_DEFAULT_COUNT) { return -ERANGE; } val = bcm54xx_auxctl_read(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC); if (val < 0) return val; /* Se the write enable bit */ val |= MII_BCM54XX_AUXCTL_MISC_WREN; if (count == DOWNSHIFT_DEV_DISABLE) { val &= ~MII_BCM54XX_AUXCTL_SHDWSEL_MISC_WIRESPEED_EN; return bcm54xx_auxctl_write(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC, val); } else { val |= MII_BCM54XX_AUXCTL_SHDWSEL_MISC_WIRESPEED_EN; ret = bcm54xx_auxctl_write(phydev, MII_BCM54XX_AUXCTL_SHDWSEL_MISC, val); if (ret < 0) return ret; } val = bcm_phy_read_shadow(phydev, BCM54XX_SHD_SCR2); val &= ~(BCM54XX_SHD_SCR2_WSPD_RTRY_LMT_MASK << BCM54XX_SHD_SCR2_WSPD_RTRY_LMT_SHIFT | BCM54XX_SHD_SCR2_WSPD_RTRY_DIS); switch (count) { case 1: val |= BCM54XX_SHD_SCR2_WSPD_RTRY_DIS; break; case DOWNSHIFT_DEV_DEFAULT_COUNT: val |= 1 << BCM54XX_SHD_SCR2_WSPD_RTRY_LMT_SHIFT; break; default: val |= (count - BCM54XX_SHD_SCR2_WSPD_RTRY_LMT_OFFSET) << BCM54XX_SHD_SCR2_WSPD_RTRY_LMT_SHIFT; break; } return bcm_phy_write_shadow(phydev, BCM54XX_SHD_SCR2, val); } EXPORT_SYMBOL_GPL(bcm_phy_downshift_set); struct bcm_phy_hw_stat { const char *string; int devad; u16 reg;