mirror of
https://github.com/Ysurac/openmptcprouter.git
synced 2025-03-09 15:40:20 +00:00
72 lines
2.3 KiB
Diff
72 lines
2.3 KiB
Diff
From a32256581a6be7e3315af44802ae217f1816af8c Mon Sep 17 00:00:00 2001
|
|
From: Phil Elwell <phil@raspberrypi.org>
|
|
Date: Wed, 21 Mar 2018 15:59:26 +0000
|
|
Subject: [PATCH 280/297] 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: Phil Elwell <phil@raspberrypi.org>
|
|
---
|
|
drivers/net/usb/lan78xx.c | 27 +++++++++++++++++++--------
|
|
1 file changed, 19 insertions(+), 8 deletions(-)
|
|
|
|
diff --git a/drivers/net/usb/lan78xx.c b/drivers/net/usb/lan78xx.c
|
|
index 53c6dbaf8425..52593368a48d 100644
|
|
--- a/drivers/net/usb/lan78xx.c
|
|
+++ b/drivers/net/usb/lan78xx.c
|
|
@@ -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);
|
|
|
|
--
|
|
2.16.1
|
|
|