161 lines
4.2 KiB
C
161 lines
4.2 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/* LED driver for Aquantia PHY
|
|
*
|
|
* Author: Daniel Golle <daniel@makrotopia.org>
|
|
*/
|
|
|
|
#include <linux/phy.h>
|
|
|
|
#include "aquantia.h"
|
|
|
|
int aqr_phy_led_brightness_set(struct phy_device *phydev,
|
|
u8 index, enum led_brightness value)
|
|
{
|
|
if (index >= AQR_MAX_LEDS)
|
|
return -EINVAL;
|
|
|
|
return phy_modify_mmd(phydev, MDIO_MMD_VEND1, AQR_LED_PROV(index),
|
|
VEND1_GLOBAL_LED_PROV_LINK_MASK |
|
|
VEND1_GLOBAL_LED_PROV_FORCE_ON |
|
|
VEND1_GLOBAL_LED_PROV_RX_ACT |
|
|
VEND1_GLOBAL_LED_PROV_TX_ACT,
|
|
value ? VEND1_GLOBAL_LED_PROV_FORCE_ON : 0);
|
|
}
|
|
|
|
static const unsigned long supported_triggers = (BIT(TRIGGER_NETDEV_LINK) |
|
|
BIT(TRIGGER_NETDEV_LINK_100) |
|
|
BIT(TRIGGER_NETDEV_LINK_1000) |
|
|
BIT(TRIGGER_NETDEV_LINK_2500) |
|
|
BIT(TRIGGER_NETDEV_LINK_5000) |
|
|
BIT(TRIGGER_NETDEV_LINK_10000) |
|
|
BIT(TRIGGER_NETDEV_RX) |
|
|
BIT(TRIGGER_NETDEV_TX));
|
|
|
|
int aqr_phy_led_hw_is_supported(struct phy_device *phydev, u8 index,
|
|
unsigned long rules)
|
|
{
|
|
if (index >= AQR_MAX_LEDS)
|
|
return -EINVAL;
|
|
|
|
/* All combinations of the supported triggers are allowed */
|
|
if (rules & ~supported_triggers)
|
|
return -EOPNOTSUPP;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int aqr_phy_led_hw_control_get(struct phy_device *phydev, u8 index,
|
|
unsigned long *rules)
|
|
{
|
|
int val;
|
|
|
|
if (index >= AQR_MAX_LEDS)
|
|
return -EINVAL;
|
|
|
|
val = phy_read_mmd(phydev, MDIO_MMD_VEND1, AQR_LED_PROV(index));
|
|
if (val < 0)
|
|
return val;
|
|
|
|
*rules = 0;
|
|
if (val & VEND1_GLOBAL_LED_PROV_LINK100)
|
|
*rules |= BIT(TRIGGER_NETDEV_LINK_100);
|
|
|
|
if (val & VEND1_GLOBAL_LED_PROV_LINK1000)
|
|
*rules |= BIT(TRIGGER_NETDEV_LINK_1000);
|
|
|
|
if (val & VEND1_GLOBAL_LED_PROV_LINK2500)
|
|
*rules |= BIT(TRIGGER_NETDEV_LINK_2500);
|
|
|
|
if (val & VEND1_GLOBAL_LED_PROV_LINK5000)
|
|
*rules |= BIT(TRIGGER_NETDEV_LINK_5000);
|
|
|
|
if (val & VEND1_GLOBAL_LED_PROV_LINK10000)
|
|
*rules |= BIT(TRIGGER_NETDEV_LINK_10000);
|
|
|
|
if (val & VEND1_GLOBAL_LED_PROV_RX_ACT)
|
|
*rules |= BIT(TRIGGER_NETDEV_RX);
|
|
|
|
if (val & VEND1_GLOBAL_LED_PROV_TX_ACT)
|
|
*rules |= BIT(TRIGGER_NETDEV_TX);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int aqr_phy_led_hw_control_set(struct phy_device *phydev, u8 index,
|
|
unsigned long rules)
|
|
{
|
|
u16 val = 0;
|
|
|
|
if (index >= AQR_MAX_LEDS)
|
|
return -EINVAL;
|
|
|
|
if (rules & (BIT(TRIGGER_NETDEV_LINK_100) | BIT(TRIGGER_NETDEV_LINK)))
|
|
val |= VEND1_GLOBAL_LED_PROV_LINK100;
|
|
|
|
if (rules & (BIT(TRIGGER_NETDEV_LINK_1000) | BIT(TRIGGER_NETDEV_LINK)))
|
|
val |= VEND1_GLOBAL_LED_PROV_LINK1000;
|
|
|
|
if (rules & (BIT(TRIGGER_NETDEV_LINK_2500) | BIT(TRIGGER_NETDEV_LINK)))
|
|
val |= VEND1_GLOBAL_LED_PROV_LINK2500;
|
|
|
|
if (rules & (BIT(TRIGGER_NETDEV_LINK_5000) | BIT(TRIGGER_NETDEV_LINK)))
|
|
val |= VEND1_GLOBAL_LED_PROV_LINK5000;
|
|
|
|
if (rules & (BIT(TRIGGER_NETDEV_LINK_10000) | BIT(TRIGGER_NETDEV_LINK)))
|
|
val |= VEND1_GLOBAL_LED_PROV_LINK10000;
|
|
|
|
if (rules & BIT(TRIGGER_NETDEV_RX))
|
|
val |= VEND1_GLOBAL_LED_PROV_RX_ACT;
|
|
|
|
if (rules & BIT(TRIGGER_NETDEV_TX))
|
|
val |= VEND1_GLOBAL_LED_PROV_TX_ACT;
|
|
|
|
return phy_modify_mmd(phydev, MDIO_MMD_VEND1, AQR_LED_PROV(index),
|
|
VEND1_GLOBAL_LED_PROV_LINK_MASK |
|
|
VEND1_GLOBAL_LED_PROV_FORCE_ON |
|
|
VEND1_GLOBAL_LED_PROV_RX_ACT |
|
|
VEND1_GLOBAL_LED_PROV_TX_ACT, val);
|
|
}
|
|
|
|
int aqr_phy_led_active_low_set(struct phy_device *phydev, int index, bool enable)
|
|
{
|
|
return phy_modify_mmd(phydev, MDIO_MMD_VEND1, AQR_LED_DRIVE(index),
|
|
VEND1_GLOBAL_LED_DRIVE_VDD,
|
|
enable ? 0 : VEND1_GLOBAL_LED_DRIVE_VDD);
|
|
}
|
|
|
|
int aqr_phy_led_polarity_set(struct phy_device *phydev, int index, unsigned long modes)
|
|
{
|
|
bool force_active_low = false, force_active_high = false;
|
|
struct aqr107_priv *priv = phydev->priv;
|
|
u32 mode;
|
|
|
|
if (index >= AQR_MAX_LEDS)
|
|
return -EINVAL;
|
|
|
|
for_each_set_bit(mode, &modes, __PHY_LED_MODES_NUM) {
|
|
switch (mode) {
|
|
case PHY_LED_ACTIVE_LOW:
|
|
force_active_low = true;
|
|
break;
|
|
case PHY_LED_ACTIVE_HIGH:
|
|
force_active_high = true;
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
}
|
|
|
|
/* Save LED driver vdd state to restore on SW reset */
|
|
if (force_active_low)
|
|
priv->leds_active_low |= BIT(index);
|
|
|
|
if (force_active_high)
|
|
priv->leds_active_high |= BIT(index);
|
|
|
|
if (force_active_high || force_active_low)
|
|
return aqr_phy_led_active_low_set(phydev, index, force_active_low);
|
|
|
|
return -EINVAL;
|
|
}
|