LXR linux/arch/sh/boards/mach-landisk/psw.c

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