arch/sh/boards/mach-landisk/irq.c

   1 /*
   2  * arch/sh/boards/landisk/irq.c
   3  *
   4  * I-O DATA Device, Inc. LANDISK Support
   5  *
   6  * Copyright (C) 2005-2007 kogiidena
   7  *
   8  * Copyright (C) 2001  Ian da Silva, Jeremy Siegel
   9  * Based largely on io_se.c.
  10  *
  11  * This file is subject to the terms and conditions of the GNU General Public
  12  * License.  See the file "COPYING" in the main directory of this archive
  13  * for more details.
  14  */
  15 #include <linux/init.h>
  16 #include <linux/irq.h>
  17 #include <linux/interrupt.h>
  18 #include <linux/io.h>
  19 #include <mach-landisk/mach/iodata_landisk.h>
  20
  21 static void disable_landisk_irq(struct irq_data *data)
  22 {
  23         unsigned char mask = 0xff ^ (0x01 << (data->irq - 5));
  24
  25         __raw_writeb(__raw_readb(PA_IMASK) & mask, PA_IMASK);
  26 }
  27
  28 static void enable_landisk_irq(struct irq_data *data)
  29 {
  30         unsigned char value = (0x01 << (data->irq - 5));
  31
  32         __raw_writeb(__raw_readb(PA_IMASK) | value, PA_IMASK);
  33 }
  34
  35 static struct irq_chip landisk_irq_chip __read_mostly = {
  36         .name           = "LANDISK",
  37         .irq_mask       = disable_landisk_irq,
  38         .irq_unmask     = enable_landisk_irq,
  39 };
  40
  41 /*
  42  * Initialize IRQ setting
  43  */
  44 void __init init_landisk_IRQ(void)
  45 {
  46         int i;
  47
  48         for (i = 5; i < 14; i++) {
  49                 disable_irq_nosync(i);
  50                 set_irq_chip_and_handler_name(i, &landisk_irq_chip,
  51                                               handle_level_irq, "level");
  52                 enable_landisk_irq(irq_get_irq_data(i));
  53         }
  54         __raw_writeb(0x00, PA_PWRINT_CLR);
  55 }