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 } 56