Merge branch 'v6v7' into devel
[linux/fpc-iii.git] / arch / arm / mach-h720x / common.c
blob1f28c90932c754d082848af2f85e9fba45f75b08
1 /*
2 * linux/arch/arm/mach-h720x/common.c
4 * Copyright (C) 2003 Thomas Gleixner <tglx@linutronix.de>
5 * 2003 Robert Schwebel <r.schwebel@pengutronix.de>
6 * 2004 Sascha Hauer <s.hauer@pengutronix.de>
8 * common stuff for Hynix h720x processors
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License version 2 as
12 * published by the Free Software Foundation.
16 #include <linux/sched.h>
17 #include <linux/mman.h>
18 #include <linux/init.h>
19 #include <linux/interrupt.h>
20 #include <linux/io.h>
22 #include <asm/page.h>
23 #include <asm/pgtable.h>
24 #include <asm/dma.h>
25 #include <mach/hardware.h>
26 #include <asm/irq.h>
27 #include <asm/mach/irq.h>
28 #include <asm/mach/map.h>
29 #include <mach/irqs.h>
31 #include <asm/mach/dma.h>
33 #if 0
34 #define IRQDBG(args...) printk(args)
35 #else
36 #define IRQDBG(args...) do {} while(0)
37 #endif
39 void __init arch_dma_init(dma_t *dma)
44 * Return usecs since last timer reload
45 * (timercount * (usecs perjiffie)) / (ticks per jiffie)
47 unsigned long h720x_gettimeoffset(void)
49 return (CPU_REG (TIMER_VIRT, TM0_COUNT) * tick_usec) / LATCH;
53 * mask Global irq's
55 static void mask_global_irq(struct irq_data *d)
57 CPU_REG (IRQC_VIRT, IRQC_IER) &= ~(1 << d->irq);
61 * unmask Global irq's
63 static void unmask_global_irq(struct irq_data *d)
65 CPU_REG (IRQC_VIRT, IRQC_IER) |= (1 << d->irq);
70 * ack GPIO irq's
71 * Ack only for edge triggered int's valid
73 static void inline ack_gpio_irq(struct irq_data *d)
75 u32 reg_base = GPIO_VIRT(IRQ_TO_REGNO(d->irq));
76 u32 bit = IRQ_TO_BIT(d->irq);
77 if ( (CPU_REG (reg_base, GPIO_EDGE) & bit))
78 CPU_REG (reg_base, GPIO_CLR) = bit;
82 * mask GPIO irq's
84 static void inline mask_gpio_irq(struct irq_data *d)
86 u32 reg_base = GPIO_VIRT(IRQ_TO_REGNO(d->irq));
87 u32 bit = IRQ_TO_BIT(d->irq);
88 CPU_REG (reg_base, GPIO_MASK) &= ~bit;
92 * unmask GPIO irq's
94 static void inline unmask_gpio_irq(struct irq_data *d)
96 u32 reg_base = GPIO_VIRT(IRQ_TO_REGNO(d->irq));
97 u32 bit = IRQ_TO_BIT(d->irq);
98 CPU_REG (reg_base, GPIO_MASK) |= bit;
101 static void
102 h720x_gpio_handler(unsigned int mask, unsigned int irq,
103 struct irq_desc *desc)
105 IRQDBG("%s irq: %d\n", __func__, irq);
106 while (mask) {
107 if (mask & 1) {
108 IRQDBG("handling irq %d\n", irq);
109 generic_handle_irq(irq);
111 irq++;
112 mask >>= 1;
116 static void
117 h720x_gpioa_demux_handler(unsigned int irq_unused, struct irq_desc *desc)
119 unsigned int mask, irq;
121 mask = CPU_REG(GPIO_A_VIRT,GPIO_STAT);
122 irq = IRQ_CHAINED_GPIOA(0);
123 IRQDBG("%s mask: 0x%08x irq: %d\n", __func__, mask,irq);
124 h720x_gpio_handler(mask, irq, desc);
127 static void
128 h720x_gpiob_demux_handler(unsigned int irq_unused, struct irq_desc *desc)
130 unsigned int mask, irq;
131 mask = CPU_REG(GPIO_B_VIRT,GPIO_STAT);
132 irq = IRQ_CHAINED_GPIOB(0);
133 IRQDBG("%s mask: 0x%08x irq: %d\n", __func__, mask,irq);
134 h720x_gpio_handler(mask, irq, desc);
137 static void
138 h720x_gpioc_demux_handler(unsigned int irq_unused, struct irq_desc *desc)
140 unsigned int mask, irq;
142 mask = CPU_REG(GPIO_C_VIRT,GPIO_STAT);
143 irq = IRQ_CHAINED_GPIOC(0);
144 IRQDBG("%s mask: 0x%08x irq: %d\n", __func__, mask,irq);
145 h720x_gpio_handler(mask, irq, desc);
148 static void
149 h720x_gpiod_demux_handler(unsigned int irq_unused, struct irq_desc *desc)
151 unsigned int mask, irq;
153 mask = CPU_REG(GPIO_D_VIRT,GPIO_STAT);
154 irq = IRQ_CHAINED_GPIOD(0);
155 IRQDBG("%s mask: 0x%08x irq: %d\n", __func__, mask,irq);
156 h720x_gpio_handler(mask, irq, desc);
159 #ifdef CONFIG_CPU_H7202
160 static void
161 h720x_gpioe_demux_handler(unsigned int irq_unused, struct irq_desc *desc)
163 unsigned int mask, irq;
165 mask = CPU_REG(GPIO_E_VIRT,GPIO_STAT);
166 irq = IRQ_CHAINED_GPIOE(0);
167 IRQDBG("%s mask: 0x%08x irq: %d\n", __func__, mask,irq);
168 h720x_gpio_handler(mask, irq, desc);
170 #endif
172 static struct irq_chip h720x_global_chip = {
173 .irq_ack = mask_global_irq,
174 .irq_mask = mask_global_irq,
175 .irq_unmask = unmask_global_irq,
178 static struct irq_chip h720x_gpio_chip = {
179 .irq_ack = ack_gpio_irq,
180 .irq_mask = mask_gpio_irq,
181 .irq_unmask = unmask_gpio_irq,
185 * Initialize IRQ's, mask all, enable multiplexed irq's
187 void __init h720x_init_irq (void)
189 int irq;
191 /* Mask global irq's */
192 CPU_REG (IRQC_VIRT, IRQC_IER) = 0x0;
194 /* Mask all multiplexed irq's */
195 CPU_REG (GPIO_A_VIRT, GPIO_MASK) = 0x0;
196 CPU_REG (GPIO_B_VIRT, GPIO_MASK) = 0x0;
197 CPU_REG (GPIO_C_VIRT, GPIO_MASK) = 0x0;
198 CPU_REG (GPIO_D_VIRT, GPIO_MASK) = 0x0;
200 /* Initialize global IRQ's, fast path */
201 for (irq = 0; irq < NR_GLBL_IRQS; irq++) {
202 set_irq_chip(irq, &h720x_global_chip);
203 set_irq_handler(irq, handle_level_irq);
204 set_irq_flags(irq, IRQF_VALID | IRQF_PROBE);
207 /* Initialize multiplexed IRQ's, slow path */
208 for (irq = IRQ_CHAINED_GPIOA(0) ; irq <= IRQ_CHAINED_GPIOD(31); irq++) {
209 set_irq_chip(irq, &h720x_gpio_chip);
210 set_irq_handler(irq, handle_edge_irq);
211 set_irq_flags(irq, IRQF_VALID );
213 set_irq_chained_handler(IRQ_GPIOA, h720x_gpioa_demux_handler);
214 set_irq_chained_handler(IRQ_GPIOB, h720x_gpiob_demux_handler);
215 set_irq_chained_handler(IRQ_GPIOC, h720x_gpioc_demux_handler);
216 set_irq_chained_handler(IRQ_GPIOD, h720x_gpiod_demux_handler);
218 #ifdef CONFIG_CPU_H7202
219 for (irq = IRQ_CHAINED_GPIOE(0) ; irq <= IRQ_CHAINED_GPIOE(31); irq++) {
220 set_irq_chip(irq, &h720x_gpio_chip);
221 set_irq_handler(irq, handle_edge_irq);
222 set_irq_flags(irq, IRQF_VALID );
224 set_irq_chained_handler(IRQ_GPIOE, h720x_gpioe_demux_handler);
225 #endif
227 /* Enable multiplexed irq's */
228 CPU_REG (IRQC_VIRT, IRQC_IER) = IRQ_ENA_MUX;
231 static struct map_desc h720x_io_desc[] __initdata = {
233 .virtual = IO_VIRT,
234 .pfn = __phys_to_pfn(IO_PHYS),
235 .length = IO_SIZE,
236 .type = MT_DEVICE
240 /* Initialize io tables */
241 void __init h720x_map_io(void)
243 iotable_init(h720x_io_desc,ARRAY_SIZE(h720x_io_desc));