[package] udev: bump to 173
[openwrt.git] / target / linux / generic / files / drivers / leds / ledtrig-morse.c
1 /*
2 * LED Morse Trigger
3 *
4 * Copyright (C) 2007 Gabor Juhos <juhosg at openwrt.org>
5 *
6 * This file was based on: drivers/led/ledtrig-timer.c
7 * Copyright 2005-2006 Openedhand Ltd.
8 * Author: Richard Purdie <rpurdie@openedhand.com>
9 *
10 * also based on the patch '[PATCH] 2.5.59 morse code panics' posted
11 * in the LKML by Tomas Szepe at Thu, 30 Jan 2003
12 * Copyright (C) 2002 Andrew Rodland <arodland@noln.com>
13 * Copyright (C) 2003 Tomas Szepe <szepe@pinerecords.com>
14 *
15 * This program is free software; you can redistribute it and/or modify it
16 * under the terms of the GNU General Public License version 2 as published
17 * by the Free Software Foundation.
18 *
19 */
20
21 #include <linux/kernel.h>
22 #include <linux/version.h>
23 #include <linux/module.h>
24 #include <linux/jiffies.h>
25 #include <linux/init.h>
26 #include <linux/list.h>
27 #include <linux/spinlock.h>
28 #include <linux/device.h>
29 #include <linux/sysdev.h>
30 #include <linux/timer.h>
31 #include <linux/ctype.h>
32 #include <linux/leds.h>
33 #include <linux/slab.h>
34
35 #include "leds.h"
36
37 #define MORSE_DELAY_BASE (HZ/2)
38
39 #define MORSE_STATE_BLINK_START 0
40 #define MORSE_STATE_BLINK_STOP 1
41
42 #define MORSE_DIT_LEN 1
43 #define MORSE_DAH_LEN 3
44 #define MORSE_SPACE_LEN 7
45
46 struct morse_trig_data {
47 unsigned long delay;
48 char *msg;
49
50 unsigned char morse;
51 unsigned char state;
52 char *msgpos;
53 struct timer_list timer;
54 };
55
56 const unsigned char morsetable[] = {
57 0122, 0, 0310, 0, 0, 0163, /* "#$%&' */
58 055, 0155, 0, 0, 0163, 0141, 0152, 0051, /* ()*+,-./ */
59 077, 076, 074, 070, 060, 040, 041, 043, 047, 057, /* 0-9 */
60 0107, 0125, 0, 0061, 0, 0114, 0, /* :;<=>?@ */
61 006, 021, 025, 011, 002, 024, 013, 020, 004, /* A-I */
62 036, 015, 022, 007, 005, 017, 026, 033, 012, /* J-R */
63 010, 003, 014, 030, 016, 031, 035, 023, /* S-Z */
64 0, 0, 0, 0, 0154 /* [\]^_ */
65 };
66
67 static inline unsigned char tomorse(char c) {
68 if (c >= 'a' && c <= 'z')
69 c = c - 'a' + 'A';
70 if (c >= '"' && c <= '_') {
71 return morsetable[c - '"'];
72 } else
73 return 0;
74 }
75
76 static inline unsigned long dit_len(struct morse_trig_data *morse_data)
77 {
78 return MORSE_DIT_LEN*morse_data->delay;
79 }
80
81 static inline unsigned long dah_len(struct morse_trig_data *morse_data)
82 {
83 return MORSE_DAH_LEN*morse_data->delay;
84 }
85
86 static inline unsigned long space_len(struct morse_trig_data *morse_data)
87 {
88 return MORSE_SPACE_LEN*morse_data->delay;
89 }
90
91 static void morse_timer_function(unsigned long data)
92 {
93 struct led_classdev *led_cdev = (struct led_classdev *)data;
94 struct morse_trig_data *morse_data = led_cdev->trigger_data;
95 unsigned long brightness = LED_OFF;
96 unsigned long delay = 0;
97
98 if (!morse_data->msg)
99 goto set_led;
100
101 switch (morse_data->state) {
102 case MORSE_STATE_BLINK_START:
103 /* Starting a new blink. We have a valid code in morse. */
104 delay = (morse_data->morse & 001) ? dah_len(morse_data):
105 dit_len(morse_data);
106 brightness = LED_FULL;
107 morse_data->state = MORSE_STATE_BLINK_STOP;
108 morse_data->morse >>= 1;
109 break;
110 case MORSE_STATE_BLINK_STOP:
111 /* Coming off of a blink. */
112 morse_data->state = MORSE_STATE_BLINK_START;
113
114 if (morse_data->morse > 1) {
115 /* Not done yet, just a one-dit pause. */
116 delay = dit_len(morse_data);
117 break;
118 }
119
120 /* Get a new char, figure out how much space. */
121 /* First time through */
122 if (!morse_data->msgpos)
123 morse_data->msgpos = (char *)morse_data->msg;
124
125 if (!*morse_data->msgpos) {
126 /* Repeating */
127 morse_data->msgpos = (char *)morse_data->msg;
128 delay = space_len(morse_data);
129 } else {
130 /* Inter-letter space */
131 delay = dah_len(morse_data);
132 }
133
134 if (!(morse_data->morse = tomorse(*morse_data->msgpos))) {
135 delay = space_len(morse_data);
136 /* And get us back here */
137 morse_data->state = MORSE_STATE_BLINK_STOP;
138 }
139 morse_data->msgpos++;
140 break;
141 }
142
143 mod_timer(&morse_data->timer, jiffies + msecs_to_jiffies(delay));
144
145 set_led:
146 led_set_brightness(led_cdev, brightness);
147 }
148
149 static ssize_t _morse_delay_show(struct led_classdev *led_cdev, char *buf)
150 {
151 struct morse_trig_data *morse_data = led_cdev->trigger_data;
152
153 sprintf(buf, "%lu\n", morse_data->delay);
154
155 return strlen(buf) + 1;
156 }
157
158 static ssize_t _morse_delay_store(struct led_classdev *led_cdev,
159 const char *buf, size_t size)
160 {
161 struct morse_trig_data *morse_data = led_cdev->trigger_data;
162 char *after;
163 unsigned long state = simple_strtoul(buf, &after, 10);
164 size_t count = after - buf;
165 int ret = -EINVAL;
166
167 if (*after && isspace(*after))
168 count++;
169
170 if (count == size) {
171 morse_data->delay = state;
172 mod_timer(&morse_data->timer, jiffies + 1);
173 ret = count;
174 }
175
176 return ret;
177 }
178
179 static ssize_t _morse_msg_show(struct led_classdev *led_cdev, char *buf)
180 {
181 struct morse_trig_data *morse_data = led_cdev->trigger_data;
182
183 if (!morse_data->msg)
184 sprintf(buf, "<none>\n");
185 else
186 sprintf(buf, "%s\n", morse_data->msg);
187
188 return strlen(buf) + 1;
189 }
190
191 static ssize_t _morse_msg_store(struct led_classdev *led_cdev,
192 const char *buf, size_t size)
193 {
194 struct morse_trig_data *morse_data = led_cdev->trigger_data;
195 char *m;
196
197 m = kmalloc(size, GFP_KERNEL);
198 if (!m)
199 return -ENOMEM;
200
201 memcpy(m,buf,size);
202 m[size]='\0';
203
204 if (morse_data->msg)
205 kfree(morse_data->msg);
206
207 morse_data->msg = m;
208 morse_data->msgpos = NULL;
209 morse_data->state = MORSE_STATE_BLINK_STOP;
210
211 mod_timer(&morse_data->timer, jiffies + 1);
212
213 return size;
214 }
215
216 #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,23)
217 static ssize_t morse_delay_show(struct device *dev,
218 struct device_attribute *attr, char *buf)
219 {
220 struct led_classdev *led_cdev = dev_get_drvdata(dev);
221
222 return _morse_delay_show(led_cdev, buf);
223 }
224
225 static ssize_t morse_delay_store(struct device *dev,
226 struct device_attribute *attr, const char *buf, size_t size)
227 {
228 struct led_classdev *led_cdev = dev_get_drvdata(dev);
229
230 return _morse_delay_store(led_cdev, buf, size);
231 }
232
233 static ssize_t morse_msg_show(struct device *dev,
234 struct device_attribute *attr, char *buf)
235 {
236 struct led_classdev *led_cdev = dev_get_drvdata(dev);
237
238 return _morse_msg_show(led_cdev, buf);
239 }
240
241 static ssize_t morse_msg_store(struct device *dev,
242 struct device_attribute *attr, const char *buf, size_t size)
243 {
244 struct led_classdev *led_cdev = dev_get_drvdata(dev);
245
246 return _morse_msg_store(led_cdev, buf, size);
247 }
248
249 static DEVICE_ATTR(delay, 0644, morse_delay_show, morse_delay_store);
250 static DEVICE_ATTR(message, 0644, morse_msg_show, morse_msg_store);
251
252 #define led_device_create_file(leddev, attr) \
253 device_create_file(leddev->dev, &dev_attr_ ## attr)
254 #define led_device_remove_file(leddev, attr) \
255 device_remove_file(leddev->dev, &dev_attr_ ## attr)
256
257 #else
258 static ssize_t morse_delay_show(struct class_device *dev, char *buf)
259 {
260 struct led_classdev *led_cdev = class_get_devdata(dev);
261
262 return _morse_delay_show(led_cdev, buf);
263 }
264
265 static ssize_t morse_delay_store(struct class_device *dev, const char *buf,
266 size_t size)
267 {
268 struct led_classdev *led_cdev = class_get_devdata(dev);
269
270 return _morse_delay_store(led_cdev, buf, size);
271 }
272
273 static ssize_t morse_msg_show(struct class_device *dev, char *buf)
274 {
275 struct led_classdev *led_cdev = class_get_devdata(dev);
276
277 return _morse_msg_show(led_cdev, buf);
278 }
279
280 static ssize_t morse_msg_store(struct class_device *dev, const char *buf,
281 size_t size)
282 {
283 struct led_classdev *led_cdev = class_get_devdata(dev);
284
285 return _morse_msg_store(led_cdev, buf, size);
286 }
287
288 static CLASS_DEVICE_ATTR(delay, 0644, morse_delay_show, morse_delay_store);
289 static CLASS_DEVICE_ATTR(message, 0644, morse_msg_show, morse_msg_store);
290
291 #define led_device_create_file(leddev, attr) \
292 class_device_create_file(leddev->class_dev, &class_device_attr_ ## attr)
293 #define led_device_remove_file(leddev, attr) \
294 class_device_remove_file(leddev->class_dev, &class_device_attr_ ## attr)
295
296 #endif
297
298 static void morse_trig_activate(struct led_classdev *led_cdev)
299 {
300 struct morse_trig_data *morse_data;
301 int rc;
302
303 morse_data = kzalloc(sizeof(*morse_data), GFP_KERNEL);
304 if (!morse_data)
305 return;
306
307 morse_data->delay = MORSE_DELAY_BASE;
308 init_timer(&morse_data->timer);
309 morse_data->timer.function = morse_timer_function;
310 morse_data->timer.data = (unsigned long)led_cdev;
311
312 rc = led_device_create_file(led_cdev, delay);
313 if (rc) goto err;
314
315 rc = led_device_create_file(led_cdev, message);
316 if (rc) goto err_delay;
317
318 led_cdev->trigger_data = morse_data;
319
320 return;
321
322 err_delay:
323 led_device_remove_file(led_cdev, delay);
324 err:
325 kfree(morse_data);
326 }
327
328 static void morse_trig_deactivate(struct led_classdev *led_cdev)
329 {
330 struct morse_trig_data *morse_data = led_cdev->trigger_data;
331
332 if (!morse_data)
333 return;
334
335 led_device_remove_file(led_cdev, message);
336 led_device_remove_file(led_cdev, delay);
337
338 del_timer_sync(&morse_data->timer);
339 if (morse_data->msg)
340 kfree(morse_data->msg);
341
342 kfree(morse_data);
343 }
344
345 static struct led_trigger morse_led_trigger = {
346 .name = "morse",
347 .activate = morse_trig_activate,
348 .deactivate = morse_trig_deactivate,
349 };
350
351 static int __init morse_trig_init(void)
352 {
353 return led_trigger_register(&morse_led_trigger);
354 }
355
356 static void __exit morse_trig_exit(void)
357 {
358 led_trigger_unregister(&morse_led_trigger);
359 }
360
361 module_init(morse_trig_init);
362 module_exit(morse_trig_exit);
363
364 MODULE_AUTHOR("Gabor Juhos <juhosg at openwrt.org>");
365 MODULE_DESCRIPTION("Morse LED trigger");
366 MODULE_LICENSE("GPL");
This page took 0.063957 seconds and 5 git commands to generate.