/* * Copyright (C) 2009-2010, Lars-Peter Clausen * JZ4740 platform IRQ support * * This program is free software; you can redistribute it and/or modify it * under the terms of the GNU General Public License as published by the * Free Software Foundation; either version 2 of the License, or (at your * option) any later version. * * You should have received a copy of the GNU General Public License along * with this program; if not, write to the Free Software Foundation, Inc., * 675 Mass Ave, Cambridge, MA 02139, USA. * */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include static void __iomem *jz_intc_base; static uint32_t jz_intc_wakeup; static uint32_t jz_intc_saved; #define JZ_REG_INTC_STATUS 0x00 #define JZ_REG_INTC_MASK 0x04 #define JZ_REG_INTC_SET_MASK 0x08 #define JZ_REG_INTC_CLEAR_MASK 0x0c #define JZ_REG_INTC_PENDING 0x10 #define IRQ_BIT(x) BIT((x) - JZ4740_IRQ_BASE) static inline unsigned long intc_irq_bit(struct irq_data *data) { return (unsigned long)irq_data_get_irq_chip_data(data); } static void intc_irq_unmask(struct irq_data *data) { writel(intc_irq_bit(data), jz_intc_base + JZ_REG_INTC_CLEAR_MASK); } static void intc_irq_mask(struct irq_data *data) { writel(intc_irq_bit(data), jz_intc_base + JZ_REG_INTC_SET_MASK); } static int intc_irq_set_wake(struct irq_data *data, unsigned int on) { if (on) jz_intc_wakeup |= intc_irq_bit(data); else jz_intc_wakeup &= ~intc_irq_bit(data); return 0; } static struct irq_chip intc_irq_type = { .name = "INTC", .irq_mask = intc_irq_mask, .irq_mask_ack = intc_irq_mask, .irq_unmask = intc_irq_unmask, .irq_set_wake = intc_irq_set_wake, }; static irqreturn_t jz4740_cascade(int irq, void *data) { uint32_t irq_reg; irq_reg = readl(jz_intc_base + JZ_REG_INTC_PENDING); if (irq_reg) generic_handle_irq(__fls(irq_reg) + JZ4740_IRQ_BASE); return IRQ_HANDLED; } static struct irqaction jz4740_cascade_action = { .handler = jz4740_cascade, .name = "JZ4740 cascade interrupt", }; void __init arch_init_irq(void) { int i; mips_cpu_irq_init(); jz_intc_base = ioremap(JZ4740_INTC_BASE_ADDR, 0x14); /* Mask all irqs */ writel(0xffffffff, jz_intc_base + JZ_REG_INTC_SET_MASK); for (i = JZ4740_IRQ_BASE; i < JZ4740_IRQ_BASE + 32; i++) { irq_set_chip_data(i, (void *)IRQ_BIT(i)); irq_set_chip_and_handler(i, &intc_irq_type, handle_level_irq); } setup_irq(2, &jz4740_cascade_action); } asmlinkage void plat_irq_dispatch(void) { unsigned int pending = read_c0_status() & read_c0_cause() & ST0_IM; if (pending & STATUSF_IP2) do_IRQ(2); else if (pending & STATUSF_IP3) do_IRQ(3); else spurious_interrupt(); } void jz4740_intc_suspend(void) { jz_intc_saved = readl(jz_intc_base + JZ_REG_INTC_MASK); writel(~jz_intc_wakeup, jz_intc_base + JZ_REG_INTC_SET_MASK); writel(jz_intc_wakeup, jz_intc_base + JZ_REG_INTC_CLEAR_MASK); } void jz4740_intc_resume(void) { writel(~jz_intc_saved, jz_intc_base + JZ_REG_INTC_CLEAR_MASK); writel(jz_intc_saved, jz_intc_base + JZ_REG_INTC_SET_MASK); } #ifdef CONFIG_DEBUG_FS static inline void intc_seq_reg(struct seq_file *s, const char *name, unsigned int reg) { seq_printf(s, "%s:\t\t%08x\n", name, readl(jz_intc_base + reg)); } static int intc_regs_show(struct seq_file *s, void *unused) { intc_seq_reg(s, "Status", JZ_REG_INTC_STATUS); intc_seq_reg(s, "Mask", JZ_REG_INTC_MASK); intc_seq_reg(s, "Pending", JZ_REG_INTC_PENDING); return 0; } static int intc_regs_open(struct inode *inode, struct file *file) { return single_open(file, intc_regs_show, NULL); } static const struct file_operations intc_regs_operations = { .open = intc_regs_open, .read = seq_read, .llseek = seq_lseek, .release = single_release, }; static int __init intc_debugfs_init(void) { (void) debugfs_create_file("jz_regs_intc", S_IFREG | S_IRUGO, NULL, NULL, &intc_regs_operations); return 0; } subsys_initcall(intc_debugfs_init); #endif