[PATCH] unnecessary long index i in sched
[linux/fpc-iii.git] / arch / arm / mach-aaec2000 / core.c
blob65be5efd633c7b618c71f1a2e478ea8501b3c110
1 /*
2 * linux/arch/arm/mach-aaec2000/core.c
4 * Code common to all AAEC-2000 machines
6 * Copyright (c) 2005 Nicolas Bellido Y Ortega
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
12 #include <linux/config.h>
13 #include <linux/module.h>
14 #include <linux/kernel.h>
15 #include <linux/init.h>
16 #include <linux/platform_device.h>
17 #include <linux/list.h>
18 #include <linux/errno.h>
19 #include <linux/dma-mapping.h>
20 #include <linux/interrupt.h>
21 #include <linux/timex.h>
22 #include <linux/signal.h>
24 #include <asm/hardware.h>
25 #include <asm/irq.h>
26 #include <asm/sizes.h>
28 #include <asm/mach/flash.h>
29 #include <asm/mach/irq.h>
30 #include <asm/mach/time.h>
31 #include <asm/mach/map.h>
33 #include "core.h"
34 #include "clock.h"
37 * Common I/O mapping:
39 * Static virtual address mappings are as follow:
41 * 0xf8000000-0xf8001ffff: Devices connected to APB bus
42 * 0xf8002000-0xf8003ffff: Devices connected to AHB bus
44 * Below 0xe8000000 is reserved for vm allocation.
46 * The machine specific code must provide the extra mapping beside the
47 * default mapping provided here.
49 static struct map_desc standard_io_desc[] __initdata = {
51 .virtual = VIO_APB_BASE,
52 .pfn = __phys_to_pfn(PIO_APB_BASE),
53 .length = IO_APB_LENGTH,
54 .type = MT_DEVICE
55 }, {
56 .virtual = VIO_AHB_BASE,
57 .pfn = __phys_to_pfn(PIO_AHB_BASE),
58 .length = IO_AHB_LENGTH,
59 .type = MT_DEVICE
63 void __init aaec2000_map_io(void)
65 iotable_init(standard_io_desc, ARRAY_SIZE(standard_io_desc));
69 * Interrupt handling routines
71 static void aaec2000_int_ack(unsigned int irq)
73 IRQ_INTSR = 1 << irq;
76 static void aaec2000_int_mask(unsigned int irq)
78 IRQ_INTENC |= (1 << irq);
81 static void aaec2000_int_unmask(unsigned int irq)
83 IRQ_INTENS |= (1 << irq);
86 static struct irqchip aaec2000_irq_chip = {
87 .ack = aaec2000_int_ack,
88 .mask = aaec2000_int_mask,
89 .unmask = aaec2000_int_unmask,
92 void __init aaec2000_init_irq(void)
94 unsigned int i;
96 for (i = 0; i < NR_IRQS; i++) {
97 set_irq_handler(i, do_level_IRQ);
98 set_irq_chip(i, &aaec2000_irq_chip);
99 set_irq_flags(i, IRQF_VALID);
102 /* Disable all interrupts */
103 IRQ_INTENC = 0xffffffff;
105 /* Clear any pending interrupts */
106 IRQ_INTSR = IRQ_INTSR;
110 * Time keeping
112 /* IRQs are disabled before entering here from do_gettimeofday() */
113 static unsigned long aaec2000_gettimeoffset(void)
115 unsigned long ticks_to_match, elapsed, usec;
117 /* Get ticks before next timer match */
118 ticks_to_match = TIMER1_LOAD - TIMER1_VAL;
120 /* We need elapsed ticks since last match */
121 elapsed = LATCH - ticks_to_match;
123 /* Now, convert them to usec */
124 usec = (unsigned long)(elapsed * (tick_nsec / 1000))/LATCH;
126 return usec;
129 /* We enter here with IRQs enabled */
130 static irqreturn_t
131 aaec2000_timer_interrupt(int irq, void *dev_id, struct pt_regs *regs)
133 /* TODO: Check timer accuracy */
134 write_seqlock(&xtime_lock);
136 timer_tick(regs);
137 TIMER1_CLEAR = 1;
139 write_sequnlock(&xtime_lock);
141 return IRQ_HANDLED;
144 static struct irqaction aaec2000_timer_irq = {
145 .name = "AAEC-2000 Timer Tick",
146 .flags = SA_INTERRUPT | SA_TIMER,
147 .handler = aaec2000_timer_interrupt,
150 static void __init aaec2000_timer_init(void)
152 /* Disable timer 1 */
153 TIMER1_CTRL = 0;
155 /* We have somehow to generate a 100Hz clock.
156 * We then use the 508KHz timer in periodic mode.
158 TIMER1_LOAD = LATCH;
159 TIMER1_CLEAR = 1; /* Clear interrupt */
161 setup_irq(INT_TMR1_OFL, &aaec2000_timer_irq);
163 TIMER1_CTRL = TIMER_CTRL_ENABLE |
164 TIMER_CTRL_PERIODIC |
165 TIMER_CTRL_CLKSEL_508K;
168 struct sys_timer aaec2000_timer = {
169 .init = aaec2000_timer_init,
170 .offset = aaec2000_gettimeoffset,
173 static struct clcd_panel mach_clcd_panel;
175 static int aaec2000_clcd_setup(struct clcd_fb *fb)
177 dma_addr_t dma;
179 fb->panel = &mach_clcd_panel;
181 fb->fb.screen_base = dma_alloc_writecombine(&fb->dev->dev, SZ_1M,
182 &dma, GFP_KERNEL);
184 if (!fb->fb.screen_base) {
185 printk(KERN_ERR "CLCD: unable to map framebuffer\n");
186 return -ENOMEM;
189 fb->fb.fix.smem_start = dma;
190 fb->fb.fix.smem_len = SZ_1M;
192 return 0;
195 static int aaec2000_clcd_mmap(struct clcd_fb *fb, struct vm_area_struct *vma)
197 return dma_mmap_writecombine(&fb->dev->dev, vma,
198 fb->fb.screen_base,
199 fb->fb.fix.smem_start,
200 fb->fb.fix.smem_len);
203 static void aaec2000_clcd_remove(struct clcd_fb *fb)
205 dma_free_writecombine(&fb->dev->dev, fb->fb.fix.smem_len,
206 fb->fb.screen_base, fb->fb.fix.smem_start);
209 static struct clcd_board clcd_plat_data = {
210 .name = "AAEC-2000",
211 .check = clcdfb_check,
212 .decode = clcdfb_decode,
213 .setup = aaec2000_clcd_setup,
214 .mmap = aaec2000_clcd_mmap,
215 .remove = aaec2000_clcd_remove,
218 static struct amba_device clcd_device = {
219 .dev = {
220 .bus_id = "mb:16",
221 .coherent_dma_mask = ~0,
222 .platform_data = &clcd_plat_data,
224 .res = {
225 .start = AAEC_CLCD_PHYS,
226 .end = AAEC_CLCD_PHYS + SZ_4K - 1,
227 .flags = IORESOURCE_MEM,
229 .irq = { INT_LCD, NO_IRQ },
230 .periphid = 0x41110,
233 static struct amba_device *amba_devs[] __initdata = {
234 &clcd_device,
237 static struct clk aaec2000_clcd_clk = {
238 .name = "CLCDCLK",
241 void __init aaec2000_set_clcd_plat_data(struct aaec2000_clcd_info *clcd)
243 clcd_plat_data.enable = clcd->enable;
244 clcd_plat_data.disable = clcd->disable;
245 memcpy(&mach_clcd_panel, &clcd->panel, sizeof(struct clcd_panel));
248 static struct flash_platform_data aaec2000_flash_data = {
249 .map_name = "cfi_probe",
250 .width = 4,
253 static struct resource aaec2000_flash_resource = {
254 .start = AAEC_FLASH_BASE,
255 .end = AAEC_FLASH_BASE + AAEC_FLASH_SIZE,
256 .flags = IORESOURCE_MEM,
259 static struct platform_device aaec2000_flash_device = {
260 .name = "armflash",
261 .id = 0,
262 .dev = {
263 .platform_data = &aaec2000_flash_data,
265 .num_resources = 1,
266 .resource = &aaec2000_flash_resource,
269 static int __init aaec2000_init(void)
271 int i;
273 clk_register(&aaec2000_clcd_clk);
275 for (i = 0; i < ARRAY_SIZE(amba_devs); i++) {
276 struct amba_device *d = amba_devs[i];
277 amba_device_register(d, &iomem_resource);
280 platform_device_register(&aaec2000_flash_device);
282 return 0;
284 arch_initcall(aaec2000_init);