On Monday 07 June 2021 16:34:48 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@nic.cz
Reviewed-by: Pali Rohár pali@kernel.org
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@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 { /*
-- 2.31.1