xref: /OK3568_Linux_fs/kernel/arch/sh/boards/mach-landisk/psw.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * arch/sh/boards/landisk/psw.c
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * push switch support for LANDISK and USL-5P
6*4882a593Smuzhiyun  *
7*4882a593Smuzhiyun  * Copyright (C) 2006-2007  Paul Mundt
8*4882a593Smuzhiyun  * Copyright (C) 2007  kogiidena
9*4882a593Smuzhiyun  */
10*4882a593Smuzhiyun #include <linux/io.h>
11*4882a593Smuzhiyun #include <linux/init.h>
12*4882a593Smuzhiyun #include <linux/interrupt.h>
13*4882a593Smuzhiyun #include <linux/platform_device.h>
14*4882a593Smuzhiyun #include <mach-landisk/mach/iodata_landisk.h>
15*4882a593Smuzhiyun #include <asm/push-switch.h>
16*4882a593Smuzhiyun 
psw_irq_handler(int irq,void * arg)17*4882a593Smuzhiyun static irqreturn_t psw_irq_handler(int irq, void *arg)
18*4882a593Smuzhiyun {
19*4882a593Smuzhiyun 	struct platform_device *pdev = arg;
20*4882a593Smuzhiyun 	struct push_switch *psw = platform_get_drvdata(pdev);
21*4882a593Smuzhiyun 	struct push_switch_platform_info *psw_info = pdev->dev.platform_data;
22*4882a593Smuzhiyun 	unsigned int sw_value;
23*4882a593Smuzhiyun 	int ret = 0;
24*4882a593Smuzhiyun 
25*4882a593Smuzhiyun 	sw_value = (0x0ff & (~__raw_readb(PA_STATUS)));
26*4882a593Smuzhiyun 
27*4882a593Smuzhiyun 	/* Nothing to do if there's no state change */
28*4882a593Smuzhiyun 	if (psw->state) {
29*4882a593Smuzhiyun 		ret = 1;
30*4882a593Smuzhiyun 		goto out;
31*4882a593Smuzhiyun 	}
32*4882a593Smuzhiyun 
33*4882a593Smuzhiyun 	/* Figure out who raised it */
34*4882a593Smuzhiyun 	if (sw_value & (1 << psw_info->bit)) {
35*4882a593Smuzhiyun 		psw->state = 1;
36*4882a593Smuzhiyun 		mod_timer(&psw->debounce, jiffies + 50);
37*4882a593Smuzhiyun 		ret = 1;
38*4882a593Smuzhiyun 	}
39*4882a593Smuzhiyun 
40*4882a593Smuzhiyun out:
41*4882a593Smuzhiyun 	/* Clear the switch IRQs */
42*4882a593Smuzhiyun 	__raw_writeb(0x00, PA_PWRINT_CLR);
43*4882a593Smuzhiyun 
44*4882a593Smuzhiyun 	return IRQ_RETVAL(ret);
45*4882a593Smuzhiyun }
46*4882a593Smuzhiyun 
47*4882a593Smuzhiyun static struct resource psw_power_resources[] = {
48*4882a593Smuzhiyun 	[0] = {
49*4882a593Smuzhiyun 		.start = IRQ_POWER,
50*4882a593Smuzhiyun 		.flags = IORESOURCE_IRQ,
51*4882a593Smuzhiyun        },
52*4882a593Smuzhiyun };
53*4882a593Smuzhiyun 
54*4882a593Smuzhiyun static struct resource psw_usl5p_resources[] = {
55*4882a593Smuzhiyun 	[0] = {
56*4882a593Smuzhiyun 		.start = IRQ_BUTTON,
57*4882a593Smuzhiyun 		.flags = IORESOURCE_IRQ,
58*4882a593Smuzhiyun 	},
59*4882a593Smuzhiyun };
60*4882a593Smuzhiyun 
61*4882a593Smuzhiyun static struct push_switch_platform_info psw_power_platform_data = {
62*4882a593Smuzhiyun 	.name		= "psw_power",
63*4882a593Smuzhiyun 	.bit		= 4,
64*4882a593Smuzhiyun 	.irq_flags	= IRQF_SHARED,
65*4882a593Smuzhiyun 	.irq_handler	= psw_irq_handler,
66*4882a593Smuzhiyun };
67*4882a593Smuzhiyun 
68*4882a593Smuzhiyun static struct push_switch_platform_info psw1_platform_data = {
69*4882a593Smuzhiyun 	.name		= "psw1",
70*4882a593Smuzhiyun 	.bit		= 0,
71*4882a593Smuzhiyun 	.irq_flags	= IRQF_SHARED,
72*4882a593Smuzhiyun 	.irq_handler	= psw_irq_handler,
73*4882a593Smuzhiyun };
74*4882a593Smuzhiyun 
75*4882a593Smuzhiyun static struct push_switch_platform_info psw2_platform_data = {
76*4882a593Smuzhiyun 	.name		= "psw2",
77*4882a593Smuzhiyun 	.bit		= 2,
78*4882a593Smuzhiyun 	.irq_flags	= IRQF_SHARED,
79*4882a593Smuzhiyun 	.irq_handler	= psw_irq_handler,
80*4882a593Smuzhiyun };
81*4882a593Smuzhiyun 
82*4882a593Smuzhiyun static struct push_switch_platform_info psw3_platform_data = {
83*4882a593Smuzhiyun 	.name		= "psw3",
84*4882a593Smuzhiyun 	.bit		= 1,
85*4882a593Smuzhiyun 	.irq_flags	= IRQF_SHARED,
86*4882a593Smuzhiyun 	.irq_handler	= psw_irq_handler,
87*4882a593Smuzhiyun };
88*4882a593Smuzhiyun 
89*4882a593Smuzhiyun static struct platform_device psw_power_switch_device = {
90*4882a593Smuzhiyun 	.name		= "push-switch",
91*4882a593Smuzhiyun 	.id		= 0,
92*4882a593Smuzhiyun 	.num_resources	= ARRAY_SIZE(psw_power_resources),
93*4882a593Smuzhiyun 	.resource	= psw_power_resources,
94*4882a593Smuzhiyun 	.dev		= {
95*4882a593Smuzhiyun 		.platform_data = &psw_power_platform_data,
96*4882a593Smuzhiyun 	},
97*4882a593Smuzhiyun };
98*4882a593Smuzhiyun 
99*4882a593Smuzhiyun static struct platform_device psw1_switch_device = {
100*4882a593Smuzhiyun 	.name		= "push-switch",
101*4882a593Smuzhiyun 	.id		= 1,
102*4882a593Smuzhiyun 	.num_resources	= ARRAY_SIZE(psw_usl5p_resources),
103*4882a593Smuzhiyun 	.resource	= psw_usl5p_resources,
104*4882a593Smuzhiyun 	.dev		= {
105*4882a593Smuzhiyun 		.platform_data = &psw1_platform_data,
106*4882a593Smuzhiyun 	},
107*4882a593Smuzhiyun };
108*4882a593Smuzhiyun 
109*4882a593Smuzhiyun static struct platform_device psw2_switch_device = {
110*4882a593Smuzhiyun 	.name		= "push-switch",
111*4882a593Smuzhiyun 	.id		= 2,
112*4882a593Smuzhiyun 	.num_resources	= ARRAY_SIZE(psw_usl5p_resources),
113*4882a593Smuzhiyun 	.resource	= psw_usl5p_resources,
114*4882a593Smuzhiyun 	.dev		= {
115*4882a593Smuzhiyun 		.platform_data = &psw2_platform_data,
116*4882a593Smuzhiyun 	},
117*4882a593Smuzhiyun };
118*4882a593Smuzhiyun 
119*4882a593Smuzhiyun static struct platform_device psw3_switch_device = {
120*4882a593Smuzhiyun 	.name		= "push-switch",
121*4882a593Smuzhiyun 	.id		= 3,
122*4882a593Smuzhiyun 	.num_resources	= ARRAY_SIZE(psw_usl5p_resources),
123*4882a593Smuzhiyun 	.resource	= psw_usl5p_resources,
124*4882a593Smuzhiyun 	.dev = {
125*4882a593Smuzhiyun 		.platform_data = &psw3_platform_data,
126*4882a593Smuzhiyun 	},
127*4882a593Smuzhiyun };
128*4882a593Smuzhiyun 
129*4882a593Smuzhiyun static struct platform_device *psw_devices[] = {
130*4882a593Smuzhiyun 	&psw_power_switch_device,
131*4882a593Smuzhiyun 	&psw1_switch_device,
132*4882a593Smuzhiyun 	&psw2_switch_device,
133*4882a593Smuzhiyun 	&psw3_switch_device,
134*4882a593Smuzhiyun };
135*4882a593Smuzhiyun 
psw_init(void)136*4882a593Smuzhiyun static int __init psw_init(void)
137*4882a593Smuzhiyun {
138*4882a593Smuzhiyun 	return platform_add_devices(psw_devices, ARRAY_SIZE(psw_devices));
139*4882a593Smuzhiyun }
140*4882a593Smuzhiyun device_initcall(psw_init);
141