1 // SPDX-License-Identifier: GPL-2.0+
13 #include "bcm-phy-lib.h"
15 /* RDB per-port registers
44 #define BCM54140_RDB_C_MISC_CTRL	0x02f	/* misc copper control */
60 #define  BCM54140_RDB_MON_CTRL_SEL_RR	3	/* meassure all round-robin */
61 #define  BCM54140_RDB_MON_CTRL_PWR_DOWN	BIT(0)	/* power-down monitor */
80  *   T = 413.35 - (0.49055 * bits[9:0])
82 #define BCM54140_HWMON_TO_TEMP(v) (413350L - (v) * 491)
83 #define BCM54140_HWMON_FROM_TEMP(v) DIV_ROUND_CLOSEST_ULL(413350L - (v), 491)
179 	struct bcm54140_priv *priv = phydev->priv;  in bcm54140_hwmon_read_alarm()
182 	mutex_lock(&priv->alarm_lock);  in bcm54140_hwmon_read_alarm()
184 	/* latch any alarm bits */  in bcm54140_hwmon_read_alarm()
190 	priv->alarm |= tmp;  in bcm54140_hwmon_read_alarm()
192 	*val = !!(priv->alarm & bit);  in bcm54140_hwmon_read_alarm()
193 	priv->alarm &= ~bit;  in bcm54140_hwmon_read_alarm()
196 	mutex_unlock(&priv->alarm_lock);  in bcm54140_hwmon_read_alarm()
221 		return -EOPNOTSUPP;  in bcm54140_hwmon_read_temp()
254 		return -EOPNOTSUPP;  in bcm54140_hwmon_read_in()
277 		return -EOPNOTSUPP;  in bcm54140_hwmon_read()
297 			return -EOPNOTSUPP;  in bcm54140_hwmon_read_string()
300 		return -EOPNOTSUPP;  in bcm54140_hwmon_read_string()
322 		return -EOPNOTSUPP;  in bcm54140_hwmon_write_temp()
346 		return -EOPNOTSUPP;  in bcm54140_hwmon_write_in()
363 		return -EOPNOTSUPP;  in bcm54140_hwmon_write()
398 	/* select round-robin */  in bcm54140_enable_monitoring()
403 	/* remove power-down bit */  in bcm54140_enable_monitoring()
419 	hwmon = devm_hwmon_device_register_with_info(&phydev->mdio.dev,  in bcm54140_probe_once()
498 	struct bcm54140_priv *priv = phydev->priv;  in bcm54140_get_base_addr_and_port()
499 	struct mii_bus *bus = phydev->mdio.bus;  in bcm54140_get_base_addr_and_port()
505 	min_addr = phydev->mdio.addr;  in bcm54140_get_base_addr_and_port()
506 	max_addr = phydev->mdio.addr;  in bcm54140_get_base_addr_and_port()
507 	addr = phydev->mdio.addr;  in bcm54140_get_base_addr_and_port()
527 			addr--;  in bcm54140_get_base_addr_and_port()
531 			addr = phydev->mdio.addr;  in bcm54140_get_base_addr_and_port()
547 		if ((phy_id & phydev->drv->phy_id_mask) !=  in bcm54140_get_base_addr_and_port()
548 		    (phydev->drv->phy_id & phydev->drv->phy_id_mask)) {  in bcm54140_get_base_addr_and_port()
549 			addr = phydev->mdio.addr;  in bcm54140_get_base_addr_and_port()
558 	if ((max_addr - min_addr + 1) % 4) {  in bcm54140_get_base_addr_and_port()
559 		dev_err(&phydev->mdio.dev,  in bcm54140_get_base_addr_and_port()
562 		return -EINVAL;  in bcm54140_get_base_addr_and_port()
565 	priv->port = (phydev->mdio.addr - min_addr) % 4;  in bcm54140_get_base_addr_and_port()
566 	priv->base_addr = phydev->mdio.addr - priv->port;  in bcm54140_get_base_addr_and_port()
576 	priv = devm_kzalloc(&phydev->mdio.dev, sizeof(*priv), GFP_KERNEL);  in bcm54140_probe()
578 		return -ENOMEM;  in bcm54140_probe()
580 	phydev->priv = priv;  in bcm54140_probe()
586 	devm_phy_package_join(&phydev->mdio.dev, phydev, priv->base_addr, 0);  in bcm54140_probe()
589 	mutex_init(&priv->alarm_lock);  in bcm54140_probe()
599 		   priv->port, priv->base_addr);  in bcm54140_probe()
610 	if (BCM54140_PHY_ID_REV(phydev->phy_id) == BCM54140_REV_B0) {  in bcm54140_config_init()
663 	struct bcm54140_priv *priv = phydev->priv;  in bcm54140_config_intr()
670 	if (priv->port >= ARRAY_SIZE(port_to_imr_bit))  in bcm54140_config_intr()
671 		return -EINVAL;  in bcm54140_config_intr()
677 	if (phydev->interrupts == PHY_INTERRUPT_ENABLED)  in bcm54140_config_intr()
678 		reg &= ~port_to_imr_bit[priv->port];  in bcm54140_config_intr()
680 		reg |= port_to_imr_bit[priv->port];  in bcm54140_config_intr()
716 		return -EINVAL;  in bcm54140_set_downshift()
731 		set = FIELD_PREP(BCM54140_RDB_SPARE2_WS_RTRY_LIMIT, cnt - 2);  in bcm54140_set_downshift()
797 		return -EINVAL;  in bcm54140_set_edpd()
806 	switch (tuna->id) {  in bcm54140_get_tunable()
812 		return -EOPNOTSUPP;  in bcm54140_get_tunable()
819 	switch (tuna->id) {  in bcm54140_set_tunable()
825 		return -EOPNOTSUPP;  in bcm54140_set_tunable()