[net-next,v4,05/14] net: phy: phy_device: Call into the PHY driver to set LED brightness
Commit Message
From: Andrew Lunn <andrew@lunn.ch>
Linux LEDs can be software controlled via the brightness file in /sys.
LED drivers need to implement a brightness_set function which the core
will call. Implement an intermediary in phy_device, which will call
into the phy driver if it implements the necessary function.
Signed-off-by: Andrew Lunn <andrew@lunn.ch>
Signed-off-by: Christian Marangi <ansuelsmth@gmail.com>
---
drivers/net/phy/phy_device.c | 15 ++++++++++++---
include/linux/phy.h | 11 +++++++++++
2 files changed, 23 insertions(+), 3 deletions(-)
Comments
On Fri, Mar 17, 2023 at 03:31:16AM +0100, Christian Marangi wrote:
> From: Andrew Lunn <andrew@lunn.ch>
>
> Linux LEDs can be software controlled via the brightness file in /sys.
> LED drivers need to implement a brightness_set function which the core
> will call. Implement an intermediary in phy_device, which will call
> into the phy driver if it implements the necessary function.
>
> Signed-off-by: Andrew Lunn <andrew@lunn.ch>
> Signed-off-by: Christian Marangi <ansuelsmth@gmail.com>
> ---
As I have already mentioned in my comments for the patch 4, the final
version of "phy_led_set_brightness()" can appear here (without
an intermediate step with a dummy implementation).
Thanks,
Michal
> drivers/net/phy/phy_device.c | 15 ++++++++++++---
> include/linux/phy.h | 11 +++++++++++
> 2 files changed, 23 insertions(+), 3 deletions(-)
>
> diff --git a/drivers/net/phy/phy_device.c b/drivers/net/phy/phy_device.c
> index ee800f93c8c3..c7312a9e820d 100644
> --- a/drivers/net/phy/phy_device.c
> +++ b/drivers/net/phy/phy_device.c
> @@ -2967,11 +2967,18 @@ static bool phy_drv_supports_irq(struct phy_driver *phydrv)
> return phydrv->config_intr && phydrv->handle_interrupt;
> }
>
> -/* Dummy implementation until calls into PHY driver are added */
> static int phy_led_set_brightness(struct led_classdev *led_cdev,
> enum led_brightness value)
> {
> - return 0;
> + struct phy_led *phyled = to_phy_led(led_cdev);
> + struct phy_device *phydev = phyled->phydev;
> + int err;
> +
> + mutex_lock(&phydev->lock);
> + err = phydev->drv->led_brightness_set(phydev, phyled->index, value);
> + mutex_unlock(&phydev->lock);
> +
> + return err;
> }
>
> static int of_phy_led(struct phy_device *phydev,
> @@ -2988,12 +2995,14 @@ static int of_phy_led(struct phy_device *phydev,
> return -ENOMEM;
>
> cdev = &phyled->led_cdev;
> + phyled->phydev = phydev;
>
> err = of_property_read_u32(led, "reg", &phyled->index);
> if (err)
> return err;
>
> - cdev->brightness_set_blocking = phy_led_set_brightness;
> + if (phydev->drv->led_brightness_set)
> + cdev->brightness_set_blocking = phy_led_set_brightness;
> cdev->max_brightness = 1;
> init_data.devicename = dev_name(&phydev->mdio.dev);
> init_data.fwnode = of_fwnode_handle(led);
> diff --git a/include/linux/phy.h b/include/linux/phy.h
> index 88a77ff60be9..94fd21d5e145 100644
> --- a/include/linux/phy.h
> +++ b/include/linux/phy.h
> @@ -832,15 +832,19 @@ struct phy_plca_status {
> * struct phy_led: An LED driven by the PHY
> *
> * @list: List of LEDs
> + * @phydev: PHY this LED is attached to
> * @led_cdev: Standard LED class structure
> * @index: Number of the LED
> */
> struct phy_led {
> struct list_head list;
> + struct phy_device *phydev;
> struct led_classdev led_cdev;
> u32 index;
> };
>
> +#define to_phy_led(d) container_of(d, struct phy_led, led_cdev)
> +
> /**
> * struct phy_driver - Driver structure for a particular PHY type
> *
> @@ -1063,6 +1067,13 @@ struct phy_driver {
> /** @get_plca_status: Return the current PLCA status info */
> int (*get_plca_status)(struct phy_device *dev,
> struct phy_plca_status *plca_st);
> +
> + /* Set a PHY LED brightness. Index indicates which of the PHYs
> + * led should be set. Value follows the standard LED class meaning,
> + * e.g. LED_OFF, LED_HALF, LED_FULL.
> + */
> + int (*led_brightness_set)(struct phy_device *dev,
> + u32 index, enum led_brightness value);
> };
> #define to_phy_driver(d) container_of(to_mdio_common_driver(d), \
> struct phy_driver, mdiodrv)
> --
> 2.39.2
>
@@ -2967,11 +2967,18 @@ static bool phy_drv_supports_irq(struct phy_driver *phydrv)
return phydrv->config_intr && phydrv->handle_interrupt;
}
-/* Dummy implementation until calls into PHY driver are added */
static int phy_led_set_brightness(struct led_classdev *led_cdev,
enum led_brightness value)
{
- return 0;
+ struct phy_led *phyled = to_phy_led(led_cdev);
+ struct phy_device *phydev = phyled->phydev;
+ int err;
+
+ mutex_lock(&phydev->lock);
+ err = phydev->drv->led_brightness_set(phydev, phyled->index, value);
+ mutex_unlock(&phydev->lock);
+
+ return err;
}
static int of_phy_led(struct phy_device *phydev,
@@ -2988,12 +2995,14 @@ static int of_phy_led(struct phy_device *phydev,
return -ENOMEM;
cdev = &phyled->led_cdev;
+ phyled->phydev = phydev;
err = of_property_read_u32(led, "reg", &phyled->index);
if (err)
return err;
- cdev->brightness_set_blocking = phy_led_set_brightness;
+ if (phydev->drv->led_brightness_set)
+ cdev->brightness_set_blocking = phy_led_set_brightness;
cdev->max_brightness = 1;
init_data.devicename = dev_name(&phydev->mdio.dev);
init_data.fwnode = of_fwnode_handle(led);
@@ -832,15 +832,19 @@ struct phy_plca_status {
* struct phy_led: An LED driven by the PHY
*
* @list: List of LEDs
+ * @phydev: PHY this LED is attached to
* @led_cdev: Standard LED class structure
* @index: Number of the LED
*/
struct phy_led {
struct list_head list;
+ struct phy_device *phydev;
struct led_classdev led_cdev;
u32 index;
};
+#define to_phy_led(d) container_of(d, struct phy_led, led_cdev)
+
/**
* struct phy_driver - Driver structure for a particular PHY type
*
@@ -1063,6 +1067,13 @@ struct phy_driver {
/** @get_plca_status: Return the current PLCA status info */
int (*get_plca_status)(struct phy_device *dev,
struct phy_plca_status *plca_st);
+
+ /* Set a PHY LED brightness. Index indicates which of the PHYs
+ * led should be set. Value follows the standard LED class meaning,
+ * e.g. LED_OFF, LED_HALF, LED_FULL.
+ */
+ int (*led_brightness_set)(struct phy_device *dev,
+ u32 index, enum led_brightness value);
};
#define to_phy_driver(d) container_of(to_mdio_common_driver(d), \
struct phy_driver, mdiodrv)