can: add combined rx/tx LED trigger support

Add <ifname>-rxtx trigger, that will be activated both for tx
as rx events. This trigger mimics "activity" LED for Ethernet
devices.

Signed-off-by: Yegor Yefremov <yegorslists@googlemail.com>
Signed-off-by: Marc Kleine-Budde <mkl@pengutronix.de>

diff --git a/drivers/net/can/led.c b/drivers/net/can/led.c
index ab7f1b0..c1b6676 100644 (file)
--- a/drivers/net/can/led.c
+++ b/drivers/net/can/led.c
@@ -30,20 +30,28 @@ void can_led_event(struct net_device *netdev, enum can_led_event event)
        case CAN_LED_EVENT_OPEN:
                led_trigger_event(priv->tx_led_trig, LED_FULL);
                led_trigger_event(priv->rx_led_trig, LED_FULL);
+               led_trigger_event(priv->rxtx_led_trig, LED_FULL);
                break;
        case CAN_LED_EVENT_STOP:
                led_trigger_event(priv->tx_led_trig, LED_OFF);
                led_trigger_event(priv->rx_led_trig, LED_OFF);
+               led_trigger_event(priv->rxtx_led_trig, LED_OFF);
                break;
        case CAN_LED_EVENT_TX:
-               if (led_delay)
+               if (led_delay) {
                        led_trigger_blink_oneshot(priv->tx_led_trig,
                                                  &led_delay, &led_delay, 1);
+                       led_trigger_blink_oneshot(priv->rxtx_led_trig,
+                                                 &led_delay, &led_delay, 1);
+               }
                break;
        case CAN_LED_EVENT_RX:
-               if (led_delay)
+               if (led_delay) {
                        led_trigger_blink_oneshot(priv->rx_led_trig,
                                                  &led_delay, &led_delay, 1);
+                       led_trigger_blink_oneshot(priv->rxtx_led_trig,
+                                                 &led_delay, &led_delay, 1);
+               }
                break;
        }
 }
@@ -55,6 +63,7 @@ static void can_led_release(struct device *gendev, void *res)
 
        led_trigger_unregister_simple(priv->tx_led_trig);
        led_trigger_unregister_simple(priv->rx_led_trig);
+       led_trigger_unregister_simple(priv->rxtx_led_trig);
 }
 
 /* Register CAN LED triggers for a CAN device
@@ -76,11 +85,15 @@ void devm_can_led_init(struct net_device *netdev)
                 "%s-tx", netdev->name);
        snprintf(priv->rx_led_trig_name, sizeof(priv->rx_led_trig_name),
                 "%s-rx", netdev->name);
+       snprintf(priv->rxtx_led_trig_name, sizeof(priv->rxtx_led_trig_name),
+                "%s-rxtx", netdev->name);
 
        led_trigger_register_simple(priv->tx_led_trig_name,
                                    &priv->tx_led_trig);
        led_trigger_register_simple(priv->rx_led_trig_name,
                                    &priv->rx_led_trig);
+       led_trigger_register_simple(priv->rxtx_led_trig_name,
+                                   &priv->rxtx_led_trig);
 
        devres_add(&netdev->dev, res);
 }
@@ -97,7 +110,7 @@ static int can_led_notifier(struct notifier_block *nb, unsigned long msg,
        if (!priv)
                return NOTIFY_DONE;
 
-       if (!priv->tx_led_trig || !priv->rx_led_trig)
+       if (!priv->tx_led_trig || !priv->rx_led_trig || !priv->rxtx_led_trig)
                return NOTIFY_DONE;
 
        if (msg == NETDEV_CHANGENAME) {
@@ -106,6 +119,9 @@ static int can_led_notifier(struct notifier_block *nb, unsigned long msg,
 
                snprintf(name, sizeof(name), "%s-rx", netdev->name);
                led_trigger_rename_static(name, priv->rx_led_trig);
+
+               snprintf(name, sizeof(name), "%s-rxtx", netdev->name);
+               led_trigger_rename_static(name, priv->rxtx_led_trig);
        }
 
        return NOTIFY_DONE;

diff --git a/include/linux/can/dev.h b/include/linux/can/dev.h
index c05ff0f..c3a9c8f 100644 (file)
--- a/include/linux/can/dev.h
+++ b/include/linux/can/dev.h
@@ -61,6 +61,8 @@ struct can_priv {
        char tx_led_trig_name[CAN_LED_NAME_SZ];
        struct led_trigger *rx_led_trig;
        char rx_led_trig_name[CAN_LED_NAME_SZ];
+       struct led_trigger *rxtx_led_trig;
+       char rxtx_led_trig_name[CAN_LED_NAME_SZ];
 #endif
 };
 

diff --git a/include/linux/can/led.h b/include/linux/can/led.h
index e0475c5..146de45 100644 (file)
--- a/include/linux/can/led.h
+++ b/include/linux/can/led.h
@@ -21,8 +21,10 @@ enum can_led_event {
 
 #ifdef CONFIG_CAN_LEDS
 
-/* keep space for interface name + "-tx"/"-rx" suffix and null terminator */
-#define CAN_LED_NAME_SZ (IFNAMSIZ + 4)
+/* keep space for interface name + "-tx"/"-rx"/"-rxtx"
+ * suffix and null terminator
+ */
+#define CAN_LED_NAME_SZ (IFNAMSIZ + 6)
 
 void can_led_event(struct net_device *netdev, enum can_led_event event);
 void devm_can_led_init(struct net_device *netdev);