diff options
Diffstat (limited to 'arch/sh/boards/mach-landisk/irq.c')
| -rw-r--r-- | arch/sh/boards/mach-landisk/irq.c | 56 |
1 files changed, 56 insertions, 0 deletions
diff --git a/arch/sh/boards/mach-landisk/irq.c b/arch/sh/boards/mach-landisk/irq.c new file mode 100644 index 00000000000..7b284cde1f5 --- /dev/null +++ b/arch/sh/boards/mach-landisk/irq.c | |||
| @@ -0,0 +1,56 @@ | |||
| 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(unsigned int irq) | ||
| 22 | { | ||
| 23 | unsigned char mask = 0xff ^ (0x01 << (irq - 5)); | ||
| 24 | |||
| 25 | ctrl_outb(ctrl_inb(PA_IMASK) & mask, PA_IMASK); | ||
| 26 | } | ||
| 27 | |||
| 28 | static void enable_landisk_irq(unsigned int irq) | ||
| 29 | { | ||
| 30 | unsigned char value = (0x01 << (irq - 5)); | ||
| 31 | |||
| 32 | ctrl_outb(ctrl_inb(PA_IMASK) | value, PA_IMASK); | ||
| 33 | } | ||
| 34 | |||
| 35 | static struct irq_chip landisk_irq_chip __read_mostly = { | ||
| 36 | .name = "LANDISK", | ||
| 37 | .mask = disable_landisk_irq, | ||
| 38 | .unmask = enable_landisk_irq, | ||
| 39 | .mask_ack = disable_landisk_irq, | ||
| 40 | }; | ||
| 41 | |||
| 42 | /* | ||
| 43 | * Initialize IRQ setting | ||
| 44 | */ | ||
| 45 | void __init init_landisk_IRQ(void) | ||
| 46 | { | ||
| 47 | int i; | ||
| 48 | |||
| 49 | for (i = 5; i < 14; i++) { | ||
| 50 | disable_irq_nosync(i); | ||
| 51 | set_irq_chip_and_handler_name(i, &landisk_irq_chip, | ||
| 52 | handle_level_irq, "level"); | ||
| 53 | enable_landisk_irq(i); | ||
| 54 | } | ||
| 55 | ctrl_outb(0x00, PA_PWRINT_CLR); | ||
| 56 | } | ||
