1// SPDX-License-Identifier: GPL-2.0-only
 2/*
 3 * Kernel Panic LED Trigger
 4 *
 5 * Copyright 2016 Ezequiel Garcia <ezequiel@vanguardiasur.com.ar>
 
 
 
 
 
 6 */
 7
 8#include <linux/kernel.h>
 9#include <linux/init.h>
10#include <linux/notifier.h>
11#include <linux/panic_notifier.h>
12#include <linux/leds.h>
13#include "../leds.h"
14
15static struct led_trigger *trigger;
16
17/*
18 * This is called in a special context by the atomic panic
19 * notifier. This means the trigger can be changed without
20 * worrying about locking.
21 */
22static void led_trigger_set_panic(struct led_classdev *led_cdev)
23{
24	struct led_trigger *trig;
25
26	list_for_each_entry(trig, &trigger_list, next_trig) {
27		if (strcmp("panic", trig->name))
28			continue;
29		if (led_cdev->trigger)
30			list_del(&led_cdev->trig_list);
31		list_add_tail(&led_cdev->trig_list, &trig->led_cdevs);
32
33		/* Avoid the delayed blink path */
34		led_cdev->blink_delay_on = 0;
35		led_cdev->blink_delay_off = 0;
36
37		led_cdev->trigger = trig;
38		if (trig->activate)
39			trig->activate(led_cdev);
40		break;
41	}
42}
43
44static int led_trigger_panic_notifier(struct notifier_block *nb,
45				      unsigned long code, void *unused)
46{
47	struct led_classdev *led_cdev;
48
49	list_for_each_entry(led_cdev, &leds_list, node)
50		if (led_cdev->flags & LED_PANIC_INDICATOR)
51			led_trigger_set_panic(led_cdev);
52	return NOTIFY_DONE;
53}
54
55static struct notifier_block led_trigger_panic_nb = {
56	.notifier_call = led_trigger_panic_notifier,
57};
58
59static long led_panic_blink(int state)
60{
61	led_trigger_event(trigger, state ? LED_FULL : LED_OFF);
62	return 0;
63}
64
65static int __init ledtrig_panic_init(void)
66{
67	led_trigger_register_simple("panic", &trigger);
68	if (!trigger)
69		return -ENOMEM;
70
71	atomic_notifier_chain_register(&panic_notifier_list,
72				       &led_trigger_panic_nb);
73
 
74	panic_blink = led_panic_blink;
75	return 0;
76}
77device_initcall(ledtrig_panic_init);

 
 1/*
 2 * Kernel Panic LED Trigger
 3 *
 4 * Copyright 2016 Ezequiel Garcia <ezequiel@vanguardiasur.com.ar>
 5 *
 6 * This program is free software; you can redistribute it and/or modify
 7 * it under the terms of the GNU General Public License version 2 as
 8 * published by the Free Software Foundation.
 9 *
10 */
11
12#include <linux/kernel.h>
13#include <linux/init.h>
14#include <linux/notifier.h>
 
15#include <linux/leds.h>
16#include "../leds.h"
17
18static struct led_trigger *trigger;
19
20/*
21 * This is called in a special context by the atomic panic
22 * notifier. This means the trigger can be changed without
23 * worrying about locking.
24 */
25static void led_trigger_set_panic(struct led_classdev *led_cdev)
26{
27	struct led_trigger *trig;
28
29	list_for_each_entry(trig, &trigger_list, next_trig) {
30		if (strcmp("panic", trig->name))
31			continue;
32		if (led_cdev->trigger)
33			list_del(&led_cdev->trig_list);
34		list_add_tail(&led_cdev->trig_list, &trig->led_cdevs);
35
36		/* Avoid the delayed blink path */
37		led_cdev->blink_delay_on = 0;
38		led_cdev->blink_delay_off = 0;
39
40		led_cdev->trigger = trig;
41		if (trig->activate)
42			trig->activate(led_cdev);
43		break;
44	}
45}
46
47static int led_trigger_panic_notifier(struct notifier_block *nb,
48				      unsigned long code, void *unused)
49{
50	struct led_classdev *led_cdev;
51
52	list_for_each_entry(led_cdev, &leds_list, node)
53		if (led_cdev->flags & LED_PANIC_INDICATOR)
54			led_trigger_set_panic(led_cdev);
55	return NOTIFY_DONE;
56}
57
58static struct notifier_block led_trigger_panic_nb = {
59	.notifier_call = led_trigger_panic_notifier,
60};
61
62static long led_panic_blink(int state)
63{
64	led_trigger_event(trigger, state ? LED_FULL : LED_OFF);
65	return 0;
66}
67
68static int __init ledtrig_panic_init(void)
69{
 
 
 
 
70	atomic_notifier_chain_register(&panic_notifier_list,
71				       &led_trigger_panic_nb);
72
73	led_trigger_register_simple("panic", &trigger);
74	panic_blink = led_panic_blink;
75	return 0;
76}
77device_initcall(ledtrig_panic_init);