]>
Commit | Line | Data |
---|---|---|
9daa0c25 PM |
1 | /* |
2 | * arch/sh/boards/renesas/r7780rp/psw.c | |
3 | * | |
4 | * push switch support for RDBRP-1/RDBREVRP-1 debug boards. | |
5 | * | |
6 | * Copyright (C) 2006 Paul Mundt | |
7 | * | |
8 | * This file is subject to the terms and conditions of the GNU General Public | |
9 | * License. See the file "COPYING" in the main directory of this archive | |
10 | * for more details. | |
11 | */ | |
12 | #include <linux/io.h> | |
0bbad249 | 13 | #include <linux/module.h> |
9daa0c25 PM |
14 | #include <linux/interrupt.h> |
15 | #include <linux/platform_device.h> | |
7639a454 | 16 | #include <mach/highlander.h> |
9daa0c25 PM |
17 | #include <asm/push-switch.h> |
18 | ||
19 | static irqreturn_t psw_irq_handler(int irq, void *arg) | |
20 | { | |
21 | struct platform_device *pdev = arg; | |
22 | struct push_switch *psw = platform_get_drvdata(pdev); | |
23 | struct push_switch_platform_info *psw_info = pdev->dev.platform_data; | |
24 | unsigned int l, mask; | |
25 | int ret = 0; | |
26 | ||
9d56dd3b | 27 | l = __raw_readw(PA_DBSW); |
9daa0c25 PM |
28 | |
29 | /* Nothing to do if there's no state change */ | |
30 | if (psw->state) { | |
31 | ret = 1; | |
32 | goto out; | |
33 | } | |
34 | ||
35 | mask = l & 0x70; | |
36 | /* Figure out who raised it */ | |
37 | if (mask & (1 << psw_info->bit)) { | |
38 | psw->state = !!(mask & (1 << psw_info->bit)); | |
39 | if (psw->state) /* debounce */ | |
40 | mod_timer(&psw->debounce, jiffies + 50); | |
41 | ||
42 | ret = 1; | |
43 | } | |
44 | ||
45 | out: | |
46 | /* Clear the switch IRQs */ | |
47 | l |= (0x7 << 12); | |
9d56dd3b | 48 | __raw_writew(l, PA_DBSW); |
9daa0c25 PM |
49 | |
50 | return IRQ_RETVAL(ret); | |
51 | } | |
52 | ||
53 | static struct resource psw_resources[] = { | |
54 | [0] = { | |
55 | .start = IRQ_PSW, | |
56 | .flags = IORESOURCE_IRQ, | |
57 | }, | |
58 | }; | |
59 | ||
60 | static struct push_switch_platform_info s2_platform_data = { | |
61 | .name = "s2", | |
62 | .bit = 6, | |
63 | .irq_flags = IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING | | |
64 | IRQF_SHARED, | |
65 | .irq_handler = psw_irq_handler, | |
66 | }; | |
67 | ||
68 | static struct platform_device s2_switch_device = { | |
69 | .name = "push-switch", | |
70 | .id = 0, | |
71 | .num_resources = ARRAY_SIZE(psw_resources), | |
72 | .resource = psw_resources, | |
73 | .dev = { | |
74 | .platform_data = &s2_platform_data, | |
75 | }, | |
76 | }; | |
77 | ||
78 | static struct push_switch_platform_info s3_platform_data = { | |
79 | .name = "s3", | |
80 | .bit = 5, | |
81 | .irq_flags = IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING | | |
82 | IRQF_SHARED, | |
83 | .irq_handler = psw_irq_handler, | |
84 | }; | |
85 | ||
86 | static struct platform_device s3_switch_device = { | |
87 | .name = "push-switch", | |
88 | .id = 1, | |
89 | .num_resources = ARRAY_SIZE(psw_resources), | |
90 | .resource = psw_resources, | |
91 | .dev = { | |
92 | .platform_data = &s3_platform_data, | |
93 | }, | |
94 | }; | |
95 | ||
96 | static struct push_switch_platform_info s4_platform_data = { | |
97 | .name = "s4", | |
98 | .bit = 4, | |
99 | .irq_flags = IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING | | |
100 | IRQF_SHARED, | |
101 | .irq_handler = psw_irq_handler, | |
102 | }; | |
103 | ||
104 | static struct platform_device s4_switch_device = { | |
105 | .name = "push-switch", | |
106 | .id = 2, | |
107 | .num_resources = ARRAY_SIZE(psw_resources), | |
108 | .resource = psw_resources, | |
109 | .dev = { | |
110 | .platform_data = &s4_platform_data, | |
111 | }, | |
112 | }; | |
113 | ||
114 | static struct platform_device *psw_devices[] = { | |
115 | &s2_switch_device, &s3_switch_device, &s4_switch_device, | |
116 | }; | |
117 | ||
118 | static int __init psw_init(void) | |
119 | { | |
120 | return platform_add_devices(psw_devices, ARRAY_SIZE(psw_devices)); | |
121 | } | |
122 | module_init(psw_init); |