ARM: Make Integrator/Versatile/Reaview VCO code similar
[deliverable/linux.git] / arch / arm / mach-integrator / integrator_cp.c
1 /*
2 * linux/arch/arm/mach-integrator/integrator_cp.c
3 *
4 * Copyright (C) 2003 Deep Blue Solutions Ltd
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License.
9 */
10 #include <linux/types.h>
11 #include <linux/kernel.h>
12 #include <linux/init.h>
13 #include <linux/list.h>
14 #include <linux/platform_device.h>
15 #include <linux/dma-mapping.h>
16 #include <linux/slab.h>
17 #include <linux/string.h>
18 #include <linux/sysdev.h>
19 #include <linux/amba/bus.h>
20 #include <linux/amba/kmi.h>
21 #include <linux/amba/clcd.h>
22 #include <linux/amba/mmci.h>
23 #include <linux/io.h>
24
25 #include <asm/clkdev.h>
26 #include <mach/clkdev.h>
27 #include <mach/hardware.h>
28 #include <mach/platform.h>
29 #include <asm/irq.h>
30 #include <asm/setup.h>
31 #include <asm/mach-types.h>
32 #include <asm/hardware/arm_timer.h>
33 #include <asm/hardware/icst.h>
34
35 #include <mach/cm.h>
36 #include <mach/lm.h>
37
38 #include <asm/mach/arch.h>
39 #include <asm/mach/flash.h>
40 #include <asm/mach/irq.h>
41 #include <asm/mach/map.h>
42 #include <asm/mach/time.h>
43
44 #include <plat/timer-sp.h>
45
46 #define INTCP_PA_FLASH_BASE 0x24000000
47 #define INTCP_FLASH_SIZE SZ_32M
48
49 #define INTCP_PA_CLCD_BASE 0xc0000000
50
51 #define INTCP_VA_CIC_BASE IO_ADDRESS(INTEGRATOR_HDR_BASE + 0x40)
52 #define INTCP_VA_PIC_BASE IO_ADDRESS(INTEGRATOR_IC_BASE)
53 #define INTCP_VA_SIC_BASE IO_ADDRESS(INTEGRATOR_CP_SIC_BASE)
54
55 #define INTCP_ETH_SIZE 0x10
56
57 #define INTCP_VA_CTRL_BASE IO_ADDRESS(INTEGRATOR_CP_CTL_BASE)
58 #define INTCP_FLASHPROG 0x04
59 #define CINTEGRATOR_FLASHPROG_FLVPPEN (1 << 0)
60 #define CINTEGRATOR_FLASHPROG_FLWREN (1 << 1)
61
62 /*
63 * Logical Physical
64 * f1000000 10000000 Core module registers
65 * f1100000 11000000 System controller registers
66 * f1200000 12000000 EBI registers
67 * f1300000 13000000 Counter/Timer
68 * f1400000 14000000 Interrupt controller
69 * f1600000 16000000 UART 0
70 * f1700000 17000000 UART 1
71 * f1a00000 1a000000 Debug LEDs
72 * fc900000 c9000000 GPIO
73 * fca00000 ca000000 SIC
74 * fcb00000 cb000000 CP system control
75 */
76
77 static struct map_desc intcp_io_desc[] __initdata = {
78 {
79 .virtual = IO_ADDRESS(INTEGRATOR_HDR_BASE),
80 .pfn = __phys_to_pfn(INTEGRATOR_HDR_BASE),
81 .length = SZ_4K,
82 .type = MT_DEVICE
83 }, {
84 .virtual = IO_ADDRESS(INTEGRATOR_SC_BASE),
85 .pfn = __phys_to_pfn(INTEGRATOR_SC_BASE),
86 .length = SZ_4K,
87 .type = MT_DEVICE
88 }, {
89 .virtual = IO_ADDRESS(INTEGRATOR_EBI_BASE),
90 .pfn = __phys_to_pfn(INTEGRATOR_EBI_BASE),
91 .length = SZ_4K,
92 .type = MT_DEVICE
93 }, {
94 .virtual = IO_ADDRESS(INTEGRATOR_CT_BASE),
95 .pfn = __phys_to_pfn(INTEGRATOR_CT_BASE),
96 .length = SZ_4K,
97 .type = MT_DEVICE
98 }, {
99 .virtual = IO_ADDRESS(INTEGRATOR_IC_BASE),
100 .pfn = __phys_to_pfn(INTEGRATOR_IC_BASE),
101 .length = SZ_4K,
102 .type = MT_DEVICE
103 }, {
104 .virtual = IO_ADDRESS(INTEGRATOR_UART0_BASE),
105 .pfn = __phys_to_pfn(INTEGRATOR_UART0_BASE),
106 .length = SZ_4K,
107 .type = MT_DEVICE
108 }, {
109 .virtual = IO_ADDRESS(INTEGRATOR_UART1_BASE),
110 .pfn = __phys_to_pfn(INTEGRATOR_UART1_BASE),
111 .length = SZ_4K,
112 .type = MT_DEVICE
113 }, {
114 .virtual = IO_ADDRESS(INTEGRATOR_DBG_BASE),
115 .pfn = __phys_to_pfn(INTEGRATOR_DBG_BASE),
116 .length = SZ_4K,
117 .type = MT_DEVICE
118 }, {
119 .virtual = IO_ADDRESS(INTEGRATOR_CP_GPIO_BASE),
120 .pfn = __phys_to_pfn(INTEGRATOR_CP_GPIO_BASE),
121 .length = SZ_4K,
122 .type = MT_DEVICE
123 }, {
124 .virtual = IO_ADDRESS(INTEGRATOR_CP_SIC_BASE),
125 .pfn = __phys_to_pfn(INTEGRATOR_CP_SIC_BASE),
126 .length = SZ_4K,
127 .type = MT_DEVICE
128 }, {
129 .virtual = IO_ADDRESS(INTEGRATOR_CP_CTL_BASE),
130 .pfn = __phys_to_pfn(INTEGRATOR_CP_CTL_BASE),
131 .length = SZ_4K,
132 .type = MT_DEVICE
133 }
134 };
135
136 static void __init intcp_map_io(void)
137 {
138 iotable_init(intcp_io_desc, ARRAY_SIZE(intcp_io_desc));
139 }
140
141 #define cic_writel __raw_writel
142 #define cic_readl __raw_readl
143 #define pic_writel __raw_writel
144 #define pic_readl __raw_readl
145 #define sic_writel __raw_writel
146 #define sic_readl __raw_readl
147
148 static void cic_mask_irq(unsigned int irq)
149 {
150 irq -= IRQ_CIC_START;
151 cic_writel(1 << irq, INTCP_VA_CIC_BASE + IRQ_ENABLE_CLEAR);
152 }
153
154 static void cic_unmask_irq(unsigned int irq)
155 {
156 irq -= IRQ_CIC_START;
157 cic_writel(1 << irq, INTCP_VA_CIC_BASE + IRQ_ENABLE_SET);
158 }
159
160 static struct irq_chip cic_chip = {
161 .name = "CIC",
162 .ack = cic_mask_irq,
163 .mask = cic_mask_irq,
164 .unmask = cic_unmask_irq,
165 };
166
167 static void pic_mask_irq(unsigned int irq)
168 {
169 irq -= IRQ_PIC_START;
170 pic_writel(1 << irq, INTCP_VA_PIC_BASE + IRQ_ENABLE_CLEAR);
171 }
172
173 static void pic_unmask_irq(unsigned int irq)
174 {
175 irq -= IRQ_PIC_START;
176 pic_writel(1 << irq, INTCP_VA_PIC_BASE + IRQ_ENABLE_SET);
177 }
178
179 static struct irq_chip pic_chip = {
180 .name = "PIC",
181 .ack = pic_mask_irq,
182 .mask = pic_mask_irq,
183 .unmask = pic_unmask_irq,
184 };
185
186 static void sic_mask_irq(unsigned int irq)
187 {
188 irq -= IRQ_SIC_START;
189 sic_writel(1 << irq, INTCP_VA_SIC_BASE + IRQ_ENABLE_CLEAR);
190 }
191
192 static void sic_unmask_irq(unsigned int irq)
193 {
194 irq -= IRQ_SIC_START;
195 sic_writel(1 << irq, INTCP_VA_SIC_BASE + IRQ_ENABLE_SET);
196 }
197
198 static struct irq_chip sic_chip = {
199 .name = "SIC",
200 .ack = sic_mask_irq,
201 .mask = sic_mask_irq,
202 .unmask = sic_unmask_irq,
203 };
204
205 static void
206 sic_handle_irq(unsigned int irq, struct irq_desc *desc)
207 {
208 unsigned long status = sic_readl(INTCP_VA_SIC_BASE + IRQ_STATUS);
209
210 if (status == 0) {
211 do_bad_IRQ(irq, desc);
212 return;
213 }
214
215 do {
216 irq = ffs(status) - 1;
217 status &= ~(1 << irq);
218
219 irq += IRQ_SIC_START;
220
221 generic_handle_irq(irq);
222 } while (status);
223 }
224
225 static void __init intcp_init_irq(void)
226 {
227 unsigned int i;
228
229 /*
230 * Disable all interrupt sources
231 */
232 pic_writel(0xffffffff, INTCP_VA_PIC_BASE + IRQ_ENABLE_CLEAR);
233 pic_writel(0xffffffff, INTCP_VA_PIC_BASE + FIQ_ENABLE_CLEAR);
234
235 for (i = IRQ_PIC_START; i <= IRQ_PIC_END; i++) {
236 if (i == 11)
237 i = 22;
238 if (i == 29)
239 break;
240 set_irq_chip(i, &pic_chip);
241 set_irq_handler(i, handle_level_irq);
242 set_irq_flags(i, IRQF_VALID | IRQF_PROBE);
243 }
244
245 cic_writel(0xffffffff, INTCP_VA_CIC_BASE + IRQ_ENABLE_CLEAR);
246 cic_writel(0xffffffff, INTCP_VA_CIC_BASE + FIQ_ENABLE_CLEAR);
247
248 for (i = IRQ_CIC_START; i <= IRQ_CIC_END; i++) {
249 set_irq_chip(i, &cic_chip);
250 set_irq_handler(i, handle_level_irq);
251 set_irq_flags(i, IRQF_VALID);
252 }
253
254 sic_writel(0x00000fff, INTCP_VA_SIC_BASE + IRQ_ENABLE_CLEAR);
255 sic_writel(0x00000fff, INTCP_VA_SIC_BASE + FIQ_ENABLE_CLEAR);
256
257 for (i = IRQ_SIC_START; i <= IRQ_SIC_END; i++) {
258 set_irq_chip(i, &sic_chip);
259 set_irq_handler(i, handle_level_irq);
260 set_irq_flags(i, IRQF_VALID | IRQF_PROBE);
261 }
262
263 set_irq_chained_handler(IRQ_CP_CPPLDINT, sic_handle_irq);
264 }
265
266 /*
267 * Clock handling
268 */
269 #define CM_LOCK (__io_address(INTEGRATOR_HDR_BASE)+INTEGRATOR_HDR_LOCK_OFFSET)
270 #define CM_AUXOSC (__io_address(INTEGRATOR_HDR_BASE)+0x1c)
271
272 static const struct icst_params cp_auxvco_params = {
273 .ref = 24000000,
274 .vco_max = ICST525_VCO_MAX_5V,
275 .vco_min = ICST525_VCO_MIN,
276 .vd_min = 8,
277 .vd_max = 263,
278 .rd_min = 3,
279 .rd_max = 65,
280 .s2div = icst525_s2div,
281 .idx2s = icst525_idx2s,
282 };
283
284 static void cp_auxvco_set(struct clk *clk, struct icst_vco vco)
285 {
286 u32 val;
287
288 val = readl(clk->vcoreg) & ~0x7ffff;
289 val |= vco.v | (vco.r << 9) | (vco.s << 16);
290
291 writel(0xa05f, CM_LOCK);
292 writel(val, clk->vcoreg);
293 writel(0, CM_LOCK);
294 }
295
296 static struct clk cp_auxclk = {
297 .params = &cp_auxvco_params,
298 .vcoreg = CM_AUXOSC,
299 .setvco = cp_auxvco_set,
300 };
301
302 static struct clk_lookup cp_lookups[] = {
303 { /* CLCD */
304 .dev_id = "mb:c0",
305 .clk = &cp_auxclk,
306 },
307 };
308
309 /*
310 * Flash handling.
311 */
312 static int intcp_flash_init(void)
313 {
314 u32 val;
315
316 val = readl(INTCP_VA_CTRL_BASE + INTCP_FLASHPROG);
317 val |= CINTEGRATOR_FLASHPROG_FLWREN;
318 writel(val, INTCP_VA_CTRL_BASE + INTCP_FLASHPROG);
319
320 return 0;
321 }
322
323 static void intcp_flash_exit(void)
324 {
325 u32 val;
326
327 val = readl(INTCP_VA_CTRL_BASE + INTCP_FLASHPROG);
328 val &= ~(CINTEGRATOR_FLASHPROG_FLVPPEN|CINTEGRATOR_FLASHPROG_FLWREN);
329 writel(val, INTCP_VA_CTRL_BASE + INTCP_FLASHPROG);
330 }
331
332 static void intcp_flash_set_vpp(int on)
333 {
334 u32 val;
335
336 val = readl(INTCP_VA_CTRL_BASE + INTCP_FLASHPROG);
337 if (on)
338 val |= CINTEGRATOR_FLASHPROG_FLVPPEN;
339 else
340 val &= ~CINTEGRATOR_FLASHPROG_FLVPPEN;
341 writel(val, INTCP_VA_CTRL_BASE + INTCP_FLASHPROG);
342 }
343
344 static struct flash_platform_data intcp_flash_data = {
345 .map_name = "cfi_probe",
346 .width = 4,
347 .init = intcp_flash_init,
348 .exit = intcp_flash_exit,
349 .set_vpp = intcp_flash_set_vpp,
350 };
351
352 static struct resource intcp_flash_resource = {
353 .start = INTCP_PA_FLASH_BASE,
354 .end = INTCP_PA_FLASH_BASE + INTCP_FLASH_SIZE - 1,
355 .flags = IORESOURCE_MEM,
356 };
357
358 static struct platform_device intcp_flash_device = {
359 .name = "armflash",
360 .id = 0,
361 .dev = {
362 .platform_data = &intcp_flash_data,
363 },
364 .num_resources = 1,
365 .resource = &intcp_flash_resource,
366 };
367
368 static struct resource smc91x_resources[] = {
369 [0] = {
370 .start = INTEGRATOR_CP_ETH_BASE,
371 .end = INTEGRATOR_CP_ETH_BASE + INTCP_ETH_SIZE - 1,
372 .flags = IORESOURCE_MEM,
373 },
374 [1] = {
375 .start = IRQ_CP_ETHINT,
376 .end = IRQ_CP_ETHINT,
377 .flags = IORESOURCE_IRQ,
378 },
379 };
380
381 static struct platform_device smc91x_device = {
382 .name = "smc91x",
383 .id = 0,
384 .num_resources = ARRAY_SIZE(smc91x_resources),
385 .resource = smc91x_resources,
386 };
387
388 static struct platform_device *intcp_devs[] __initdata = {
389 &intcp_flash_device,
390 &smc91x_device,
391 };
392
393 /*
394 * It seems that the card insertion interrupt remains active after
395 * we've acknowledged it. We therefore ignore the interrupt, and
396 * rely on reading it from the SIC. This also means that we must
397 * clear the latched interrupt.
398 */
399 static unsigned int mmc_status(struct device *dev)
400 {
401 unsigned int status = readl(IO_ADDRESS(0xca000000 + 4));
402 writel(8, IO_ADDRESS(INTEGRATOR_CP_CTL_BASE + 8));
403
404 return status & 8;
405 }
406
407 static struct mmci_platform_data mmc_data = {
408 .ocr_mask = MMC_VDD_32_33|MMC_VDD_33_34,
409 .status = mmc_status,
410 .gpio_wp = -1,
411 .gpio_cd = -1,
412 };
413
414 static struct amba_device mmc_device = {
415 .dev = {
416 .init_name = "mb:1c",
417 .platform_data = &mmc_data,
418 },
419 .res = {
420 .start = INTEGRATOR_CP_MMC_BASE,
421 .end = INTEGRATOR_CP_MMC_BASE + SZ_4K - 1,
422 .flags = IORESOURCE_MEM,
423 },
424 .irq = { IRQ_CP_MMCIINT0, IRQ_CP_MMCIINT1 },
425 .periphid = 0,
426 };
427
428 static struct amba_device aaci_device = {
429 .dev = {
430 .init_name = "mb:1d",
431 },
432 .res = {
433 .start = INTEGRATOR_CP_AACI_BASE,
434 .end = INTEGRATOR_CP_AACI_BASE + SZ_4K - 1,
435 .flags = IORESOURCE_MEM,
436 },
437 .irq = { IRQ_CP_AACIINT, NO_IRQ },
438 .periphid = 0,
439 };
440
441
442 /*
443 * CLCD support
444 */
445 static struct clcd_panel vga = {
446 .mode = {
447 .name = "VGA",
448 .refresh = 60,
449 .xres = 640,
450 .yres = 480,
451 .pixclock = 39721,
452 .left_margin = 40,
453 .right_margin = 24,
454 .upper_margin = 32,
455 .lower_margin = 11,
456 .hsync_len = 96,
457 .vsync_len = 2,
458 .sync = 0,
459 .vmode = FB_VMODE_NONINTERLACED,
460 },
461 .width = -1,
462 .height = -1,
463 .tim2 = TIM2_BCD | TIM2_IPC,
464 .cntl = CNTL_LCDTFT | CNTL_LCDVCOMP(1),
465 .bpp = 16,
466 .grayscale = 0,
467 };
468
469 /*
470 * Ensure VGA is selected.
471 */
472 static void cp_clcd_enable(struct clcd_fb *fb)
473 {
474 u32 val;
475
476 if (fb->fb.var.bits_per_pixel <= 8)
477 val = CM_CTRL_LCDMUXSEL_VGA_8421BPP;
478 else if (fb->fb.var.bits_per_pixel <= 16)
479 val = CM_CTRL_LCDMUXSEL_VGA_16BPP
480 | CM_CTRL_LCDEN0 | CM_CTRL_LCDEN1
481 | CM_CTRL_STATIC1 | CM_CTRL_STATIC2;
482 else
483 val = 0; /* no idea for this, don't trust the docs */
484
485 cm_control(CM_CTRL_LCDMUXSEL_MASK|
486 CM_CTRL_LCDEN0|
487 CM_CTRL_LCDEN1|
488 CM_CTRL_STATIC1|
489 CM_CTRL_STATIC2|
490 CM_CTRL_STATIC|
491 CM_CTRL_n24BITEN, val);
492 }
493
494 static unsigned long framesize = SZ_1M;
495
496 static int cp_clcd_setup(struct clcd_fb *fb)
497 {
498 dma_addr_t dma;
499
500 fb->panel = &vga;
501
502 fb->fb.screen_base = dma_alloc_writecombine(&fb->dev->dev, framesize,
503 &dma, GFP_KERNEL);
504 if (!fb->fb.screen_base) {
505 printk(KERN_ERR "CLCD: unable to map framebuffer\n");
506 return -ENOMEM;
507 }
508
509 fb->fb.fix.smem_start = dma;
510 fb->fb.fix.smem_len = framesize;
511
512 return 0;
513 }
514
515 static int cp_clcd_mmap(struct clcd_fb *fb, struct vm_area_struct *vma)
516 {
517 return dma_mmap_writecombine(&fb->dev->dev, vma,
518 fb->fb.screen_base,
519 fb->fb.fix.smem_start,
520 fb->fb.fix.smem_len);
521 }
522
523 static void cp_clcd_remove(struct clcd_fb *fb)
524 {
525 dma_free_writecombine(&fb->dev->dev, fb->fb.fix.smem_len,
526 fb->fb.screen_base, fb->fb.fix.smem_start);
527 }
528
529 static struct clcd_board clcd_data = {
530 .name = "Integrator/CP",
531 .check = clcdfb_check,
532 .decode = clcdfb_decode,
533 .enable = cp_clcd_enable,
534 .setup = cp_clcd_setup,
535 .mmap = cp_clcd_mmap,
536 .remove = cp_clcd_remove,
537 };
538
539 static struct amba_device clcd_device = {
540 .dev = {
541 .init_name = "mb:c0",
542 .coherent_dma_mask = ~0,
543 .platform_data = &clcd_data,
544 },
545 .res = {
546 .start = INTCP_PA_CLCD_BASE,
547 .end = INTCP_PA_CLCD_BASE + SZ_4K - 1,
548 .flags = IORESOURCE_MEM,
549 },
550 .dma_mask = ~0,
551 .irq = { IRQ_CP_CLCDCINT, NO_IRQ },
552 .periphid = 0,
553 };
554
555 static struct amba_device *amba_devs[] __initdata = {
556 &mmc_device,
557 &aaci_device,
558 &clcd_device,
559 };
560
561 static void __init intcp_init(void)
562 {
563 int i;
564
565 clkdev_add_table(cp_lookups, ARRAY_SIZE(cp_lookups));
566 platform_add_devices(intcp_devs, ARRAY_SIZE(intcp_devs));
567
568 for (i = 0; i < ARRAY_SIZE(amba_devs); i++) {
569 struct amba_device *d = amba_devs[i];
570 amba_device_register(d, &iomem_resource);
571 }
572 }
573
574 #define TIMER0_VA_BASE __io_address(INTEGRATOR_TIMER0_BASE)
575 #define TIMER1_VA_BASE __io_address(INTEGRATOR_TIMER1_BASE)
576 #define TIMER2_VA_BASE __io_address(INTEGRATOR_TIMER2_BASE)
577
578 static void __init intcp_timer_init(void)
579 {
580 writel(0, TIMER0_VA_BASE + TIMER_CTRL);
581 writel(0, TIMER1_VA_BASE + TIMER_CTRL);
582 writel(0, TIMER2_VA_BASE + TIMER_CTRL);
583
584 sp804_clocksource_init(TIMER2_VA_BASE);
585 sp804_clockevents_init(TIMER1_VA_BASE, IRQ_TIMERINT1);
586 }
587
588 static struct sys_timer cp_timer = {
589 .init = intcp_timer_init,
590 };
591
592 MACHINE_START(CINTEGRATOR, "ARM-IntegratorCP")
593 /* Maintainer: ARM Ltd/Deep Blue Solutions Ltd */
594 .phys_io = 0x16000000,
595 .io_pg_offst = ((0xf1600000) >> 18) & 0xfffc,
596 .boot_params = 0x00000100,
597 .map_io = intcp_map_io,
598 .init_irq = intcp_init_irq,
599 .timer = &cp_timer,
600 .init_machine = intcp_init,
601 MACHINE_END
This page took 0.045051 seconds and 5 git commands to generate.