1/* 2 * Interrupt routines for Gemini 3 * 4 * Copyright (C) 2001-2006 Storlink, Corp. 5 * Copyright (C) 2008-2009 Paulius Zaleckas <paulius.zaleckas@teltonika.lt> 6 * 7 * This program is free software; you can redistribute it and/or modify 8 * it under the terms of the GNU General Public License as published by 9 * the Free Software Foundation; either version 2 of the License, or 10 * (at your option) any later version. 11 */ 12#include <linux/init.h> 13#include <linux/io.h> 14#include <linux/ioport.h> 15#include <linux/stddef.h> 16#include <linux/list.h> 17#include <linux/sched.h> 18#include <asm/irq.h> 19#include <asm/mach/irq.h> 20#include <mach/hardware.h> 21 22#define IRQ_SOURCE(base_addr) (base_addr + 0x00) 23#define IRQ_MASK(base_addr) (base_addr + 0x04) 24#define IRQ_CLEAR(base_addr) (base_addr + 0x08) 25#define IRQ_TMODE(base_addr) (base_addr + 0x0C) 26#define IRQ_TLEVEL(base_addr) (base_addr + 0x10) 27#define IRQ_STATUS(base_addr) (base_addr + 0x14) 28#define FIQ_SOURCE(base_addr) (base_addr + 0x20) 29#define FIQ_MASK(base_addr) (base_addr + 0x24) 30#define FIQ_CLEAR(base_addr) (base_addr + 0x28) 31#define FIQ_TMODE(base_addr) (base_addr + 0x2C) 32#define FIQ_LEVEL(base_addr) (base_addr + 0x30) 33#define FIQ_STATUS(base_addr) (base_addr + 0x34) 34 35static void gemini_ack_irq(unsigned int irq) 36{ 37 __raw_writel(1 << irq, IRQ_CLEAR(IO_ADDRESS(GEMINI_INTERRUPT_BASE))); 38} 39 40static void gemini_mask_irq(unsigned int irq) 41{ 42 unsigned int mask; 43 44 mask = __raw_readl(IRQ_MASK(IO_ADDRESS(GEMINI_INTERRUPT_BASE))); 45 mask &= ~(1 << irq); 46 __raw_writel(mask, IRQ_MASK(IO_ADDRESS(GEMINI_INTERRUPT_BASE))); 47} 48 49static void gemini_unmask_irq(unsigned int irq) 50{ 51 unsigned int mask; 52 53 mask = __raw_readl(IRQ_MASK(IO_ADDRESS(GEMINI_INTERRUPT_BASE))); 54 mask |= (1 << irq); 55 __raw_writel(mask, IRQ_MASK(IO_ADDRESS(GEMINI_INTERRUPT_BASE))); 56} 57 58static struct irq_chip gemini_irq_chip = { 59 .name = "INTC", 60 .ack = gemini_ack_irq, 61 .mask = gemini_mask_irq, 62 .unmask = gemini_unmask_irq, 63}; 64 65static struct resource irq_resource = { 66 .name = "irq_handler", 67 .start = IO_ADDRESS(GEMINI_INTERRUPT_BASE), 68 .end = IO_ADDRESS(FIQ_STATUS(GEMINI_INTERRUPT_BASE)) + 4, 69}; 70 71void __init gemini_init_irq(void) 72{ 73 unsigned int i, mode = 0, level = 0; 74 75 /* 76 * Disable arch_idle() by default since it is buggy 77 * For more info see arch/arm/mach-gemini/include/mach/system.h 78 */ 79 disable_hlt(); 80 81 request_resource(&iomem_resource, &irq_resource); 82 83 for (i = 0; i < NR_IRQS; i++) { 84 set_irq_chip(i, &gemini_irq_chip); 85 if((i >= IRQ_TIMER1 && i <= IRQ_TIMER3) || (i >= IRQ_SERIRQ0 && i <= IRQ_SERIRQ1)) { 86 set_irq_handler(i, handle_edge_irq); 87 mode |= 1 << i; 88 level |= 1 << i; 89 } else { 90 set_irq_handler(i, handle_level_irq); 91 } 92 set_irq_flags(i, IRQF_VALID | IRQF_PROBE); 93 } 94 95 /* Disable all interrupts */ 96 __raw_writel(0, IRQ_MASK(IO_ADDRESS(GEMINI_INTERRUPT_BASE))); 97 __raw_writel(0, FIQ_MASK(IO_ADDRESS(GEMINI_INTERRUPT_BASE))); 98 99 /* Set interrupt mode */ 100 __raw_writel(mode, IRQ_TMODE(IO_ADDRESS(GEMINI_INTERRUPT_BASE))); 101 __raw_writel(level, IRQ_TLEVEL(IO_ADDRESS(GEMINI_INTERRUPT_BASE))); 102} 103