1194 lines · 29.3 KB · C
RawDownload
// 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.

Keyboard shortcuts

General

Show keyboard shortcuts
?
Focus the current search
/

Issues and pull requests

Open filters
f

Issues, pull requests and Inbox

Select next item
j↓
Select previous item
k↑
Open selected item
Enter
Dismiss filters or clear selection
Esc

Repository code

Go to file
t