| /* |
| * Copyright (C) 2000 David J. Mckay (david.mckay@st.com) |
| * |
| * May be copied or modified under the terms of the GNU General Public |
| * License. See linux/COPYING for more information. |
| * |
| * Looks after interrupts on the HARP board. |
| * |
| * Bases on the IPR irq system |
| */ |
| |
| #include <linux/init.h> |
| #include <linux/irq.h> |
| |
| #include <asm/system.h> |
| #include <asm/io.h> |
| #include <asm/harp/harp.h> |
| |
| |
| #define NUM_EXTERNAL_IRQS 16 |
| |
| // Early versions of the STB1 Overdrive required this nasty frig |
| //#define INVERT_INTMASK_WRITES |
| |
| static void enable_harp_irq(unsigned int irq); |
| static void disable_harp_irq(unsigned int irq); |
| |
| /* shutdown is same as "disable" */ |
| #define shutdown_harp_irq disable_harp_irq |
| |
| static void mask_and_ack_harp(unsigned int); |
| static void end_harp_irq(unsigned int irq); |
| |
| static unsigned int startup_harp_irq(unsigned int irq) |
| { |
| enable_harp_irq(irq); |
| return 0; /* never anything pending */ |
| } |
| |
| static struct hw_interrupt_type harp_irq_type = { |
| .typename = "Harp-IRQ", |
| .startup = startup_harp_irq, |
| .shutdown = shutdown_harp_irq, |
| .enable = enable_harp_irq, |
| .disable = disable_harp_irq, |
| .ack = mask_and_ack_harp, |
| .end = end_harp_irq |
| }; |
| |
| static void disable_harp_irq(unsigned int irq) |
| { |
| unsigned val, flags; |
| unsigned maskReg; |
| unsigned mask; |
| int pri; |
| |
| if (irq < 0 || irq >= NUM_EXTERNAL_IRQS) |
| return; |
| |
| pri = 15 - irq; |
| |
| if (pri < 8) { |
| maskReg = EPLD_INTMASK0; |
| } else { |
| maskReg = EPLD_INTMASK1; |
| pri -= 8; |
| } |
| |
| local_irq_save(flags); |
| mask = ctrl_inl(maskReg); |
| mask &= (~(1 << pri)); |
| #if defined(INVERT_INTMASK_WRITES) |
| mask ^= 0xff; |
| #endif |
| ctrl_outl(mask, maskReg); |
| local_irq_restore(flags); |
| } |
| |
| static void enable_harp_irq(unsigned int irq) |
| { |
| unsigned flags; |
| unsigned maskReg; |
| unsigned mask; |
| int pri; |
| |
| if (irq < 0 || irq >= NUM_EXTERNAL_IRQS) |
| return; |
| |
| pri = 15 - irq; |
| |
| if (pri < 8) { |
| maskReg = EPLD_INTMASK0; |
| } else { |
| maskReg = EPLD_INTMASK1; |
| pri -= 8; |
| } |
| |
| local_irq_save(flags); |
| mask = ctrl_inl(maskReg); |
| |
| |
| mask |= (1 << pri); |
| |
| #if defined(INVERT_INTMASK_WRITES) |
| mask ^= 0xff; |
| #endif |
| ctrl_outl(mask, maskReg); |
| |
| local_irq_restore(flags); |
| } |
| |
| /* This functions sets the desired irq handler to be an overdrive type */ |
| static void __init make_harp_irq(unsigned int irq) |
| { |
| disable_irq_nosync(irq); |
| irq_desc[irq].chip = &harp_irq_type; |
| disable_harp_irq(irq); |
| } |
| |
| static void mask_and_ack_harp(unsigned int irq) |
| { |
| disable_harp_irq(irq); |
| } |
| |
| static void end_harp_irq(unsigned int irq) |
| { |
| enable_harp_irq(irq); |
| } |
| |
| void __init init_harp_irq(void) |
| { |
| int i; |
| |
| #if !defined(INVERT_INTMASK_WRITES) |
| // On the harp these are set to enable an interrupt |
| ctrl_outl(0x00, EPLD_INTMASK0); |
| ctrl_outl(0x00, EPLD_INTMASK1); |
| #else |
| // On the Overdrive the data is inverted before being stored in the reg |
| ctrl_outl(0xff, EPLD_INTMASK0); |
| ctrl_outl(0xff, EPLD_INTMASK1); |
| #endif |
| |
| for (i = 0; i < NUM_EXTERNAL_IRQS; i++) { |
| make_harp_irq(i); |
| } |
| } |