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