1 /* 2 * Backlight emulation LED trigger 3 * 4 * Copyright 2008 (C) Rodolfo Giometti <giometti@linux.it> 5 * Copyright 2008 (C) Eurotech S.p.A. <info@eurotech.it> 6 * 7 * This program is free software; you can redistribute it and/or modify 8 * it under the terms of the GNU General Public License version 2 as 9 * published by the Free Software Foundation. 10 * 11 */ 12 13 #include <linux/module.h> 14 #include <linux/kernel.h> 15 #include <linux/slab.h> 16 #include <linux/init.h> 17 #include <linux/fb.h> 18 #include <linux/leds.h> 19 #include "../leds.h" 20 21 #define BLANK 1 22 #define UNBLANK 0 23 24 struct bl_trig_notifier { 25 struct led_classdev *led; 26 int brightness; 27 int old_status; 28 struct notifier_block notifier; 29 unsigned invert; 30 }; 31 32 static int fb_notifier_callback(struct notifier_block *p, 33 unsigned long event, void *data) 34 { 35 struct bl_trig_notifier *n = container_of(p, 36 struct bl_trig_notifier, notifier); 37 struct led_classdev *led = n->led; 38 struct fb_event *fb_event = data; 39 int *blank; 40 int new_status; 41 42 /* If we aren't interested in this event, skip it immediately ... */ 43 if (event != FB_EVENT_BLANK) 44 return 0; 45 46 blank = fb_event->data; 47 new_status = *blank ? BLANK : UNBLANK; 48 49 if (new_status == n->old_status) 50 return 0; 51 52 if ((n->old_status == UNBLANK) ^ n->invert) { 53 n->brightness = led->brightness; 54 __led_set_brightness(led, LED_OFF); 55 } else { 56 __led_set_brightness(led, n->brightness); 57 } 58 59 n->old_status = new_status; 60 61 return 0; 62 } 63 64 static ssize_t bl_trig_invert_show(struct device *dev, 65 struct device_attribute *attr, char *buf) 66 { 67 struct led_classdev *led = dev_get_drvdata(dev); 68 struct bl_trig_notifier *n = led->trigger_data; 69 70 return sprintf(buf, "%u\n", n->invert); 71 } 72 73 static ssize_t bl_trig_invert_store(struct device *dev, 74 struct device_attribute *attr, const char *buf, size_t num) 75 { 76 struct led_classdev *led = dev_get_drvdata(dev); 77 struct bl_trig_notifier *n = led->trigger_data; 78 unsigned long invert; 79 int ret; 80 81 ret = kstrtoul(buf, 10, &invert); 82 if (ret < 0) 83 return ret; 84 85 if (invert > 1) 86 return -EINVAL; 87 88 n->invert = invert; 89 90 /* After inverting, we need to update the LED. */ 91 if ((n->old_status == BLANK) ^ n->invert) 92 __led_set_brightness(led, LED_OFF); 93 else 94 __led_set_brightness(led, n->brightness); 95 96 return num; 97 } 98 static DEVICE_ATTR(inverted, 0644, bl_trig_invert_show, bl_trig_invert_store); 99 100 static void bl_trig_activate(struct led_classdev *led) 101 { 102 int ret; 103 104 struct bl_trig_notifier *n; 105 106 n = kzalloc(sizeof(struct bl_trig_notifier), GFP_KERNEL); 107 led->trigger_data = n; 108 if (!n) { 109 dev_err(led->dev, "unable to allocate backlight trigger\n"); 110 return; 111 } 112 113 ret = device_create_file(led->dev, &dev_attr_inverted); 114 if (ret) 115 goto err_invert; 116 117 n->led = led; 118 n->brightness = led->brightness; 119 n->old_status = UNBLANK; 120 n->notifier.notifier_call = fb_notifier_callback; 121 122 ret = fb_register_client(&n->notifier); 123 if (ret) 124 dev_err(led->dev, "unable to register backlight trigger\n"); 125 led->activated = true; 126 127 return; 128 129 err_invert: 130 led->trigger_data = NULL; 131 kfree(n); 132 } 133 134 static void bl_trig_deactivate(struct led_classdev *led) 135 { 136 struct bl_trig_notifier *n = 137 (struct bl_trig_notifier *) led->trigger_data; 138 139 if (led->activated) { 140 device_remove_file(led->dev, &dev_attr_inverted); 141 fb_unregister_client(&n->notifier); 142 kfree(n); 143 led->activated = false; 144 } 145 } 146 147 static struct led_trigger bl_led_trigger = { 148 .name = "backlight", 149 .activate = bl_trig_activate, 150 .deactivate = bl_trig_deactivate 151 }; 152 153 static int __init bl_trig_init(void) 154 { 155 return led_trigger_register(&bl_led_trigger); 156 } 157 158 static void __exit bl_trig_exit(void) 159 { 160 led_trigger_unregister(&bl_led_trigger); 161 } 162 163 module_init(bl_trig_init); 164 module_exit(bl_trig_exit); 165 166 MODULE_AUTHOR("Rodolfo Giometti <giometti@linux.it>"); 167 MODULE_DESCRIPTION("Backlight emulation LED trigger"); 168 MODULE_LICENSE("GPL v2"); 169