psw.c

  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
 16static 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(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(&psw->debounce, jiffies + 50);
 38
 39		ret = 1;
 40	}
 41
 42out:
 43	/* Clear the switch IRQs */
 44	l |= (0x7 << 12);
 45	__raw_writew(l, PA_DBSW);
 46
 47	return IRQ_RETVAL(ret);
 48}
 49
 50static struct resource psw_resources[] = {
 51	[0] = {
 52		.start	= IRQ_PSW,
 53		.flags	= IORESOURCE_IRQ,
 54	},
 55};
 56
 57static 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
 65static 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
 75static 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
 83static 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
 93static 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
101static 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
111static struct platform_device *psw_devices[] = {
112	&s2_switch_device, &s3_switch_device, &s4_switch_device,
113};
114
115static int __init psw_init(void)
116{
117	return platform_add_devices(psw_devices, ARRAY_SIZE(psw_devices));
118}
119module_init(psw_init);