| /* |
| * arch/arm/mach-netx/generic.c |
| * |
| * Copyright (C) 2005 Sascha Hauer <s.hauer@pengutronix.de>, Pengutronix |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License version 2 |
| * as published by the Free Software Foundation. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| * 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., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
| */ |
| |
| #include <linux/device.h> |
| #include <linux/init.h> |
| #include <linux/kernel.h> |
| #include <linux/module.h> |
| #include <linux/platform_device.h> |
| #include <mach/hardware.h> |
| #include <asm/mach/map.h> |
| #include <asm/hardware/vic.h> |
| #include <asm/io.h> |
| #include <mach/netx-regs.h> |
| #include <asm/mach/irq.h> |
| |
| static struct map_desc netx_io_desc[] __initdata = { |
| { |
| .virtual = NETX_IO_VIRT, |
| .pfn = __phys_to_pfn(NETX_IO_PHYS), |
| .length = NETX_IO_SIZE, |
| .type = MT_DEVICE |
| } |
| }; |
| |
| void __init netx_map_io(void) |
| { |
| iotable_init(netx_io_desc, ARRAY_SIZE(netx_io_desc)); |
| } |
| |
| static struct resource netx_rtc_resources[] = { |
| [0] = { |
| .start = 0x00101200, |
| .end = 0x00101220, |
| .flags = IORESOURCE_MEM, |
| }, |
| }; |
| |
| static struct platform_device netx_rtc_device = { |
| .name = "netx-rtc", |
| .id = 0, |
| .num_resources = ARRAY_SIZE(netx_rtc_resources), |
| .resource = netx_rtc_resources, |
| }; |
| |
| static struct platform_device *devices[] __initdata = { |
| &netx_rtc_device, |
| }; |
| |
| #if 0 |
| #define DEBUG_IRQ(fmt...) printk(fmt) |
| #else |
| #define DEBUG_IRQ(fmt...) while (0) {} |
| #endif |
| |
| static void |
| netx_hif_demux_handler(unsigned int irq_unused, struct irq_desc *desc) |
| { |
| unsigned int irq = NETX_IRQ_HIF_CHAINED(0); |
| unsigned int stat; |
| |
| stat = ((readl(NETX_DPMAS_INT_EN) & |
| readl(NETX_DPMAS_INT_STAT)) >> 24) & 0x1f; |
| |
| desc = irq_desc + NETX_IRQ_HIF_CHAINED(0); |
| |
| while (stat) { |
| if (stat & 1) { |
| DEBUG_IRQ("handling irq %d\n", irq); |
| desc_handle_irq(irq, desc); |
| } |
| irq++; |
| desc++; |
| stat >>= 1; |
| } |
| } |
| |
| static int |
| netx_hif_irq_type(unsigned int _irq, unsigned int type) |
| { |
| unsigned int val, irq; |
| |
| val = readl(NETX_DPMAS_IF_CONF1); |
| |
| irq = _irq - NETX_IRQ_HIF_CHAINED(0); |
| |
| if (type & IRQ_TYPE_EDGE_RISING) { |
| DEBUG_IRQ("rising edges\n"); |
| val |= (1 << 26) << irq; |
| } |
| if (type & IRQ_TYPE_EDGE_FALLING) { |
| DEBUG_IRQ("falling edges\n"); |
| val &= ~((1 << 26) << irq); |
| } |
| if (type & IRQ_TYPE_LEVEL_LOW) { |
| DEBUG_IRQ("low level\n"); |
| val &= ~((1 << 26) << irq); |
| } |
| if (type & IRQ_TYPE_LEVEL_HIGH) { |
| DEBUG_IRQ("high level\n"); |
| val |= (1 << 26) << irq; |
| } |
| |
| writel(val, NETX_DPMAS_IF_CONF1); |
| |
| return 0; |
| } |
| |
| static void |
| netx_hif_ack_irq(unsigned int _irq) |
| { |
| unsigned int val, irq; |
| |
| irq = _irq - NETX_IRQ_HIF_CHAINED(0); |
| writel((1 << 24) << irq, NETX_DPMAS_INT_STAT); |
| |
| val = readl(NETX_DPMAS_INT_EN); |
| val &= ~((1 << 24) << irq); |
| writel(val, NETX_DPMAS_INT_EN); |
| |
| DEBUG_IRQ("%s: irq %d\n", __func__, _irq); |
| } |
| |
| static void |
| netx_hif_mask_irq(unsigned int _irq) |
| { |
| unsigned int val, irq; |
| |
| irq = _irq - NETX_IRQ_HIF_CHAINED(0); |
| val = readl(NETX_DPMAS_INT_EN); |
| val &= ~((1 << 24) << irq); |
| writel(val, NETX_DPMAS_INT_EN); |
| DEBUG_IRQ("%s: irq %d\n", __func__, _irq); |
| } |
| |
| static void |
| netx_hif_unmask_irq(unsigned int _irq) |
| { |
| unsigned int val, irq; |
| |
| irq = _irq - NETX_IRQ_HIF_CHAINED(0); |
| val = readl(NETX_DPMAS_INT_EN); |
| val |= (1 << 24) << irq; |
| writel(val, NETX_DPMAS_INT_EN); |
| DEBUG_IRQ("%s: irq %d\n", __func__, _irq); |
| } |
| |
| static struct irq_chip netx_hif_chip = { |
| .ack = netx_hif_ack_irq, |
| .mask = netx_hif_mask_irq, |
| .unmask = netx_hif_unmask_irq, |
| .set_type = netx_hif_irq_type, |
| }; |
| |
| void __init netx_init_irq(void) |
| { |
| int irq; |
| |
| vic_init(__io(io_p2v(NETX_PA_VIC)), 0, ~0); |
| |
| for (irq = NETX_IRQ_HIF_CHAINED(0); irq <= NETX_IRQ_HIF_LAST; irq++) { |
| set_irq_chip(irq, &netx_hif_chip); |
| set_irq_handler(irq, handle_level_irq); |
| set_irq_flags(irq, IRQF_VALID); |
| } |
| |
| writel(NETX_DPMAS_INT_EN_GLB_EN, NETX_DPMAS_INT_EN); |
| set_irq_chained_handler(NETX_IRQ_HIF, netx_hif_demux_handler); |
| } |
| |
| static int __init netx_init(void) |
| { |
| return platform_add_devices(devices, ARRAY_SIZE(devices)); |
| } |
| |
| subsys_initcall(netx_init); |
| |