^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Copyright 2012, Fabio Baltieri <fabio.baltieri@gmail.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * Copyright 2012, Kurt Van Dijck <kurt.van.dijck@eia.be>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/netdevice.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/can/dev.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/can/led.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) static unsigned long led_delay = 50;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) module_param(led_delay, ulong, 0644);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) MODULE_PARM_DESC(led_delay,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) "blink delay time for activity leds (msecs, default: 50).");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) /* Trigger a LED event in response to a CAN device event */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) void can_led_event(struct net_device *netdev, enum can_led_event event)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) struct can_priv *priv = netdev_priv(netdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) switch (event) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) case CAN_LED_EVENT_OPEN:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) led_trigger_event(priv->tx_led_trig, LED_FULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) led_trigger_event(priv->rx_led_trig, LED_FULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) led_trigger_event(priv->rxtx_led_trig, LED_FULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) case CAN_LED_EVENT_STOP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) led_trigger_event(priv->tx_led_trig, LED_OFF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) led_trigger_event(priv->rx_led_trig, LED_OFF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) led_trigger_event(priv->rxtx_led_trig, LED_OFF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) case CAN_LED_EVENT_TX:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) if (led_delay) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) led_trigger_blink_oneshot(priv->tx_led_trig,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) &led_delay, &led_delay, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) led_trigger_blink_oneshot(priv->rxtx_led_trig,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) &led_delay, &led_delay, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) case CAN_LED_EVENT_RX:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) if (led_delay) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) led_trigger_blink_oneshot(priv->rx_led_trig,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) &led_delay, &led_delay, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) led_trigger_blink_oneshot(priv->rxtx_led_trig,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) &led_delay, &led_delay, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) EXPORT_SYMBOL_GPL(can_led_event);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) static void can_led_release(struct device *gendev, void *res)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) struct can_priv *priv = netdev_priv(to_net_dev(gendev));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) led_trigger_unregister_simple(priv->tx_led_trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) led_trigger_unregister_simple(priv->rx_led_trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) led_trigger_unregister_simple(priv->rxtx_led_trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) /* Register CAN LED triggers for a CAN device
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) * This is normally called from a driver's probe function
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) void devm_can_led_init(struct net_device *netdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) struct can_priv *priv = netdev_priv(netdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) void *res;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) res = devres_alloc(can_led_release, 0, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) if (!res) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) netdev_err(netdev, "cannot register LED triggers\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) snprintf(priv->tx_led_trig_name, sizeof(priv->tx_led_trig_name),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) "%s-tx", netdev->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) snprintf(priv->rx_led_trig_name, sizeof(priv->rx_led_trig_name),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) "%s-rx", netdev->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) snprintf(priv->rxtx_led_trig_name, sizeof(priv->rxtx_led_trig_name),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) "%s-rxtx", netdev->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) led_trigger_register_simple(priv->tx_led_trig_name,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) &priv->tx_led_trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) led_trigger_register_simple(priv->rx_led_trig_name,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) &priv->rx_led_trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) led_trigger_register_simple(priv->rxtx_led_trig_name,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) &priv->rxtx_led_trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) devres_add(&netdev->dev, res);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) EXPORT_SYMBOL_GPL(devm_can_led_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) /* NETDEV rename notifier to rename the associated led triggers too */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) static int can_led_notifier(struct notifier_block *nb, unsigned long msg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) void *ptr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) struct net_device *netdev = netdev_notifier_info_to_dev(ptr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) struct can_priv *priv = safe_candev_priv(netdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) char name[CAN_LED_NAME_SZ];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) if (!priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) return NOTIFY_DONE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) if (!priv->tx_led_trig || !priv->rx_led_trig || !priv->rxtx_led_trig)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) return NOTIFY_DONE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) if (msg == NETDEV_CHANGENAME) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) snprintf(name, sizeof(name), "%s-tx", netdev->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) led_trigger_rename_static(name, priv->tx_led_trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) snprintf(name, sizeof(name), "%s-rx", netdev->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) led_trigger_rename_static(name, priv->rx_led_trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) snprintf(name, sizeof(name), "%s-rxtx", netdev->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) led_trigger_rename_static(name, priv->rxtx_led_trig);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) return NOTIFY_DONE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) /* notifier block for netdevice event */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) static struct notifier_block can_netdev_notifier __read_mostly = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) .notifier_call = can_led_notifier,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) int __init can_led_notifier_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) return register_netdevice_notifier(&can_netdev_notifier);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) void __exit can_led_notifier_exit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) unregister_netdevice_notifier(&can_netdev_notifier);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) }
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags
| Donate