123 lines
2.7 KiB
C
123 lines
2.7 KiB
C
|
/*
|
||
|
|
* arch/sh/boards/renesas/r7780rp/psw.c
|
||
|
|
*
|
||
|
|
* push switch support for RDBRP-1/RDBREVRP-1 debug boards.
|
||
|
|
*
|
||
|
|
* Copyright (C) 2006 Paul Mundt
|
||
|
|
*
|
||
|
|
* This file is subject to the terms and conditions of the GNU General Public
|
||
|
|
* License. See the file "COPYING" in the main directory of this archive
|
||
|
|
* for more details.
|
||
|
|
*/
|
||
|
|
#include <linux/io.h>
|
||
|
|
#include <linux/init.h>
|
||
|
|
#include <linux/interrupt.h>
|
||
|
|
#include <linux/platform_device.h>
|
||
|
|
#include <mach/highlander.h>
|
||
|
|
#include <asm/push-switch.h>
|
||
|
|
|
||
|
|
static irqreturn_t psw_irq_handler(int irq, void *arg)
|
||
|
|
{
|
||
|
|
struct platform_device *pdev = arg;
|
||
|
|
struct push_switch *psw = platform_get_drvdata(pdev);
|
||
|
|
struct push_switch_platform_info *psw_info = pdev->dev.platform_data;
|
||
|
|
unsigned int l, mask;
|
||
|
|
int ret = 0;
|
||
|
|
|
||
|
|
l = __raw_readw(PA_DBSW);
|
||
|
|
|
||
|
|
/* Nothing to do if there's no state change */
|
||
|
|
if (psw->state) {
|
||
|
|
ret = 1;
|
||
|
|
goto out;
|
||
|
|
}
|
||
|
|
|
||
|
|
mask = l & 0x70;
|
||
|
|
/* Figure out who raised it */
|
||
|
|
if (mask & (1 << psw_info->bit)) {
|
||
|
|
psw->state = !!(mask & (1 << psw_info->bit));
|
||
|
|
if (psw->state) /* debounce */
|
||
|
|
mod_timer(&psw->debounce, jiffies + 50);
|
||
|
|
|
||
|
|
ret = 1;
|
||
|
|
}
|
||
|
|
|
||
|
|
out:
|
||
|
|
/* Clear the switch IRQs */
|
||
|
|
l |= (0x7 << 12);
|
||
|
|
__raw_writew(l, PA_DBSW);
|
||
|
|
|
||
|
|
return IRQ_RETVAL(ret);
|
||
|
|
}
|
||
|
|
|
||
|
|
static struct resource psw_resources[] = {
|
||
|
|
[0] = {
|
||
|
|
.start = IRQ_PSW,
|
||
|
|
.flags = IORESOURCE_IRQ,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct push_switch_platform_info s2_platform_data = {
|
||
|
|
.name = "s2",
|
||
|
|
.bit = 6,
|
||
|
|
.irq_flags = IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING |
|
||
|
|
IRQF_SHARED,
|
||
|
|
.irq_handler = psw_irq_handler,
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct platform_device s2_switch_device = {
|
||
|
|
.name = "push-switch",
|
||
|
|
.id = 0,
|
||
|
|
.num_resources = ARRAY_SIZE(psw_resources),
|
||
|
|
.resource = psw_resources,
|
||
|
|
.dev = {
|
||
|
|
.platform_data = &s2_platform_data,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct push_switch_platform_info s3_platform_data = {
|
||
|
|
.name = "s3",
|
||
|
|
.bit = 5,
|
||
|
|
.irq_flags = IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING |
|
||
|
|
IRQF_SHARED,
|
||
|
|
.irq_handler = psw_irq_handler,
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct platform_device s3_switch_device = {
|
||
|
|
.name = "push-switch",
|
||
|
|
.id = 1,
|
||
|
|
.num_resources = ARRAY_SIZE(psw_resources),
|
||
|
|
.resource = psw_resources,
|
||
|
|
.dev = {
|
||
|
|
.platform_data = &s3_platform_data,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct push_switch_platform_info s4_platform_data = {
|
||
|
|
.name = "s4",
|
||
|
|
.bit = 4,
|
||
|
|
.irq_flags = IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING |
|
||
|
|
IRQF_SHARED,
|
||
|
|
.irq_handler = psw_irq_handler,
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct platform_device s4_switch_device = {
|
||
|
|
.name = "push-switch",
|
||
|
|
.id = 2,
|
||
|
|
.num_resources = ARRAY_SIZE(psw_resources),
|
||
|
|
.resource = psw_resources,
|
||
|
|
.dev = {
|
||
|
|
.platform_data = &s4_platform_data,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
|
||
|
|
static struct platform_device *psw_devices[] = {
|
||
|
|
&s2_switch_device, &s3_switch_device, &s4_switch_device,
|
||
|
|
};
|
||
|
|
|
||
|
|
static int __init psw_init(void)
|
||
|
|
{
|
||
|
|
return platform_add_devices(psw_devices, ARRAY_SIZE(psw_devices));
|
||
|
|
}
|
||
|
|
module_init(psw_init);
|