blob: db14897f8e16a59db54f9c27723fc31d27923e47 [file] [log] [blame]
Thomas Gleixnerd2912cb2019-06-04 10:11:33 +02001// SPDX-License-Identifier: GPL-2.0-only
Fabio Baltieri996a9532012-12-18 18:50:55 +01002/*
3 * Copyright 2012, Fabio Baltieri <fabio.baltieri@gmail.com>
Kurt Van Dijcka1ef7bd2012-12-18 18:50:57 +01004 * Copyright 2012, Kurt Van Dijck <kurt.van.dijck@eia.be>
Fabio Baltieri996a9532012-12-18 18:50:55 +01005 */
6
7#include <linux/module.h>
8#include <linux/device.h>
9#include <linux/kernel.h>
10#include <linux/slab.h>
11#include <linux/netdevice.h>
12#include <linux/can/dev.h>
13
14#include <linux/can/led.h>
15
16static unsigned long led_delay = 50;
17module_param(led_delay, ulong, 0644);
18MODULE_PARM_DESC(led_delay,
19 "blink delay time for activity leds (msecs, default: 50).");
20
21/* Trigger a LED event in response to a CAN device event */
22void can_led_event(struct net_device *netdev, enum can_led_event event)
23{
24 struct can_priv *priv = netdev_priv(netdev);
25
26 switch (event) {
27 case CAN_LED_EVENT_OPEN:
28 led_trigger_event(priv->tx_led_trig, LED_FULL);
29 led_trigger_event(priv->rx_led_trig, LED_FULL);
Yegor Yefremovc54eb702015-03-16 09:38:13 +010030 led_trigger_event(priv->rxtx_led_trig, LED_FULL);
Fabio Baltieri996a9532012-12-18 18:50:55 +010031 break;
32 case CAN_LED_EVENT_STOP:
33 led_trigger_event(priv->tx_led_trig, LED_OFF);
34 led_trigger_event(priv->rx_led_trig, LED_OFF);
Yegor Yefremovc54eb702015-03-16 09:38:13 +010035 led_trigger_event(priv->rxtx_led_trig, LED_OFF);
Fabio Baltieri996a9532012-12-18 18:50:55 +010036 break;
37 case CAN_LED_EVENT_TX:
Yegor Yefremovc54eb702015-03-16 09:38:13 +010038 if (led_delay) {
Fabio Baltieri996a9532012-12-18 18:50:55 +010039 led_trigger_blink_oneshot(priv->tx_led_trig,
40 &led_delay, &led_delay, 1);
Yegor Yefremovc54eb702015-03-16 09:38:13 +010041 led_trigger_blink_oneshot(priv->rxtx_led_trig,
42 &led_delay, &led_delay, 1);
43 }
Fabio Baltieri996a9532012-12-18 18:50:55 +010044 break;
45 case CAN_LED_EVENT_RX:
Yegor Yefremovc54eb702015-03-16 09:38:13 +010046 if (led_delay) {
Fabio Baltieri996a9532012-12-18 18:50:55 +010047 led_trigger_blink_oneshot(priv->rx_led_trig,
48 &led_delay, &led_delay, 1);
Yegor Yefremovc54eb702015-03-16 09:38:13 +010049 led_trigger_blink_oneshot(priv->rxtx_led_trig,
50 &led_delay, &led_delay, 1);
51 }
Fabio Baltieri996a9532012-12-18 18:50:55 +010052 break;
53 }
54}
55EXPORT_SYMBOL_GPL(can_led_event);
56
57static void can_led_release(struct device *gendev, void *res)
58{
59 struct can_priv *priv = netdev_priv(to_net_dev(gendev));
60
61 led_trigger_unregister_simple(priv->tx_led_trig);
62 led_trigger_unregister_simple(priv->rx_led_trig);
Yegor Yefremovc54eb702015-03-16 09:38:13 +010063 led_trigger_unregister_simple(priv->rxtx_led_trig);
Fabio Baltieri996a9532012-12-18 18:50:55 +010064}
65
66/* Register CAN LED triggers for a CAN device
67 *
68 * This is normally called from a driver's probe function
69 */
70void devm_can_led_init(struct net_device *netdev)
71{
72 struct can_priv *priv = netdev_priv(netdev);
73 void *res;
74
75 res = devres_alloc(can_led_release, 0, GFP_KERNEL);
76 if (!res) {
77 netdev_err(netdev, "cannot register LED triggers\n");
78 return;
79 }
80
81 snprintf(priv->tx_led_trig_name, sizeof(priv->tx_led_trig_name),
82 "%s-tx", netdev->name);
83 snprintf(priv->rx_led_trig_name, sizeof(priv->rx_led_trig_name),
84 "%s-rx", netdev->name);
Yegor Yefremovc54eb702015-03-16 09:38:13 +010085 snprintf(priv->rxtx_led_trig_name, sizeof(priv->rxtx_led_trig_name),
86 "%s-rxtx", netdev->name);
Fabio Baltieri996a9532012-12-18 18:50:55 +010087
88 led_trigger_register_simple(priv->tx_led_trig_name,
89 &priv->tx_led_trig);
90 led_trigger_register_simple(priv->rx_led_trig_name,
91 &priv->rx_led_trig);
Yegor Yefremovc54eb702015-03-16 09:38:13 +010092 led_trigger_register_simple(priv->rxtx_led_trig_name,
93 &priv->rxtx_led_trig);
Fabio Baltieri996a9532012-12-18 18:50:55 +010094
95 devres_add(&netdev->dev, res);
96}
97EXPORT_SYMBOL_GPL(devm_can_led_init);
Kurt Van Dijcka1ef7bd2012-12-18 18:50:57 +010098
99/* NETDEV rename notifier to rename the associated led triggers too */
100static int can_led_notifier(struct notifier_block *nb, unsigned long msg,
Jiri Pirko351638e2013-05-28 01:30:21 +0000101 void *ptr)
Kurt Van Dijcka1ef7bd2012-12-18 18:50:57 +0100102{
Jiri Pirko351638e2013-05-28 01:30:21 +0000103 struct net_device *netdev = netdev_notifier_info_to_dev(ptr);
Kurt Van Dijcka1ef7bd2012-12-18 18:50:57 +0100104 struct can_priv *priv = safe_candev_priv(netdev);
105 char name[CAN_LED_NAME_SZ];
106
107 if (!priv)
108 return NOTIFY_DONE;
109
Yegor Yefremovc54eb702015-03-16 09:38:13 +0100110 if (!priv->tx_led_trig || !priv->rx_led_trig || !priv->rxtx_led_trig)
Oliver Hartkopp45fb4f82014-05-27 13:30:56 +0200111 return NOTIFY_DONE;
112
Kurt Van Dijcka1ef7bd2012-12-18 18:50:57 +0100113 if (msg == NETDEV_CHANGENAME) {
114 snprintf(name, sizeof(name), "%s-tx", netdev->name);
115 led_trigger_rename_static(name, priv->tx_led_trig);
116
117 snprintf(name, sizeof(name), "%s-rx", netdev->name);
118 led_trigger_rename_static(name, priv->rx_led_trig);
Yegor Yefremovc54eb702015-03-16 09:38:13 +0100119
120 snprintf(name, sizeof(name), "%s-rxtx", netdev->name);
121 led_trigger_rename_static(name, priv->rxtx_led_trig);
Kurt Van Dijcka1ef7bd2012-12-18 18:50:57 +0100122 }
123
124 return NOTIFY_DONE;
125}
126
127/* notifier block for netdevice event */
128static struct notifier_block can_netdev_notifier __read_mostly = {
129 .notifier_call = can_led_notifier,
130};
131
132int __init can_led_notifier_init(void)
133{
134 return register_netdevice_notifier(&can_netdev_notifier);
135}
136
137void __exit can_led_notifier_exit(void)
138{
139 unregister_netdevice_notifier(&can_netdev_notifier);
140}