Logo Search packages:      
Sourcecode: linux version File versions

psw.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 <asm/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);

Generated by  Doxygen 1.6.0   Back to index