[PATCH u-boot-marvell v2 3/6] arm: mvebu: turris_mox: start blinking PHY LEDs when entering rescue

[Stefan Roese]

On 07.06.21 16:34, Marek Behún wrote:
> Configure blinking on ethernet PHY LEDs on the MOX A board when entering
> rescue mode via reset button.
> 
> Signed-off-by: Marek Behún <marek.behun at nic.cz>

Reviewed-by: Stefan Roese <sr at denx.de>

Thanks,
Stefan

> ---
>   board/CZ.NIC/turris_mox/turris_mox.c | 35 ++++++++++++++++++++++++++++
>   1 file changed, 35 insertions(+)
> 
> diff --git a/board/CZ.NIC/turris_mox/turris_mox.c b/board/CZ.NIC/turris_mox/turris_mox.c
> index a78f33661e..44c272c7cb 100644
> --- a/board/CZ.NIC/turris_mox/turris_mox.c
> +++ b/board/CZ.NIC/turris_mox/turris_mox.c
> @@ -377,6 +377,38 @@ int misc_init_r(void)
>   	return 0;
>   }
>   
> +static void mox_phy_modify(struct phy_device *phydev, int page, int reg,
> +			   u16 mask, u16 set)
> +{
> +	int val;
> +
> +	val = phydev->drv->readext(phydev, MDIO_DEVAD_NONE, page, reg);
> +	val &= ~mask;
> +	val |= set;
> +	phydev->drv->writeext(phydev, MDIO_DEVAD_NONE, page, reg, val);
> +}
> +
> +static void mox_phy_leds_start_blinking(void)
> +{
> +	struct phy_device *phydev;
> +	struct mii_dev *bus;
> +
> +	bus = miiphy_get_dev_by_name("neta at 30000");
> +	if (!bus) {
> +		printf("Cannot get MDIO bus device!\n");
> +		return;
> +	}
> +
> +	phydev = phy_find_by_mask(bus, BIT(1), PHY_INTERFACE_MODE_RGMII);
> +	if (!phydev) {
> +		printf("Cannot get ethernet PHY!\n");
> +		return;
> +	}
> +
> +	mox_phy_modify(phydev, 3, 0x12, 0x700, 0x400);
> +	mox_phy_modify(phydev, 3, 0x10, 0xff, 0xbb);
> +}
> +
>   static bool read_reset_button(void)
>   {
>   	struct udevice *button, *led;
> @@ -424,6 +456,9 @@ static void handle_reset_button(void)
>   		/* Ensure bootcmd_rescue is used by distroboot */
>   		env_set("boot_targets", "rescue");
>   
> +		/* start blinking PHY LEDs */
> +		mox_phy_leds_start_blinking();
> +
>   		printf("RESET button was pressed, overwriting boot_targets!\n");
>   	} else {
>   		/*
> 


Viele Grüße,
Stefan

-- 
DENX Software Engineering GmbH,      Managing Director: Wolfgang Denk
HRB 165235 Munich, Office: Kirchenstr.5, D-82194 Groebenzell, Germany
Phone: (+49)-8142-66989-51 Fax: (+49)-8142-66989-80 Email: sr at denx.de