Commit a3225658 authored by Phil Elwell's avatar Phil Elwell
Browse files

lan78xx: Read LED states from Device Tree 



Add support for DT property "microchip,led-modes", a vector of two
cells (u32s) in the range 0-15, each of which sets the mode for one
of the two LEDs. The possible values are:

    0=link/activity          1=link1000/activity
    2=link100/activity       3=link10/activity
    4=link100/1000/activity  5=link10/1000/activity
    6=link10/100/activity    14=off    15=on

Signed-off-by: default avatarPhil Elwell <phil@raspberrypi.org>
parent 69c1d8b4

drivers/net/usb/lan78xx.c

+19 −8
Original line number Diff line number Diff line
@@ -2017,7 +2017,9 @@ static int lan78xx_phy_init(struct lan78xx_net *dev) 
{

	int ret;

	u32 mii_adv;

	u32 led_modes;

	u32 led_modes[2];

	u32 led_modes_reg;

	int i;

	struct phy_device *phydev = dev->net->phydev;



	phydev = phy_find_first(dev->mdiobus);
@@ -2090,18 +2092,27 @@ static int lan78xx_phy_init(struct lan78xx_net *dev) 
	mii_adv = (u32)mii_advertise_flowctrl(dev->fc_request_control);

	phydev->advertising |= mii_adv_to_ethtool_adv_t(mii_adv);



	/* Change LED defaults:

	 *   orange = link1000/activity

	 *   green  = link10/link100/activity

	/* Set LED modes:

	 * led: 0=link/activity          1=link1000/activity

	 *      2=link100/activity       3=link10/activity

	 *      4=link100/1000/activity  5=link10/1000/activity

	 *      6=link10/100/activity    14=off    15=on

	 */

	led_modes = phy_read(phydev, 0x1d);

	led_modes &= ~0xff;

	led_modes |= (1 << 0) | (6 << 4);

	(void)phy_write(phydev, 0x1d, led_modes);



	memset(led_modes, ~0, sizeof(led_modes));



	of_property_read_u32_array(dev->udev->dev.of_node,

				   "microchip,led-modes",

				   led_modes, ARRAY_SIZE(led_modes));



	led_modes_reg = phy_read(phydev, 0x1d);

	for (i = 0; i < ARRAY_SIZE(led_modes); i++) {

		if (led_modes[i] != ~0) {

			led_modes_reg &= ~(0xf << (i * 4));

			led_modes_reg |= (led_modes[i] & 0xf) << (i * 4);

		}

	}

	(void)phy_write(phydev, 0x1d, led_modes_reg);



	genphy_config_aneg(phydev);