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