Commit 9daa0c25 authored by Paul Mundt's avatar Paul Mundt
Browse files

sh: R7780RP push-switch support. 



This adds simple push-switch support for the RDBRP-1/RDBREVRP-1 debug
boards found on the R7780RP-1.

Signed-off-by: default avatarPaul Mundt <lethal@linux-sh.org>
parent 9f5e8eee

arch/sh/boards/renesas/r7780rp/Makefile

+3 −1
Original line number Diff line number Diff line
@@ -3,4 +3,6 @@ 
#



obj-y	 := setup.o io.o irq.o



obj-$(CONFIG_HEARTBEAT)		+= led.o

obj-$(CONFIG_PUSH_SWITCH)	+= psw.o

arch/sh/boards/renesas/r7780rp/psw.c

0 → 100644
+122 −0
Original line number Diff line number Diff line 
/*

 * 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 <asm/mach/r7780rp.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 = ctrl_inw(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);

	ctrl_outw(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);