]>
Commit | Line | Data |
---|---|---|
1 | #include <linux/module.h> | |
2 | #include <linux/device.h> | |
3 | #include <linux/platform_device.h> | |
4 | #include <linux/gpio_event.h> | |
5 | #include <linux/interrupt.h> | |
6 | #include <linux/irq.h> | |
7 | #include <mach/gpio.h> | |
8 | #include <linux/earlysuspend.h> | |
9 | #include <linux/wakelock.h> | |
10 | #include <plat/board-mapphone.h> | |
11 | ||
12 | #define PREFIX "debounce: " | |
13 | ||
14 | #define PADCONF_PULL_UP ( OMAP343X_PADCONF_OFF_WAKEUP_ENABLED | \ | |
15 | OMAP343X_PADCONF_INPUT_ENABLED | \ | |
16 | OMAP343X_PADCONF_PULL_UP | \ | |
17 | OMAP343X_PADCONF_PUD_ENABLED | \ | |
18 | OMAP343X_PADCONF_MUXMODE4 ) | |
19 | ||
20 | #define PADCONF_PULL_DOWN ( OMAP343X_PADCONF_OFF_WAKEUP_ENABLED | \ | |
21 | OMAP343X_PADCONF_INPUT_ENABLED | \ | |
22 | OMAP343X_PADCONF_PULL_DOWN | \ | |
23 | OMAP343X_PADCONF_PUD_ENABLED | \ | |
24 | OMAP343X_PADCONF_MUXMODE4 ) | |
25 | ||
26 | #define OMAP_CTRL_REGADDR(reg) (OMAP2_L4_IO_ADDRESS(OMAP343X_CTRL_BASE) + (reg)) | |
27 | ||
28 | static unsigned old_flags = 0; | |
29 | static ktime_t old_debounce_delay; | |
30 | static ktime_t old_settle_time; | |
31 | static ktime_t old_poll_time; | |
32 | static int (*old_sw_fixup)(int index); | |
33 | static struct gpio_event_matrix_info *gpio_evmi = NULL; | |
34 | static int hw_debounce = 0; | |
35 | static int hw_debounce_time = 0; | |
36 | ||
37 | struct gpio_event { | |
38 | struct gpio_event_input_devs *input_devs; | |
39 | const struct gpio_event_platform_data *info; | |
40 | struct early_suspend early_suspend; | |
41 | void *state[0]; | |
42 | }; | |
43 | ||
44 | struct gpio_kp { | |
45 | struct gpio_event_input_devs *input_devs; | |
46 | struct gpio_event_matrix_info *keypad_info; | |
47 | struct hrtimer timer; | |
48 | struct wake_lock wake_lock; | |
49 | int current_output; | |
50 | unsigned int use_irq:1; | |
51 | unsigned int key_state_changed:1; | |
52 | unsigned int last_key_state_changed:1; | |
53 | unsigned int some_keys_pressed:2; | |
54 | unsigned long keys_pressed[0]; | |
55 | }; | |
56 | ||
57 | static struct gpio_kp *gpio_kp_state = NULL; | |
58 | ||
59 | static int find_ms2_dev(struct device *dev, void *data) | |
60 | { | |
61 | if (!strncmp((char*)data, dev_name(dev), strlen((char*)data))) { | |
62 | printk(KERN_INFO PREFIX "Found it\n"); | |
63 | return 1; | |
64 | } | |
65 | return 0; | |
66 | } | |
67 | ||
68 | /* hardware debounce: (time + 1) * 31us */ | |
69 | static void hw_debounce_set(int enable, int time) { | |
70 | int i; | |
71 | ||
72 | if (gpio_evmi == NULL) | |
73 | return; | |
74 | ||
75 | for (i = 0; i < gpio_evmi->ninputs; i++) { | |
76 | int gpio = gpio_evmi->input_gpios[i]; | |
77 | ||
78 | if ((time != -1) && (time != hw_debounce_time) && hw_debounce) { | |
79 | printk(KERN_INFO PREFIX "Setting hardware debounce time for GPIO %d to %d (%dus)\n", gpio, time, (time+1)*31); | |
80 | omap_set_gpio_debounce_time(gpio, time); | |
81 | } | |
82 | ||
83 | if ((enable != -1) && (enable != hw_debounce)) { | |
84 | printk(KERN_INFO PREFIX "%sabling hardware debounce for GPIO %d\n", (enable?"En":"Dis"), gpio); | |
85 | omap_set_gpio_debounce(gpio, enable); | |
86 | } | |
87 | } | |
88 | } | |
89 | ||
90 | static void set_irq_types(void) { | |
91 | int err; | |
92 | unsigned int irq; | |
93 | unsigned long type; | |
94 | int i; | |
95 | ||
96 | if (gpio_evmi == NULL) | |
97 | return; | |
98 | ||
99 | switch (gpio_evmi->flags & (GPIOKPF_ACTIVE_HIGH|GPIOKPF_LEVEL_TRIGGERED_IRQ)) { | |
100 | default: | |
101 | type = IRQ_TYPE_EDGE_FALLING; | |
102 | break; | |
103 | case GPIOKPF_ACTIVE_HIGH: | |
104 | type = IRQ_TYPE_EDGE_RISING; | |
105 | break; | |
106 | case GPIOKPF_LEVEL_TRIGGERED_IRQ: | |
107 | type = IRQ_TYPE_LEVEL_LOW; | |
108 | break; | |
109 | case GPIOKPF_LEVEL_TRIGGERED_IRQ | GPIOKPF_ACTIVE_HIGH: | |
110 | type = IRQ_TYPE_LEVEL_HIGH; | |
111 | break; | |
112 | } | |
113 | ||
114 | printk(KERN_INFO PREFIX "Settinhg IRQ type to 0x%lx\n", type); | |
115 | ||
116 | for (i = 0; i < gpio_evmi->ninputs; i++) { | |
117 | ||
118 | err = irq = gpio_to_irq(gpio_evmi->input_gpios[i]); | |
119 | ||
120 | if (err < 0) | |
121 | return; | |
122 | ||
123 | err = set_irq_type(irq, type); | |
124 | } | |
125 | } | |
126 | ||
127 | static ssize_t show_debounce_delay(struct device *dev, struct device_attribute *attr, char *buf) | |
128 | { | |
129 | if (!gpio_evmi) | |
130 | return -ENODEV; | |
131 | ||
132 | return snprintf(buf, PAGE_SIZE, "%ld\n", (gpio_evmi->debounce_delay.tv.nsec / NSEC_PER_MSEC)); | |
133 | } | |
134 | ||
135 | static void set_debounce_delay(long delay) | |
136 | { | |
137 | if (gpio_evmi->debounce_delay.tv.nsec != delay * NSEC_PER_MSEC) { | |
138 | printk(KERN_INFO PREFIX "Changing debounce_delay\n"); | |
139 | gpio_evmi->debounce_delay.tv.nsec = delay * NSEC_PER_MSEC; | |
140 | printk(KERN_INFO PREFIX "debounce_delay: %u\n", gpio_evmi->debounce_delay.tv.nsec); | |
141 | } | |
142 | ||
143 | #if 0 | |
144 | if (gpio_evmi->debounce_delay.tv.nsec != 0) { | |
145 | if (!(gpio_evmi->flags & GPIOKPF_DEBOUNCE)) { | |
146 | printk(KERN_INFO PREFIX "Activating debounce\n"); | |
147 | gpio_evmi->flags |= GPIOKPF_DEBOUNCE; | |
148 | } | |
149 | } else { | |
150 | if (gpio_evmi->flags & GPIOKPF_DEBOUNCE) { | |
151 | printk(KERN_INFO PREFIX "Deactivating debounce\n"); | |
152 | gpio_evmi->flags &= ~GPIOKPF_DEBOUNCE; | |
153 | } | |
154 | } | |
155 | #endif | |
156 | } | |
157 | ||
158 | static ssize_t store_debounce_delay(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | |
159 | { | |
160 | long int delay; | |
161 | ||
162 | if (!gpio_evmi) | |
163 | return -ENODEV; | |
164 | ||
165 | sscanf(buf, "%ld", &delay); | |
166 | set_debounce_delay(delay); | |
167 | ||
168 | return count; | |
169 | } | |
170 | ||
171 | static ssize_t show_settle_time(struct device *dev, struct device_attribute *attr, char *buf) | |
172 | { | |
173 | if (!gpio_evmi) | |
174 | return -ENODEV; | |
175 | ||
176 | return snprintf(buf, PAGE_SIZE, "%ld\n", (gpio_evmi->settle_time.tv.nsec / NSEC_PER_USEC)); | |
177 | } | |
178 | ||
179 | static ssize_t store_settle_time(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | |
180 | { | |
181 | long int delay; | |
182 | ||
183 | if (!gpio_evmi) | |
184 | return -ENODEV; | |
185 | ||
186 | sscanf(buf, "%ld", &delay); | |
187 | gpio_evmi->settle_time.tv.nsec = delay * NSEC_PER_USEC; | |
188 | ||
189 | return count; | |
190 | } | |
191 | ||
192 | static ssize_t show_poll_time(struct device *dev, struct device_attribute *attr, char *buf) | |
193 | { | |
194 | if (!gpio_evmi) | |
195 | return -ENODEV; | |
196 | ||
197 | return snprintf(buf, PAGE_SIZE, "%ld\n", (gpio_evmi->poll_time.tv.nsec / NSEC_PER_MSEC)); | |
198 | } | |
199 | ||
200 | static ssize_t store_poll_time(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | |
201 | { | |
202 | long int delay; | |
203 | ||
204 | if (!gpio_evmi) | |
205 | return -ENODEV; | |
206 | ||
207 | sscanf(buf, "%ld", &delay); | |
208 | gpio_evmi->poll_time.tv.nsec = delay * NSEC_PER_MSEC; | |
209 | ||
210 | return count; | |
211 | } | |
212 | ||
213 | static ssize_t show_flags(struct device *dev, struct device_attribute *attr, char *buf) | |
214 | { | |
215 | if (!gpio_evmi) | |
216 | return -ENODEV; | |
217 | ||
218 | return snprintf(buf, PAGE_SIZE, "0x%x\n", gpio_evmi->flags); | |
219 | } | |
220 | ||
221 | static ssize_t store_flags(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | |
222 | { | |
223 | unsigned flags; | |
224 | ||
225 | if (!gpio_evmi) | |
226 | return -ENODEV; | |
227 | ||
228 | sscanf(buf, "0x%x", &flags); | |
229 | ||
230 | printk(KERN_INFO PREFIX "flags: 0x%x\n", flags); | |
231 | ||
232 | gpio_evmi->flags = flags; | |
233 | ||
234 | return count; | |
235 | } | |
236 | ||
237 | static ssize_t show_debounce_flag(struct device *dev, struct device_attribute *attr, char *buf) | |
238 | { | |
239 | if (!gpio_evmi) | |
240 | return -ENODEV; | |
241 | ||
242 | return snprintf(buf, PAGE_SIZE, "%u\n", (gpio_evmi->flags & GPIOKPF_DEBOUNCE) ? 1 : 0); | |
243 | } | |
244 | ||
245 | static ssize_t store_debounce_flag(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | |
246 | { | |
247 | unsigned flag; | |
248 | ||
249 | if (!gpio_evmi) | |
250 | return -ENODEV; | |
251 | ||
252 | sscanf(buf, "%u", &flag); | |
253 | ||
254 | if (flag) { | |
255 | gpio_evmi->flags |= GPIOKPF_DEBOUNCE; | |
256 | } else { | |
257 | gpio_evmi->flags &= ~GPIOKPF_DEBOUNCE; | |
258 | } | |
259 | ||
260 | return count; | |
261 | } | |
262 | ||
263 | static ssize_t show_remove_some_phantom_keys_flag(struct device *dev, struct device_attribute *attr, char *buf) | |
264 | { | |
265 | if (!gpio_evmi) | |
266 | return -ENODEV; | |
267 | ||
268 | return snprintf(buf, PAGE_SIZE, "%u\n", (gpio_evmi->flags & GPIOKPF_REMOVE_SOME_PHANTOM_KEYS) ? 1 : 0); | |
269 | } | |
270 | ||
271 | static ssize_t store_remove_some_phantom_keys_flag(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | |
272 | { | |
273 | unsigned flag; | |
274 | ||
275 | if (!gpio_evmi) | |
276 | return -ENODEV; | |
277 | ||
278 | sscanf(buf, "%u", &flag); | |
279 | ||
280 | if (flag) { | |
281 | gpio_evmi->flags |= GPIOKPF_REMOVE_SOME_PHANTOM_KEYS; | |
282 | } else { | |
283 | gpio_evmi->flags &= ~GPIOKPF_REMOVE_SOME_PHANTOM_KEYS; | |
284 | } | |
285 | ||
286 | return count; | |
287 | } | |
288 | ||
289 | static ssize_t show_print_unmapped_keys_flag(struct device *dev, struct device_attribute *attr, char *buf) | |
290 | { | |
291 | if (!gpio_evmi) | |
292 | return -ENODEV; | |
293 | ||
294 | return snprintf(buf, PAGE_SIZE, "%u\n", (gpio_evmi->flags & GPIOKPF_PRINT_UNMAPPED_KEYS) ? 1 : 0); | |
295 | } | |
296 | ||
297 | static ssize_t store_print_unmapped_keys_flag(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | |
298 | { | |
299 | unsigned flag; | |
300 | ||
301 | if (!gpio_evmi) | |
302 | return -ENODEV; | |
303 | ||
304 | sscanf(buf, "%u", &flag); | |
305 | ||
306 | if (flag) { | |
307 | gpio_evmi->flags |= GPIOKPF_PRINT_UNMAPPED_KEYS; | |
308 | } else { | |
309 | gpio_evmi->flags &= ~GPIOKPF_PRINT_UNMAPPED_KEYS; | |
310 | } | |
311 | ||
312 | return count; | |
313 | } | |
314 | ||
315 | static ssize_t show_print_mapped_keys_flag(struct device *dev, struct device_attribute *attr, char *buf) | |
316 | { | |
317 | if (!gpio_evmi) | |
318 | return -ENODEV; | |
319 | ||
320 | return snprintf(buf, PAGE_SIZE, "%u\n", (gpio_evmi->flags & GPIOKPF_PRINT_MAPPED_KEYS) ? 1 : 0); | |
321 | } | |
322 | ||
323 | static ssize_t store_print_mapped_keys_flag(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | |
324 | { | |
325 | unsigned flag; | |
326 | ||
327 | if (!gpio_evmi) | |
328 | return -ENODEV; | |
329 | ||
330 | sscanf(buf, "%u", &flag); | |
331 | ||
332 | if (flag) { | |
333 | gpio_evmi->flags |= GPIOKPF_PRINT_MAPPED_KEYS; | |
334 | } else { | |
335 | gpio_evmi->flags &= ~GPIOKPF_PRINT_MAPPED_KEYS; | |
336 | } | |
337 | ||
338 | return count; | |
339 | } | |
340 | ||
341 | static ssize_t show_print_phantom_keys_flag(struct device *dev, struct device_attribute *attr, char *buf) | |
342 | { | |
343 | if (!gpio_evmi) | |
344 | return -ENODEV; | |
345 | ||
346 | return snprintf(buf, PAGE_SIZE, "%u\n", (gpio_evmi->flags & GPIOKPF_PRINT_PHANTOM_KEYS) ? 1 : 0); | |
347 | } | |
348 | ||
349 | static ssize_t store_print_phantom_keys_flag(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | |
350 | { | |
351 | unsigned flag; | |
352 | ||
353 | if (!gpio_evmi) | |
354 | return -ENODEV; | |
355 | ||
356 | sscanf(buf, "%u", &flag); | |
357 | ||
358 | if (flag) { | |
359 | gpio_evmi->flags |= GPIOKPF_PRINT_PHANTOM_KEYS; | |
360 | } else { | |
361 | gpio_evmi->flags &= ~GPIOKPF_PRINT_PHANTOM_KEYS; | |
362 | } | |
363 | ||
364 | return count; | |
365 | } | |
366 | ||
367 | static ssize_t show_active_high_flag(struct device *dev, struct device_attribute *attr, char *buf) | |
368 | { | |
369 | if (!gpio_evmi) | |
370 | return -ENODEV; | |
371 | ||
372 | return snprintf(buf, PAGE_SIZE, "%u\n", (gpio_evmi->flags & GPIOKPF_ACTIVE_HIGH) ? 1 : 0); | |
373 | } | |
374 | ||
375 | static ssize_t store_active_high_flag(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | |
376 | { | |
377 | unsigned flag; | |
378 | int i; | |
379 | ||
380 | if (!gpio_evmi) | |
381 | return -ENODEV; | |
382 | ||
383 | sscanf(buf, "%u", &flag); | |
384 | ||
385 | if (flag) { | |
386 | gpio_evmi->flags |= GPIOKPF_ACTIVE_HIGH; | |
387 | for (i = 0x7a; i <= 0x88; i += 2) { | |
388 | __raw_writew(PADCONF_PULL_DOWN, OMAP_CTRL_REGADDR(i)); | |
389 | } | |
390 | } else { | |
391 | gpio_evmi->flags &= ~GPIOKPF_ACTIVE_HIGH; | |
392 | for (i = 0x7a; i <= 0x88; i += 2) { | |
393 | __raw_writew(PADCONF_PULL_UP, OMAP_CTRL_REGADDR(i)); | |
394 | } | |
395 | } | |
396 | ||
397 | set_irq_types(); | |
398 | ||
399 | return count; | |
400 | } | |
401 | ||
402 | static ssize_t show_level_triggered_irq_flag(struct device *dev, struct device_attribute *attr, char *buf) | |
403 | { | |
404 | if (!gpio_evmi) | |
405 | return -ENODEV; | |
406 | ||
407 | return snprintf(buf, PAGE_SIZE, "%u\n", (gpio_evmi->flags & GPIOKPF_LEVEL_TRIGGERED_IRQ) ? 1 : 0); | |
408 | } | |
409 | ||
410 | static ssize_t store_level_triggered_irq_flag(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | |
411 | { | |
412 | unsigned flag; | |
413 | ||
414 | if (!gpio_evmi) | |
415 | return -ENODEV; | |
416 | ||
417 | sscanf(buf, "%u", &flag); | |
418 | ||
419 | if (flag) { | |
420 | gpio_evmi->flags |= GPIOKPF_LEVEL_TRIGGERED_IRQ; | |
421 | } else { | |
422 | gpio_evmi->flags &= ~GPIOKPF_LEVEL_TRIGGERED_IRQ; | |
423 | } | |
424 | ||
425 | set_irq_types(); | |
426 | ||
427 | return count; | |
428 | } | |
429 | ||
430 | static ssize_t show_drive_inactive_flag(struct device *dev, struct device_attribute *attr, char *buf) | |
431 | { | |
432 | if (!gpio_evmi) | |
433 | return -ENODEV; | |
434 | ||
435 | return snprintf(buf, PAGE_SIZE, "%u\n", (gpio_evmi->flags & GPIOKPF_DRIVE_INACTIVE) ? 1 : 0); | |
436 | } | |
437 | ||
438 | static ssize_t store_drive_inactive_flag(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | |
439 | { | |
440 | unsigned flag; | |
441 | ||
442 | if (!gpio_evmi) | |
443 | return -ENODEV; | |
444 | ||
445 | sscanf(buf, "%u", &flag); | |
446 | ||
447 | if (flag) { | |
448 | gpio_evmi->flags |= GPIOKPF_DRIVE_INACTIVE; | |
449 | } else { | |
450 | gpio_evmi->flags &= ~GPIOKPF_DRIVE_INACTIVE; | |
451 | } | |
452 | ||
453 | return count; | |
454 | } | |
455 | ||
456 | static ssize_t show_hw_debounce(struct device *dev, struct device_attribute *attr, char *buf) | |
457 | { | |
458 | return snprintf(buf, PAGE_SIZE, "%d\n", hw_debounce); | |
459 | } | |
460 | ||
461 | static ssize_t store_hw_debounce(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | |
462 | { | |
463 | int enable; | |
464 | ||
465 | sscanf(buf, "%d", &enable); | |
466 | ||
467 | if (enable) { | |
468 | hw_debounce_set(1, -1); | |
469 | hw_debounce = 1; | |
470 | } | |
471 | else { | |
472 | hw_debounce_set(-1, 0); | |
473 | hw_debounce_set(0, -1); | |
474 | hw_debounce = 0; | |
475 | hw_debounce_time = 0; | |
476 | } | |
477 | ||
478 | return count; | |
479 | } | |
480 | ||
481 | static ssize_t show_hw_debounce_time(struct device *dev, struct device_attribute *attr, char *buf) | |
482 | { | |
483 | return snprintf(buf, PAGE_SIZE, "%d\n", hw_debounce_time); | |
484 | } | |
485 | ||
486 | static ssize_t store_hw_debounce_time(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) | |
487 | { | |
488 | int time; | |
489 | ||
490 | sscanf(buf, "%d", &time); | |
491 | ||
492 | if ((time < 0) || (time > 0xff)) | |
493 | return count; | |
494 | ||
495 | if (!hw_debounce) | |
496 | return count; | |
497 | ||
498 | hw_debounce_set(-1, time); | |
499 | hw_debounce_time = time; | |
500 | ||
501 | return count; | |
502 | } | |
503 | ||
504 | static DEVICE_ATTR(debounce_delay, (S_IRUGO | S_IWUGO), show_debounce_delay, store_debounce_delay); | |
505 | static DEVICE_ATTR(settle_time, (S_IRUGO | S_IWUGO), show_settle_time, store_settle_time); | |
506 | static DEVICE_ATTR(poll_time, (S_IRUGO | S_IWUGO), show_poll_time, store_poll_time); | |
507 | static DEVICE_ATTR(flags, (S_IRUGO), show_flags, store_flags); | |
508 | static DEVICE_ATTR(debounce_flag, (S_IRUGO | S_IWUGO), show_debounce_flag, store_debounce_flag); | |
509 | static DEVICE_ATTR(remove_some_phantom_keys_flag, (S_IRUGO | S_IWUGO), show_remove_some_phantom_keys_flag, store_remove_some_phantom_keys_flag); | |
510 | static DEVICE_ATTR(print_unmapped_keys_flag, (S_IRUGO | S_IWUGO), show_print_unmapped_keys_flag, store_print_unmapped_keys_flag); | |
511 | static DEVICE_ATTR(print_mapped_keys_flag, (S_IRUGO | S_IWUGO), show_print_mapped_keys_flag, store_print_mapped_keys_flag); | |
512 | static DEVICE_ATTR(print_phantom_keys_flag, (S_IRUGO | S_IWUGO), show_print_phantom_keys_flag, store_print_phantom_keys_flag); | |
513 | static DEVICE_ATTR(active_high_flag, (S_IRUGO | S_IWUGO), show_active_high_flag, store_active_high_flag); | |
514 | static DEVICE_ATTR(level_triggered_irq_flag, (S_IRUGO | S_IWUGO), show_level_triggered_irq_flag, store_level_triggered_irq_flag); | |
515 | static DEVICE_ATTR(drive_inactive_flag, (S_IRUGO | S_IWUGO), show_drive_inactive_flag, store_drive_inactive_flag); | |
516 | static DEVICE_ATTR(hw_debounce, (S_IRUGO | S_IWUGO), show_hw_debounce, store_hw_debounce); | |
517 | static DEVICE_ATTR(hw_debounce_time, (S_IRUGO | S_IWUGO), show_hw_debounce_time, store_hw_debounce_time); | |
518 | ||
519 | #if 0 | |
520 | static int debounce_fixup(int index) | |
521 | { | |
522 | int ret; | |
523 | ||
524 | printk(KERN_INFO PREFIX "key_state_changed: %d, last_key_state_changed: %d, some_keys_pressed: %d\n", | |
525 | gpio_kp_state->key_state_changed, | |
526 | gpio_kp_state->last_key_state_changed, | |
527 | gpio_kp_state->some_keys_pressed); | |
528 | ||
529 | ret = old_sw_fixup(index); | |
530 | if (!ret) | |
531 | printk(KERN_INFO PREFIX "Index 0x%x ignored!\n", index); | |
532 | ||
533 | return ret; | |
534 | } | |
535 | #endif | |
536 | ||
537 | static void debounce_release(struct device *dev) | |
538 | { | |
539 | } | |
540 | ||
541 | static struct device debounce_device = { | |
542 | .init_name = "debounce", | |
543 | .release = debounce_release, | |
544 | }; | |
545 | ||
546 | static int __init debounce_init(void) | |
547 | { | |
548 | struct device *event_dev = NULL; | |
549 | struct platform_device *pdev = NULL; | |
550 | struct gpio_event_platform_data *gpio_epd; | |
551 | struct gpio_event_info *gpio_ei; | |
552 | struct gpio_event *gpio_e; | |
553 | int err = 0; | |
554 | int i; | |
555 | ||
556 | printk(KERN_INFO PREFIX "Searching for " GPIO_EVENT_DEV_NAME "...\n"); | |
557 | ||
558 | event_dev = device_find_child(&platform_bus, GPIO_EVENT_DEV_NAME, find_ms2_dev); | |
559 | if (event_dev == NULL) | |
560 | return -ENODEV; | |
561 | ||
562 | pdev = container_of(event_dev, struct platform_device, dev); | |
563 | if (pdev == NULL) | |
564 | return -ENODEV; | |
565 | ||
566 | gpio_epd = (struct gpio_event_platform_data*)event_dev->platform_data; | |
567 | printk(KERN_INFO PREFIX "And there is a %s connected...\n", gpio_epd->name); | |
568 | if (strcmp(gpio_epd->name, "sholes-keypad")) | |
569 | return -ENODEV; | |
570 | ||
571 | gpio_ei = (struct gpio_event_info*)gpio_epd->info[0]; | |
572 | gpio_evmi = container_of(gpio_ei, struct gpio_event_matrix_info, info); | |
573 | ||
574 | gpio_e = platform_get_drvdata(pdev); | |
575 | printk(KERN_INFO PREFIX "Number of states: %d\n", gpio_e->info->info_count); | |
576 | ||
577 | /* Search for correct gpio_event state */ | |
578 | for (i = 0; i < gpio_e->info->info_count; i++) { | |
579 | if (gpio_e->info->info[i]->func == gpio_ei->func) { | |
580 | printk(KERN_INFO PREFIX "Keypad state: %d\n", i); | |
581 | gpio_kp_state = gpio_e->state[i]; | |
582 | } | |
583 | } | |
584 | ||
585 | if (!gpio_kp_state) { | |
586 | printk(KERN_ERR PREFIX "Can't determine correct keypad state!\n"); | |
587 | return -ENODEV; | |
588 | } | |
589 | ||
590 | printk(KERN_INFO PREFIX "kp_use_irq: %d\n", gpio_kp_state->use_irq); | |
591 | #if 0 | |
592 | gpio_kp_state->use_irq=0; | |
593 | hrtimer_start(&(gpio_kp_state->timer), gpio_evmi->poll_time, HRTIMER_MODE_REL); | |
594 | printk(KERN_INFO PREFIX "kp_use_irq: %d\n", gpio_kp_state->use_irq); | |
595 | #endif | |
596 | ||
597 | err = device_register(&debounce_device); | |
598 | if (err) { | |
599 | return err; | |
600 | } | |
601 | ||
602 | err = device_create_file(&debounce_device, &dev_attr_debounce_delay); | |
603 | err = device_create_file(&debounce_device, &dev_attr_settle_time); | |
604 | err = device_create_file(&debounce_device, &dev_attr_poll_time); | |
605 | err = device_create_file(&debounce_device, &dev_attr_flags); | |
606 | err = device_create_file(&debounce_device, &dev_attr_debounce_flag); | |
607 | err = device_create_file(&debounce_device, &dev_attr_remove_some_phantom_keys_flag); | |
608 | err = device_create_file(&debounce_device, &dev_attr_print_unmapped_keys_flag); | |
609 | err = device_create_file(&debounce_device, &dev_attr_print_mapped_keys_flag); | |
610 | err = device_create_file(&debounce_device, &dev_attr_print_phantom_keys_flag); | |
611 | err = device_create_file(&debounce_device, &dev_attr_active_high_flag); | |
612 | err = device_create_file(&debounce_device, &dev_attr_level_triggered_irq_flag); | |
613 | err = device_create_file(&debounce_device, &dev_attr_drive_inactive_flag); | |
614 | err = device_create_file(&debounce_device, &dev_attr_hw_debounce); | |
615 | err = device_create_file(&debounce_device, &dev_attr_hw_debounce_time); | |
616 | ||
617 | printk(KERN_INFO PREFIX "settle_time: %u\n", gpio_evmi->settle_time.tv.nsec); | |
618 | printk(KERN_INFO PREFIX "poll_time: %u\n", gpio_evmi->poll_time.tv.nsec); | |
619 | printk(KERN_INFO PREFIX "debounce_delay: %u\n", gpio_evmi->debounce_delay.tv.nsec); | |
620 | printk(KERN_INFO PREFIX "flags: 0x%x\n", gpio_evmi->flags); | |
621 | ||
622 | old_debounce_delay = gpio_evmi->debounce_delay; | |
623 | old_settle_time = gpio_evmi->settle_time; | |
624 | old_poll_time = gpio_evmi->poll_time; | |
625 | old_flags = gpio_evmi->flags; | |
626 | old_sw_fixup = gpio_evmi->sw_fixup; | |
627 | ||
628 | #if 0 | |
629 | printk(KERN_INFO PREFIX "Registering fixup handler\n"); | |
630 | gpio_evmi->sw_fixup = debounce_fixup; | |
631 | #endif | |
632 | ||
633 | return 0; | |
634 | } | |
635 | ||
636 | static void __exit debounce_exit(void) | |
637 | { | |
638 | int i; | |
639 | ||
640 | if (gpio_evmi) { | |
641 | if (gpio_evmi->debounce_delay.tv.nsec != old_debounce_delay.tv.nsec) { | |
642 | printk(KERN_INFO PREFIX "Restoring debounce_delay\n"); | |
643 | gpio_evmi->debounce_delay = old_debounce_delay; | |
644 | printk(KERN_INFO PREFIX "debounce_delay: %u\n", gpio_evmi->debounce_delay.tv.nsec); | |
645 | } | |
646 | if (gpio_evmi->flags != old_flags) { | |
647 | printk(KERN_INFO PREFIX "Restoring flags\n"); | |
648 | gpio_evmi->flags = old_flags; | |
649 | printk(KERN_INFO PREFIX "flags: 0x%x\n", gpio_evmi->flags); | |
650 | if (gpio_evmi->flags & GPIOKPF_ACTIVE_HIGH) { | |
651 | for (i = 0x7a; i <= 0x88; i += 2) { | |
652 | __raw_writew(PADCONF_PULL_DOWN, OMAP_CTRL_REGADDR(i)); | |
653 | } | |
654 | } else { | |
655 | for (i = 0x7a; i <= 0x88; i += 2) { | |
656 | __raw_writew(PADCONF_PULL_UP, OMAP_CTRL_REGADDR(i)); | |
657 | } | |
658 | } | |
659 | set_irq_types(); | |
660 | } | |
661 | gpio_evmi->settle_time = old_settle_time; | |
662 | gpio_evmi->poll_time = old_poll_time; | |
663 | ||
664 | if (gpio_evmi->sw_fixup != old_sw_fixup) { | |
665 | printk(KERN_INFO PREFIX "Restoring fixup handler\n"); | |
666 | gpio_evmi->sw_fixup = old_sw_fixup; | |
667 | } | |
668 | } | |
669 | hw_debounce_set(0, 0); | |
670 | device_remove_file(&debounce_device, &dev_attr_debounce_delay); | |
671 | device_remove_file(&debounce_device, &dev_attr_settle_time); | |
672 | device_remove_file(&debounce_device, &dev_attr_poll_time); | |
673 | device_remove_file(&debounce_device, &dev_attr_flags); | |
674 | device_remove_file(&debounce_device, &dev_attr_debounce_flag); | |
675 | device_remove_file(&debounce_device, &dev_attr_remove_some_phantom_keys_flag); | |
676 | device_remove_file(&debounce_device, &dev_attr_print_unmapped_keys_flag); | |
677 | device_remove_file(&debounce_device, &dev_attr_print_mapped_keys_flag); | |
678 | device_remove_file(&debounce_device, &dev_attr_print_phantom_keys_flag); | |
679 | device_remove_file(&debounce_device, &dev_attr_active_high_flag); | |
680 | device_remove_file(&debounce_device, &dev_attr_level_triggered_irq_flag); | |
681 | device_remove_file(&debounce_device, &dev_attr_drive_inactive_flag); | |
682 | device_remove_file(&debounce_device, &dev_attr_hw_debounce); | |
683 | device_remove_file(&debounce_device, &dev_attr_hw_debounce_time); | |
684 | device_unregister(&debounce_device); | |
685 | } | |
686 | ||
687 | module_init(debounce_init); | |
688 | module_exit(debounce_exit); | |
689 | ||
690 | MODULE_LICENSE("GPL"); | |
691 | MODULE_AUTHOR("Michael Gernoth <michael@gernoth.net>"); |