projects / openwrt.git / blob
? search:


92869bb00c1c3581de19c6c365d14fc91e881b98
[openwrt.git] / target / linux / omap24xx / patches-3.1 / 200-omap-platform.patch
1 Index: linux-3.1/arch/arm/plat-omap/bootreason.c
2 ===================================================================
3 --- /dev/null 1970-01-01 00:00:00.000000000 +0000
4 +++ linux-3.1/arch/arm/plat-omap/bootreason.c 2011-10-30 00:48:34.877053219 +0200
5 @@ -0,0 +1,79 @@
6 +/*
7 + * linux/arch/arm/plat-omap/bootreason.c
8 + *
9 + * OMAP Bootreason passing
10 + *
11 + * Copyright (c) 2004 Nokia
12 + *
13 + * Written by David Weinehall <david.weinehall@nokia.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 as published by the
17 + * Free Software Foundation; either version 2 of the License, or (at your
18 + * option) any later version.
19 + *
20 + * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
21 + * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
22 + * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN
23 + * NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
24 + * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
25 + * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
26 + * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
27 + * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
28 + * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
29 + * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30 + *
31 + * You should have received a copy of the GNU General Public License along
32 + * with this program; if not, write to the Free Software Foundation, Inc.,
33 + * 675 Mass Ave, Cambridge, MA 02139, USA.
34 + */
35 +#include <linux/proc_fs.h>
36 +#include <linux/errno.h>
37 +#include <plat/board.h>
38 +
39 +static char boot_reason[16];
40 +
41 +static int omap_bootreason_read_proc(char *page, char **start, off_t off,
42 + int count, int *eof, void *data)
43 +{
44 + int len = 0;
45 +
46 + len += sprintf(page + len, "%s\n", boot_reason);
47 +
48 + *start = page + off;
49 +
50 + if (len > off)
51 + len -= off;
52 + else
53 + len = 0;
54 +
55 + return len < count ? len : count;
56 +}
57 +
58 +static int __init bootreason_init(void)
59 +{
60 + const struct omap_boot_reason_config *cfg;
61 + int reason_valid = 0;
62 +
63 + cfg = omap_get_config(OMAP_TAG_BOOT_REASON, struct omap_boot_reason_config);
64 + if (cfg != NULL) {
65 + strncpy(boot_reason, cfg->reason_str, sizeof(cfg->reason_str));
66 + boot_reason[sizeof(cfg->reason_str)] = 0;
67 + reason_valid = 1;
68 + } else {
69 + /* Read the boot reason from the OMAP registers */
70 + }
71 +
72 + if (!reason_valid)
73 + return -ENOENT;
74 +
75 + printk(KERN_INFO "Bootup reason: %s\n", boot_reason);
76 +
77 + if (!create_proc_read_entry("bootreason", S_IRUGO, NULL,
78 + omap_bootreason_read_proc, NULL))
79 + return -ENOMEM;
80 +
81 + return 0;
82 +}
83 +
84 +late_initcall(bootreason_init);
85 Index: linux-3.1/arch/arm/plat-omap/common.c
86 ===================================================================
87 --- linux-3.1.orig/arch/arm/plat-omap/common.c 2011-10-30 00:48:32.781054651 +0200
88 +++ linux-3.1/arch/arm/plat-omap/common.c 2011-10-30 00:48:34.877053219 +0200
89 @@ -21,18 +21,90 @@
90 #include <plat/vram.h>
91 #include <plat/dsp.h>
92
93 +#include <asm/setup.h>
94 +
95
96 #define NO_LENGTH_CHECK 0xffffffff
97
98 struct omap_board_config_kernel *omap_board_config __initdata;
99 int omap_board_config_size;
100
101 +unsigned char omap_bootloader_tag[1024];
102 +int omap_bootloader_tag_len;
103 +
104 +/* used by omap-smp.c and board-4430sdp.c */
105 +void __iomem *gic_cpu_base_addr;
106 +
107 +#ifdef CONFIG_OMAP_BOOT_TAG
108 +
109 +static int __init parse_tag_omap(const struct tag *tag)
110 +{
111 + u32 size = tag->hdr.size - (sizeof(tag->hdr) >> 2);
112 +
113 + size <<= 2;
114 + if (size > sizeof(omap_bootloader_tag))
115 + return -1;
116 +
117 + memcpy(omap_bootloader_tag, tag->u.omap.data, size);
118 + omap_bootloader_tag_len = size;
119 +
120 + return 0;
121 +}
122 +
123 +__tagtable(ATAG_BOARD, parse_tag_omap);
124 +
125 +#endif
126 +
127 static const void *__init get_config(u16 tag, size_t len,
128 int skip, size_t *len_out)
129 {
130 struct omap_board_config_kernel *kinfo = NULL;
131 int i;
132
133 +#ifdef CONFIG_OMAP_BOOT_TAG
134 + struct omap_board_config_entry *info = NULL;
135 +
136 + if (omap_bootloader_tag_len > 4)
137 + info = (struct omap_board_config_entry *) omap_bootloader_tag;
138 + while (info != NULL) {
139 + u8 *next;
140 +
141 + if (info->tag == tag) {
142 + if (skip == 0)
143 + break;
144 + skip--;
145 + }
146 +
147 + if ((info->len & 0x03) != 0) {
148 + /* We bail out to avoid an alignment fault */
149 + printk(KERN_ERR "OMAP peripheral config: Length (%d) not word-aligned (tag %04x)\n",
150 + info->len, info->tag);
151 + return NULL;
152 + }
153 + next = (u8 *) info + sizeof(*info) + info->len;
154 + if (next >= omap_bootloader_tag + omap_bootloader_tag_len)
155 + info = NULL;
156 + else
157 + info = (struct omap_board_config_entry *) next;
158 + }
159 + if (info != NULL) {
160 + /* Check the length as a lame attempt to check for
161 + * binary inconsistency. */
162 + if (len != NO_LENGTH_CHECK) {
163 + /* Word-align len */
164 + if (len & 0x03)
165 + len = (len + 3) & ~0x03;
166 + if (info->len != len) {
167 + printk(KERN_ERR "OMAP peripheral config: Length mismatch with tag %x (want %d, got %d)\n",
168 + tag, len, info->len);
169 + return NULL;
170 + }
171 + }
172 + if (len_out != NULL)
173 + *len_out = info->len;
174 + return info->data;
175 + }
176 +#endif
177 /* Try to find the config from the board-specific structures
178 * in the kernel. */
179 for (i = 0; i < omap_board_config_size; i++) {
180 Index: linux-3.1/arch/arm/plat-omap/component-version.c
181 ===================================================================
182 --- /dev/null 1970-01-01 00:00:00.000000000 +0000
183 +++ linux-3.1/arch/arm/plat-omap/component-version.c 2011-10-30 00:48:34.877053219 +0200
184 @@ -0,0 +1,64 @@
185 +/*
186 + * linux/arch/arm/plat-omap/component-version.c
187 + *
188 + * Copyright (C) 2005 Nokia Corporation
189 + * Written by Juha Yrjölä <juha.yrjola@nokia.com>
190 + *
191 + * This program is free software; you can redistribute it and/or modify
192 + * it under the terms of the GNU General Public License version 2 as
193 + * published by the Free Software Foundation.
194 + */
195 +
196 +#include <linux/init.h>
197 +#include <linux/module.h>
198 +#include <linux/err.h>
199 +#include <linux/proc_fs.h>
200 +#include <plat/board.h>
201 +
202 +static int component_version_read_proc(char *page, char **start, off_t off,
203 + int count, int *eof, void *data)
204 +{
205 + int len, i;
206 + const struct omap_version_config *ver;
207 + char *p;
208 +
209 + i = 0;
210 + p = page;
211 + while ((ver = omap_get_nr_config(OMAP_TAG_VERSION_STR,
212 + struct omap_version_config, i)) != NULL) {
213 + p += sprintf(p, "%-12s%s\n", ver->component, ver->version);
214 + i++;
215 + }
216 +
217 + len = (p - page) - off;
218 + if (len < 0)
219 + len = 0;
220 +
221 + *eof = (len <= count) ? 1 : 0;
222 + *start = page + off;
223 +
224 + return len;
225 +}
226 +
227 +static int __init component_version_init(void)
228 +{
229 + if (omap_get_config(OMAP_TAG_VERSION_STR, struct omap_version_config) == NULL)
230 + return -ENODEV;
231 + if (!create_proc_read_entry("component_version", S_IRUGO, NULL,
232 + component_version_read_proc, NULL))
233 + return -ENOMEM;
234 +
235 + return 0;
236 +}
237 +
238 +static void __exit component_version_exit(void)
239 +{
240 + remove_proc_entry("component_version", NULL);
241 +}
242 +
243 +late_initcall(component_version_init);
244 +module_exit(component_version_exit);
245 +
246 +MODULE_AUTHOR("Juha Yrjölä <juha.yrjola@nokia.com>");
247 +MODULE_DESCRIPTION("Component version driver");
248 +MODULE_LICENSE("GPL");
249 Index: linux-3.1/arch/arm/plat-omap/Kconfig
250 ===================================================================
251 --- linux-3.1.orig/arch/arm/plat-omap/Kconfig 2011-10-30 00:48:32.933054543 +0200
252 +++ linux-3.1/arch/arm/plat-omap/Kconfig 2011-10-30 00:48:34.877053219 +0200
253 @@ -82,6 +82,38 @@ config OMAP_RESET_CLOCKS
254 probably do not want this option enabled until your
255 device drivers work properly.
256
257 +config OMAP_BOOT_TAG
258 + bool "OMAP bootloader information passing"
259 + depends on ARCH_OMAP
260 + default n
261 + help
262 + Say Y, if you have a bootloader which passes information
263 + about your board and its peripheral configuration.
264 +
265 +config OMAP_BOOT_REASON
266 + bool "Support for boot reason"
267 + depends on OMAP_BOOT_TAG
268 + default n
269 + help
270 + Say Y, if you want to have a procfs entry for reading the boot
271 + reason in user-space.
272 +
273 +config OMAP_COMPONENT_VERSION
274 + bool "Support for component version display"
275 + depends on OMAP_BOOT_TAG && PROC_FS
276 + default n
277 + help
278 + Say Y, if you want to have a procfs entry for reading component
279 + versions (supplied by the bootloader) in user-space.
280 +
281 +config OMAP_GPIO_SWITCH
282 + bool "GPIO switch support"
283 + help
284 + Say Y, if you want to have support for reporting of GPIO
285 + switches (e.g. cover switches) via sysfs. Your bootloader has
286 + to provide information about the switches to the kernel via the
287 + ATAG_BOARD mechanism if they're not defined by the board config.
288 +
289 config OMAP_MUX
290 bool "OMAP multiplexing support"
291 depends on ARCH_OMAP
292 Index: linux-3.1/arch/arm/plat-omap/Makefile
293 ===================================================================
294 --- linux-3.1.orig/arch/arm/plat-omap/Makefile 2011-10-30 00:48:32.953054530 +0200
295 +++ linux-3.1/arch/arm/plat-omap/Makefile 2011-10-30 00:48:34.877053219 +0200
296 @@ -23,6 +23,9 @@ obj-$(CONFIG_OMAP_IOMMU_DEBUG) += iommu-
297
298 obj-$(CONFIG_CPU_FREQ) += cpu-omap.o
299 obj-$(CONFIG_OMAP_DM_TIMER) += dmtimer.o
300 +obj-$(CONFIG_OMAP_BOOT_REASON) += bootreason.o
301 +obj-$(CONFIG_OMAP_COMPONENT_VERSION) += component-version.o
302 +obj-$(CONFIG_OMAP_GPIO_SWITCH) += gpio-switch.o
303 obj-$(CONFIG_OMAP_DEBUG_DEVICES) += debug-devices.o
304 obj-$(CONFIG_OMAP_DEBUG_LEDS) += debug-leds.o
305 i2c-omap-$(CONFIG_I2C_OMAP) := i2c.o
306 Index: linux-3.1/arch/arm/include/asm/setup.h
307 ===================================================================
308 --- linux-3.1.orig/arch/arm/include/asm/setup.h 2011-10-30 00:48:32.965054522 +0200
309 +++ linux-3.1/arch/arm/include/asm/setup.h 2011-10-30 00:48:34.877053219 +0200
310 @@ -136,6 +136,13 @@ struct tag_acorn {
311 __u8 adfsdrives;
312 };
313
314 +/* TI OMAP specific information */
315 +#define ATAG_BOARD 0x414f4d50
316 +
317 +struct tag_omap {
318 + u8 data[0];
319 +};
320 +
321 /* footbridge memory clock, see arch/arm/mach-footbridge/arch.c */
322 #define ATAG_MEMCLK 0x41000402
323
324 @@ -162,6 +169,11 @@ struct tag {
325 struct tag_acorn acorn;
326
327 /*
328 + * OMAP specific
329 + */
330 + struct tag_omap omap;
331 +
332 + /*
333 * DC21285 specific
334 */
335 struct tag_memclk memclk;
336 Index: linux-3.1/arch/arm/plat-omap/gpio-switch.c
337 ===================================================================
338 --- /dev/null 1970-01-01 00:00:00.000000000 +0000
339 +++ linux-3.1/arch/arm/plat-omap/gpio-switch.c 2011-10-30 00:48:34.877053219 +0200
340 @@ -0,0 +1,554 @@
341 +/*
342 + * linux/arch/arm/plat-omap/gpio-switch.c
343 + *
344 + * Copyright (C) 2004-2006 Nokia Corporation
345 + * Written by Juha Yrjölä <juha.yrjola@nokia.com>
346 + * and Paul Mundt <paul.mundt@nokia.com>
347 + *
348 + * This program is free software; you can redistribute it and/or modify
349 + * it under the terms of the GNU General Public License version 2 as
350 + * published by the Free Software Foundation.
351 + */
352 +
353 +#include <linux/sched.h>
354 +#include <linux/init.h>
355 +#include <linux/list.h>
356 +#include <linux/irq.h>
357 +#include <linux/interrupt.h>
358 +#include <linux/module.h>
359 +#include <linux/platform_device.h>
360 +#include <linux/timer.h>
361 +#include <linux/err.h>
362 +#include <linux/slab.h>
363 +#include <linux/gpio.h>
364 +#include <plat/hardware.h>
365 +#include <plat/irqs.h>
366 +#include <plat/mux.h>
367 +#include <plat/board.h>
368 +#include <plat/gpio-switch.h>
369 +
370 +struct gpio_switch {
371 + char name[14];
372 + u16 gpio;
373 + unsigned flags:4;
374 + unsigned type:4;
375 + unsigned state:1;
376 + unsigned both_edges:1;
377 +
378 + u16 debounce_rising;
379 + u16 debounce_falling;
380 +
381 + void (* notify)(void *data, int state);
382 + void *notify_data;
383 +
384 + struct work_struct work;
385 + struct timer_list timer;
386 + struct platform_device pdev;
387 +
388 + struct list_head node;
389 +};
390 +
391 +static LIST_HEAD(gpio_switches);
392 +static struct platform_device *gpio_sw_platform_dev;
393 +static struct platform_driver gpio_sw_driver;
394 +
395 +static const struct omap_gpio_switch *board_gpio_sw_table;
396 +static int board_gpio_sw_count;
397 +
398 +static const char *cover_str[2] = { "open", "closed" };
399 +static const char *connection_str[2] = { "disconnected", "connected" };
400 +static const char *activity_str[2] = { "inactive", "active" };
401 +
402 +/*
403 + * GPIO switch state default debounce delay in ms
404 + */
405 +#define OMAP_GPIO_SW_DEFAULT_DEBOUNCE 10
406 +
407 +static const char **get_sw_str(struct gpio_switch *sw)
408 +{
409 + switch (sw->type) {
410 + case OMAP_GPIO_SWITCH_TYPE_COVER:
411 + return cover_str;
412 + case OMAP_GPIO_SWITCH_TYPE_CONNECTION:
413 + return connection_str;
414 + case OMAP_GPIO_SWITCH_TYPE_ACTIVITY:
415 + return activity_str;
416 + default:
417 + BUG();
418 + return NULL;
419 + }
420 +}
421 +
422 +static const char *get_sw_type(struct gpio_switch *sw)
423 +{
424 + switch (sw->type) {
425 + case OMAP_GPIO_SWITCH_TYPE_COVER:
426 + return "cover";
427 + case OMAP_GPIO_SWITCH_TYPE_CONNECTION:
428 + return "connection";
429 + case OMAP_GPIO_SWITCH_TYPE_ACTIVITY:
430 + return "activity";
431 + default:
432 + BUG();
433 + return NULL;
434 + }
435 +}
436 +
437 +static void print_sw_state(struct gpio_switch *sw, int state)
438 +{
439 + const char **str;
440 +
441 + str = get_sw_str(sw);
442 + if (str != NULL)
443 + printk(KERN_INFO "%s (GPIO %d) is now %s\n", sw->name, sw->gpio, str[state]);
444 +}
445 +
446 +static int gpio_sw_get_state(struct gpio_switch *sw)
447 +{
448 + int state;
449 +
450 + state = gpio_get_value(sw->gpio);
451 + if (sw->flags & OMAP_GPIO_SWITCH_FLAG_INVERTED)
452 + state = !state;
453 +
454 + return state;
455 +}
456 +
457 +static ssize_t gpio_sw_state_store(struct device *dev,
458 + struct device_attribute *attr,
459 + const char *buf,
460 + size_t count)
461 +{
462 + struct gpio_switch *sw = dev_get_drvdata(dev);
463 + const char **str;
464 + char state[16];
465 + int enable;
466 +
467 + if (!(sw->flags & OMAP_GPIO_SWITCH_FLAG_OUTPUT))
468 + return -EPERM;
469 +
470 + if (sscanf(buf, "%15s", state) != 1)
471 + return -EINVAL;
472 +
473 + str = get_sw_str(sw);
474 + if (strcmp(state, str[0]) == 0)
475 + sw->state = enable = 0;
476 + else if (strcmp(state, str[1]) == 0)
477 + sw->state = enable = 1;
478 + else
479 + return -EINVAL;
480 +
481 + if (sw->flags & OMAP_GPIO_SWITCH_FLAG_INVERTED)
482 + enable = !enable;
483 + gpio_set_value(sw->gpio, enable);
484 +
485 + return count;
486 +}
487 +
488 +static ssize_t gpio_sw_state_show(struct device *dev,
489 + struct device_attribute *attr,
490 + char *buf)
491 +{
492 + struct gpio_switch *sw = dev_get_drvdata(dev);
493 + const char **str;
494 +
495 + str = get_sw_str(sw);
496 + return sprintf(buf, "%s\n", str[sw->state]);
497 +}
498 +
499 +static DEVICE_ATTR(state, S_IRUGO | S_IWUSR, gpio_sw_state_show,
500 + gpio_sw_state_store);
501 +
502 +static ssize_t gpio_sw_type_show(struct device *dev,
503 + struct device_attribute *attr,
504 + char *buf)
505 +{
506 + struct gpio_switch *sw = dev_get_drvdata(dev);
507 +
508 + return sprintf(buf, "%s\n", get_sw_type(sw));
509 +}
510 +
511 +static DEVICE_ATTR(type, S_IRUGO, gpio_sw_type_show, NULL);
512 +
513 +static ssize_t gpio_sw_direction_show(struct device *dev,
514 + struct device_attribute *attr,
515 + char *buf)
516 +{
517 + struct gpio_switch *sw = dev_get_drvdata(dev);
518 + int is_output;
519 +
520 + is_output = sw->flags & OMAP_GPIO_SWITCH_FLAG_OUTPUT;
521 + return sprintf(buf, "%s\n", is_output ? "output" : "input");
522 +}
523 +
524 +static DEVICE_ATTR(direction, S_IRUGO, gpio_sw_direction_show, NULL);
525 +
526 +
527 +static irqreturn_t gpio_sw_irq_handler(int irq, void *arg)
528 +{
529 + struct gpio_switch *sw = arg;
530 + unsigned long timeout;
531 + int state;
532 +
533 + if (!sw->both_edges) {
534 + if (gpio_get_value(sw->gpio))
535 + irq_set_irq_type(OMAP_GPIO_IRQ(sw->gpio), IRQ_TYPE_EDGE_FALLING);
536 + else
537 + irq_set_irq_type(OMAP_GPIO_IRQ(sw->gpio), IRQ_TYPE_EDGE_RISING);
538 + }
539 +
540 + state = gpio_sw_get_state(sw);
541 + if (sw->state == state)
542 + return IRQ_HANDLED;
543 +
544 + if (state)
545 + timeout = sw->debounce_rising;
546 + else
547 + timeout = sw->debounce_falling;
548 + if (!timeout)
549 + schedule_work(&sw->work);
550 + else
551 + mod_timer(&sw->timer, jiffies + msecs_to_jiffies(timeout));
552 +
553 + return IRQ_HANDLED;
554 +}
555 +
556 +static void gpio_sw_timer(unsigned long arg)
557 +{
558 + struct gpio_switch *sw = (struct gpio_switch *) arg;
559 +
560 + schedule_work(&sw->work);
561 +}
562 +
563 +static void gpio_sw_handler(struct work_struct *work)
564 +{
565 + struct gpio_switch *sw = container_of(work, struct gpio_switch, work);
566 + int state;
567 +
568 + state = gpio_sw_get_state(sw);
569 + if (sw->state == state)
570 + return;
571 +
572 + sw->state = state;
573 + if (sw->notify != NULL)
574 + sw->notify(sw->notify_data, state);
575 + sysfs_notify(&sw->pdev.dev.kobj, NULL, "state");
576 + print_sw_state(sw, state);
577 +}
578 +
579 +static int __init can_do_both_edges(struct gpio_switch *sw)
580 +{
581 + if (!cpu_class_is_omap1())
582 + return 1;
583 + if (OMAP_GPIO_IS_MPUIO(sw->gpio))
584 + return 0;
585 + else
586 + return 1;
587 +}
588 +
589 +static void gpio_sw_release(struct device *dev)
590 +{
591 +}
592 +
593 +static int __init new_switch(struct gpio_switch *sw)
594 +{
595 + int r, direction, trigger;
596 +
597 + switch (sw->type) {
598 + case OMAP_GPIO_SWITCH_TYPE_COVER:
599 + case OMAP_GPIO_SWITCH_TYPE_CONNECTION:
600 + case OMAP_GPIO_SWITCH_TYPE_ACTIVITY:
601 + break;
602 + default:
603 + printk(KERN_ERR "invalid GPIO switch type: %d\n", sw->type);
604 + return -EINVAL;
605 + }
606 +
607 + sw->pdev.name = sw->name;
608 + sw->pdev.id = -1;
609 +
610 + sw->pdev.dev.parent = &gpio_sw_platform_dev->dev;
611 + sw->pdev.dev.driver = &gpio_sw_driver.driver;
612 + sw->pdev.dev.release = gpio_sw_release;
613 +
614 + r = platform_device_register(&sw->pdev);
615 + if (r) {
616 + printk(KERN_ERR "gpio-switch: platform device registration "
617 + "failed for %s", sw->name);
618 + return r;
619 + }
620 + dev_set_drvdata(&sw->pdev.dev, sw);
621 +
622 + r = gpio_request(sw->gpio, "gpio-switch");
623 + if (r < 0) {
624 + platform_device_unregister(&sw->pdev);
625 + return r;
626 + }
627 +
628 + /* input: 1, output: 0 */
629 + direction = !(sw->flags & OMAP_GPIO_SWITCH_FLAG_OUTPUT);
630 + if (direction)
631 + gpio_direction_input(sw->gpio);
632 + else
633 + gpio_direction_output(sw->gpio, 0);
634 +
635 + sw->state = gpio_sw_get_state(sw);
636 +
637 + r = 0;
638 + r |= device_create_file(&sw->pdev.dev, &dev_attr_state);
639 + r |= device_create_file(&sw->pdev.dev, &dev_attr_type);
640 + r |= device_create_file(&sw->pdev.dev, &dev_attr_direction);
641 + if (r)
642 + printk(KERN_ERR "gpio-switch: attribute file creation "
643 + "failed for %s\n", sw->name);
644 +
645 + if (!direction)
646 + return 0;
647 +
648 + if (can_do_both_edges(sw)) {
649 + trigger = IRQF_TRIGGER_FALLING | IRQF_TRIGGER_RISING;
650 + sw->both_edges = 1;
651 + } else {
652 + if (gpio_get_value(sw->gpio))
653 + trigger = IRQF_TRIGGER_FALLING;
654 + else
655 + trigger = IRQF_TRIGGER_RISING;
656 + }
657 + r = request_irq(OMAP_GPIO_IRQ(sw->gpio), gpio_sw_irq_handler,
658 + IRQF_SHARED | trigger, sw->name, sw);
659 + if (r < 0) {
660 + printk(KERN_ERR "gpio-switch: request_irq() failed "
661 + "for GPIO %d\n", sw->gpio);
662 + platform_device_unregister(&sw->pdev);
663 + gpio_free(sw->gpio);
664 + return r;
665 + }
666 +
667 + INIT_WORK(&sw->work, gpio_sw_handler);
668 + init_timer(&sw->timer);
669 +
670 + sw->timer.function = gpio_sw_timer;
671 + sw->timer.data = (unsigned long)sw;
672 +
673 + list_add(&sw->node, &gpio_switches);
674 +
675 + return 0;
676 +}
677 +
678 +static int __init add_atag_switches(void)
679 +{
680 + const struct omap_gpio_switch_config *cfg;
681 + struct gpio_switch *sw;
682 + int i, r;
683 +
684 + for (i = 0; ; i++) {
685 + cfg = omap_get_nr_config(OMAP_TAG_GPIO_SWITCH,
686 + struct omap_gpio_switch_config, i);
687 + if (cfg == NULL)
688 + break;
689 + sw = kzalloc(sizeof(*sw), GFP_KERNEL);
690 + if (sw == NULL) {
691 + printk(KERN_ERR "gpio-switch: kmalloc failed\n");
692 + return -ENOMEM;
693 + }
694 + strncpy(sw->name, cfg->name, sizeof(cfg->name));
695 + sw->gpio = cfg->gpio;
696 + sw->flags = cfg->flags;
697 + sw->type = cfg->type;
698 + sw->debounce_rising = OMAP_GPIO_SW_DEFAULT_DEBOUNCE;
699 + sw->debounce_falling = OMAP_GPIO_SW_DEFAULT_DEBOUNCE;
700 + if ((r = new_switch(sw)) < 0) {
701 + kfree(sw);
702 + return r;
703 + }
704 + }
705 + return 0;
706 +}
707 +
708 +static struct gpio_switch * __init find_switch(int gpio, const char *name)
709 +{
710 + struct gpio_switch *sw;
711 +
712 + list_for_each_entry(sw, &gpio_switches, node) {
713 + if ((gpio < 0 || sw->gpio != gpio) &&
714 + (name == NULL || strcmp(sw->name, name) != 0))
715 + continue;
716 +
717 + if (gpio < 0 || name == NULL)
718 + goto no_check;
719 +
720 + if (strcmp(sw->name, name) != 0)
721 + printk("gpio-switch: name mismatch for %d (%s, %s)\n",
722 + gpio, name, sw->name);
723 + else if (sw->gpio != gpio)
724 + printk("gpio-switch: GPIO mismatch for %s (%d, %d)\n",
725 + name, gpio, sw->gpio);
726 +no_check:
727 + return sw;
728 + }
729 + return NULL;
730 +}
731 +
732 +static int __init add_board_switches(void)
733 +{
734 + int i;
735 +
736 + for (i = 0; i < board_gpio_sw_count; i++) {
737 + const struct omap_gpio_switch *cfg;
738 + struct gpio_switch *sw;
739 + int r;
740 +
741 + cfg = board_gpio_sw_table + i;
742 + if (strlen(cfg->name) > sizeof(sw->name) - 1)
743 + return -EINVAL;
744 + /* Check whether we only update an existing switch
745 + * or add a new switch. */
746 + sw = find_switch(cfg->gpio, cfg->name);
747 + if (sw != NULL) {
748 + sw->debounce_rising = cfg->debounce_rising;
749 + sw->debounce_falling = cfg->debounce_falling;
750 + sw->notify = cfg->notify;
751 + sw->notify_data = cfg->notify_data;
752 + continue;
753 + } else {
754 + if (cfg->gpio < 0 || cfg->name == NULL) {
755 + printk("gpio-switch: required switch not "
756 + "found (%d, %s)\n", cfg->gpio,
757 + cfg->name);
758 + continue;
759 + }
760 + }
761 + sw = kzalloc(sizeof(*sw), GFP_KERNEL);
762 + if (sw == NULL) {
763 + printk(KERN_ERR "gpio-switch: kmalloc failed\n");
764 + return -ENOMEM;
765 + }
766 + strlcpy(sw->name, cfg->name, sizeof(sw->name));
767 + sw->gpio = cfg->gpio;
768 + sw->flags = cfg->flags;
769 + sw->type = cfg->type;
770 + sw->debounce_rising = cfg->debounce_rising;
771 + sw->debounce_falling = cfg->debounce_falling;
772 + sw->notify = cfg->notify;
773 + sw->notify_data = cfg->notify_data;
774 + if ((r = new_switch(sw)) < 0) {
775 + kfree(sw);
776 + return r;
777 + }
778 + }
779 + return 0;
780 +}
781 +
782 +static void gpio_sw_cleanup(void)
783 +{
784 + struct gpio_switch *sw = NULL, *old = NULL;
785 +
786 + list_for_each_entry(sw, &gpio_switches, node) {
787 + if (old != NULL)
788 + kfree(old);
789 + flush_scheduled_work();
790 + del_timer_sync(&sw->timer);
791 +
792 + free_irq(OMAP_GPIO_IRQ(sw->gpio), sw);
793 +
794 + device_remove_file(&sw->pdev.dev, &dev_attr_state);
795 + device_remove_file(&sw->pdev.dev, &dev_attr_type);
796 + device_remove_file(&sw->pdev.dev, &dev_attr_direction);
797 +
798 + platform_device_unregister(&sw->pdev);
799 + gpio_free(sw->gpio);
800 + old = sw;
801 + }
802 + kfree(old);
803 +}
804 +
805 +static void __init report_initial_state(void)
806 +{
807 + struct gpio_switch *sw;
808 +
809 + list_for_each_entry(sw, &gpio_switches, node) {
810 + int state;
811 +
812 + state = gpio_get_value(sw->gpio);
813 + if (sw->flags & OMAP_GPIO_SWITCH_FLAG_INVERTED)
814 + state = !state;
815 + if (sw->notify != NULL)
816 + sw->notify(sw->notify_data, state);
817 + print_sw_state(sw, state);
818 + }
819 +}
820 +
821 +static int gpio_sw_remove(struct platform_device *dev)
822 +{
823 + return 0;
824 +}
825 +
826 +static struct platform_driver gpio_sw_driver = {
827 + .remove = gpio_sw_remove,
828 + .driver = {
829 + .name = "gpio-switch",
830 + },
831 +};
832 +
833 +void __init omap_register_gpio_switches(const struct omap_gpio_switch *tbl,
834 + int count)
835 +{
836 + BUG_ON(board_gpio_sw_table != NULL);
837 +
838 + board_gpio_sw_table = tbl;
839 + board_gpio_sw_count = count;
840 +}
841 +
842 +static int __init gpio_sw_init(void)
843 +{
844 + int r;
845 +
846 + printk(KERN_INFO "OMAP GPIO switch handler initializing\n");
847 +
848 + r = platform_driver_register(&gpio_sw_driver);
849 + if (r)
850 + return r;
851 +
852 + gpio_sw_platform_dev = platform_device_register_simple("gpio-switch",
853 + -1, NULL, 0);
854 + if (IS_ERR(gpio_sw_platform_dev)) {
855 + r = PTR_ERR(gpio_sw_platform_dev);
856 + goto err1;
857 + }
858 +
859 + r = add_atag_switches();
860 + if (r < 0)
861 + goto err2;
862 +
863 + r = add_board_switches();
864 + if (r < 0)
865 + goto err2;
866 +
867 + report_initial_state();
868 +
869 + return 0;
870 +err2:
871 + gpio_sw_cleanup();
872 + platform_device_unregister(gpio_sw_platform_dev);
873 +err1:
874 + platform_driver_unregister(&gpio_sw_driver);
875 + return r;
876 +}
877 +
878 +static void __exit gpio_sw_exit(void)
879 +{
880 + gpio_sw_cleanup();
881 + platform_device_unregister(gpio_sw_platform_dev);
882 + platform_driver_unregister(&gpio_sw_driver);
883 +}
884 +
885 +#ifndef MODULE
886 +late_initcall(gpio_sw_init);
887 +#else
888 +module_init(gpio_sw_init);
889 +#endif
890 +module_exit(gpio_sw_exit);
891 +
892 +MODULE_AUTHOR("Juha Yrjölä <juha.yrjola@nokia.com>, Paul Mundt <paul.mundt@nokia.com");
893 +MODULE_DESCRIPTION("GPIO switch driver");
894 +MODULE_LICENSE("GPL");
895 Index: linux-3.1/arch/arm/plat-omap/include/plat/board.h
896 ===================================================================
897 --- linux-3.1.orig/arch/arm/plat-omap/include/plat/board.h 2011-10-30 00:48:32.949054532 +0200
898 +++ linux-3.1/arch/arm/plat-omap/include/plat/board.h 2011-10-30 00:48:34.877053219 +0200
899 @@ -151,6 +151,14 @@ struct omap_board_config_kernel {
900 const void *data;
901 };
902
903 +struct omap_gpio_switch_config {
904 + char name[12];
905 + u16 gpio;
906 + int flags:4;
907 + int type:4;
908 + int key_code:24; /* Linux key code */
909 +};
910 +
911 extern const void *__init __omap_get_config(u16 tag, size_t len, int nr);
912
913 #define omap_get_config(tag, type) \
Personal OpenWRT clone
This page took 0.074137 seconds and 3 git commands to generate.