blob: be9ead4a3bcc3b55a44634fbdc6eabcb37733a32 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
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>
Russell Kingd052d1b2005-10-29 19:07:23 +010014#include <linux/platform_device.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070015#include <linux/dma-mapping.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070016#include <linux/string.h>
Kay Sieversedbaa602011-12-21 16:26:03 -080017#include <linux/device.h>
Russell Kinga62c80e2006-01-07 13:52:45 +000018#include <linux/amba/bus.h>
19#include <linux/amba/kmi.h>
20#include <linux/amba/clcd.h>
Linus Walleij6ef297f2009-09-22 14:29:36 +010021#include <linux/amba/mmci.h>
Russell Kingfced80c2008-09-06 12:10:45 +010022#include <linux/io.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090023#include <linux/gfp.h>
Jean-Christop PLAGNIOL-VILLARD6d803ba2010-11-17 10:04:33 +010024#include <linux/clkdev.h>
Marc Zyngier046dfa02011-05-18 10:51:53 +010025#include <linux/mtd/physmap.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070026
Russell Kinga09e64f2008-08-05 16:14:15 +010027#include <mach/hardware.h>
Russell Kinga285edc2010-01-14 19:59:37 +000028#include <mach/platform.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070029#include <asm/irq.h>
30#include <asm/setup.h>
31#include <asm/mach-types.h>
Russell King5a463342010-01-16 23:52:12 +000032#include <asm/hardware/arm_timer.h>
Russell Kingc5a0adb2010-01-16 20:16:10 +000033#include <asm/hardware/icst.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070034
Russell Kinga09e64f2008-08-05 16:14:15 +010035#include <mach/cm.h>
36#include <mach/lm.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070037
38#include <asm/mach/arch.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070039#include <asm/mach/irq.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070040#include <asm/mach/map.h>
41#include <asm/mach/time.h>
42
Rob Herring8a9618f2010-10-06 16:18:08 +010043#include <asm/hardware/timer-sp.h>
Russell King5a463342010-01-16 23:52:12 +000044
Russell King9dfec4f2011-01-18 20:10:10 +000045#include <plat/clcd.h>
Russell Kingc41b16f2011-01-19 15:32:15 +000046#include <plat/fpga-irq.h>
Russell Kingd77e2702011-01-22 11:37:54 +000047#include <plat/sched_clock.h>
Russell King9dfec4f2011-01-18 20:10:10 +000048
Russell King98c672c2010-05-22 18:18:57 +010049#include "common.h"
50
Linus Torvalds1da177e2005-04-16 15:20:36 -070051#define INTCP_PA_FLASH_BASE 0x24000000
52#define INTCP_FLASH_SIZE SZ_32M
53
54#define INTCP_PA_CLCD_BASE 0xc0000000
55
Russell Kingc41b16f2011-01-19 15:32:15 +000056#define INTCP_VA_CIC_BASE __io_address(INTEGRATOR_HDR_BASE + 0x40)
57#define INTCP_VA_PIC_BASE __io_address(INTEGRATOR_IC_BASE)
58#define INTCP_VA_SIC_BASE __io_address(INTEGRATOR_CP_SIC_BASE)
Linus Torvalds1da177e2005-04-16 15:20:36 -070059
Linus Torvalds1da177e2005-04-16 15:20:36 -070060#define INTCP_ETH_SIZE 0x10
61
Russell Kingda7ba952010-01-17 19:59:58 +000062#define INTCP_VA_CTRL_BASE IO_ADDRESS(INTEGRATOR_CP_CTL_BASE)
Linus Torvalds1da177e2005-04-16 15:20:36 -070063#define INTCP_FLASHPROG 0x04
64#define CINTEGRATOR_FLASHPROG_FLVPPEN (1 << 0)
65#define CINTEGRATOR_FLASHPROG_FLWREN (1 << 1)
66
67/*
68 * Logical Physical
69 * f1000000 10000000 Core module registers
70 * f1100000 11000000 System controller registers
71 * f1200000 12000000 EBI registers
72 * f1300000 13000000 Counter/Timer
73 * f1400000 14000000 Interrupt controller
74 * f1600000 16000000 UART 0
75 * f1700000 17000000 UART 1
76 * f1a00000 1a000000 Debug LEDs
Russell Kingda7ba952010-01-17 19:59:58 +000077 * fc900000 c9000000 GPIO
78 * fca00000 ca000000 SIC
79 * fcb00000 cb000000 CP system control
Linus Torvalds1da177e2005-04-16 15:20:36 -070080 */
81
82static struct map_desc intcp_io_desc[] __initdata = {
Deepak Saxenac8d27292005-10-28 15:19:10 +010083 {
84 .virtual = IO_ADDRESS(INTEGRATOR_HDR_BASE),
85 .pfn = __phys_to_pfn(INTEGRATOR_HDR_BASE),
86 .length = SZ_4K,
87 .type = MT_DEVICE
88 }, {
89 .virtual = IO_ADDRESS(INTEGRATOR_SC_BASE),
90 .pfn = __phys_to_pfn(INTEGRATOR_SC_BASE),
91 .length = SZ_4K,
92 .type = MT_DEVICE
93 }, {
94 .virtual = IO_ADDRESS(INTEGRATOR_EBI_BASE),
95 .pfn = __phys_to_pfn(INTEGRATOR_EBI_BASE),
96 .length = SZ_4K,
97 .type = MT_DEVICE
98 }, {
99 .virtual = IO_ADDRESS(INTEGRATOR_CT_BASE),
100 .pfn = __phys_to_pfn(INTEGRATOR_CT_BASE),
101 .length = SZ_4K,
102 .type = MT_DEVICE
103 }, {
104 .virtual = IO_ADDRESS(INTEGRATOR_IC_BASE),
105 .pfn = __phys_to_pfn(INTEGRATOR_IC_BASE),
106 .length = SZ_4K,
107 .type = MT_DEVICE
108 }, {
109 .virtual = IO_ADDRESS(INTEGRATOR_UART0_BASE),
110 .pfn = __phys_to_pfn(INTEGRATOR_UART0_BASE),
111 .length = SZ_4K,
112 .type = MT_DEVICE
113 }, {
114 .virtual = IO_ADDRESS(INTEGRATOR_UART1_BASE),
115 .pfn = __phys_to_pfn(INTEGRATOR_UART1_BASE),
116 .length = SZ_4K,
117 .type = MT_DEVICE
118 }, {
119 .virtual = IO_ADDRESS(INTEGRATOR_DBG_BASE),
120 .pfn = __phys_to_pfn(INTEGRATOR_DBG_BASE),
121 .length = SZ_4K,
122 .type = MT_DEVICE
123 }, {
Russell Kingda7ba952010-01-17 19:59:58 +0000124 .virtual = IO_ADDRESS(INTEGRATOR_CP_GPIO_BASE),
125 .pfn = __phys_to_pfn(INTEGRATOR_CP_GPIO_BASE),
Deepak Saxenac8d27292005-10-28 15:19:10 +0100126 .length = SZ_4K,
127 .type = MT_DEVICE
128 }, {
Russell Kingda7ba952010-01-17 19:59:58 +0000129 .virtual = IO_ADDRESS(INTEGRATOR_CP_SIC_BASE),
130 .pfn = __phys_to_pfn(INTEGRATOR_CP_SIC_BASE),
Deepak Saxenac8d27292005-10-28 15:19:10 +0100131 .length = SZ_4K,
132 .type = MT_DEVICE
133 }, {
Russell Kingda7ba952010-01-17 19:59:58 +0000134 .virtual = IO_ADDRESS(INTEGRATOR_CP_CTL_BASE),
135 .pfn = __phys_to_pfn(INTEGRATOR_CP_CTL_BASE),
Deepak Saxenac8d27292005-10-28 15:19:10 +0100136 .length = SZ_4K,
137 .type = MT_DEVICE
138 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700139};
140
141static void __init intcp_map_io(void)
142{
143 iotable_init(intcp_io_desc, ARRAY_SIZE(intcp_io_desc));
144}
145
Russell Kingc41b16f2011-01-19 15:32:15 +0000146static struct fpga_irq_data cic_irq_data = {
147 .base = INTCP_VA_CIC_BASE,
148 .irq_start = IRQ_CIC_START,
149 .chip.name = "CIC",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700150};
151
Russell Kingc41b16f2011-01-19 15:32:15 +0000152static struct fpga_irq_data pic_irq_data = {
153 .base = INTCP_VA_PIC_BASE,
154 .irq_start = IRQ_PIC_START,
155 .chip.name = "PIC",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700156};
157
Russell Kingc41b16f2011-01-19 15:32:15 +0000158static struct fpga_irq_data sic_irq_data = {
159 .base = INTCP_VA_SIC_BASE,
160 .irq_start = IRQ_SIC_START,
161 .chip.name = "SIC",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700162};
163
Linus Torvalds1da177e2005-04-16 15:20:36 -0700164static void __init intcp_init_irq(void)
165{
Russell Kingc41b16f2011-01-19 15:32:15 +0000166 u32 pic_mask, sic_mask;
167
168 pic_mask = ~((~0u) << (11 - IRQ_PIC_START));
169 pic_mask |= (~((~0u) << (29 - 22))) << 22;
170 sic_mask = ~((~0u) << (1 + IRQ_SIC_END - IRQ_SIC_START));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700171
172 /*
173 * Disable all interrupt sources
174 */
Russell Kingc41b16f2011-01-19 15:32:15 +0000175 writel(0xffffffff, INTCP_VA_PIC_BASE + IRQ_ENABLE_CLEAR);
176 writel(0xffffffff, INTCP_VA_PIC_BASE + FIQ_ENABLE_CLEAR);
177 writel(0xffffffff, INTCP_VA_CIC_BASE + IRQ_ENABLE_CLEAR);
178 writel(0xffffffff, INTCP_VA_CIC_BASE + FIQ_ENABLE_CLEAR);
179 writel(sic_mask, INTCP_VA_SIC_BASE + IRQ_ENABLE_CLEAR);
180 writel(sic_mask, INTCP_VA_SIC_BASE + FIQ_ENABLE_CLEAR);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700181
Russell Kingc41b16f2011-01-19 15:32:15 +0000182 fpga_irq_init(-1, pic_mask, &pic_irq_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700183
Russell Kingc41b16f2011-01-19 15:32:15 +0000184 fpga_irq_init(-1, ~((~0u) << (1 + IRQ_CIC_END - IRQ_CIC_START)),
185 &cic_irq_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700186
Russell Kingc41b16f2011-01-19 15:32:15 +0000187 fpga_irq_init(IRQ_CP_CPPLDINT, sic_mask, &sic_irq_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700188}
189
190/*
191 * Clock handling
192 */
Russell Kingd1914c72010-01-14 20:09:34 +0000193#define CM_LOCK (__io_address(INTEGRATOR_HDR_BASE)+INTEGRATOR_HDR_LOCK_OFFSET)
194#define CM_AUXOSC (__io_address(INTEGRATOR_HDR_BASE)+0x1c)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700195
Russell King39c0cb02010-01-16 16:27:28 +0000196static const struct icst_params cp_auxvco_params = {
Russell King64fceb12010-01-16 17:28:44 +0000197 .ref = 24000000,
Russell King4de2edb2010-01-16 18:08:47 +0000198 .vco_max = ICST525_VCO_MAX_5V,
Russell Kinge73a46a2010-01-16 19:49:39 +0000199 .vco_min = ICST525_VCO_MIN,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700200 .vd_min = 8,
201 .vd_max = 263,
202 .rd_min = 3,
203 .rd_max = 65,
Russell King232eaf72010-01-16 19:46:19 +0000204 .s2div = icst525_s2div,
205 .idx2s = icst525_idx2s,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700206};
207
Russell King39c0cb02010-01-16 16:27:28 +0000208static void cp_auxvco_set(struct clk *clk, struct icst_vco vco)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700209{
210 u32 val;
211
Russell Kingd1914c72010-01-14 20:09:34 +0000212 val = readl(clk->vcoreg) & ~0x7ffff;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700213 val |= vco.v | (vco.r << 9) | (vco.s << 16);
214
215 writel(0xa05f, CM_LOCK);
Russell Kingd1914c72010-01-14 20:09:34 +0000216 writel(val, clk->vcoreg);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700217 writel(0, CM_LOCK);
218}
219
Russell King9bf5b2e2010-03-01 16:18:39 +0000220static const struct clk_ops cp_auxclk_ops = {
221 .round = icst_clk_round,
222 .set = icst_clk_set,
223 .setvco = cp_auxvco_set,
224};
225
Russell Kingd72fbdf2008-11-08 20:08:08 +0000226static struct clk cp_auxclk = {
Russell King9bf5b2e2010-03-01 16:18:39 +0000227 .ops = &cp_auxclk_ops,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700228 .params = &cp_auxvco_params,
Russell Kingd1914c72010-01-14 20:09:34 +0000229 .vcoreg = CM_AUXOSC,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700230};
231
Russell King7ff550d2011-05-12 13:31:48 +0100232static struct clk sp804_clk = {
233 .rate = 1000000,
234};
235
Russell Kingd72fbdf2008-11-08 20:08:08 +0000236static struct clk_lookup cp_lookups[] = {
237 { /* CLCD */
238 .dev_id = "mb:c0",
239 .clk = &cp_auxclk,
Russell King7ff550d2011-05-12 13:31:48 +0100240 }, { /* SP804 timers */
241 .dev_id = "sp804",
242 .clk = &sp804_clk,
Russell Kingd72fbdf2008-11-08 20:08:08 +0000243 },
Linus Torvalds1da177e2005-04-16 15:20:36 -0700244};
245
246/*
247 * Flash handling.
248 */
Marc Zyngier046dfa02011-05-18 10:51:53 +0100249static int intcp_flash_init(struct platform_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700250{
251 u32 val;
252
253 val = readl(INTCP_VA_CTRL_BASE + INTCP_FLASHPROG);
254 val |= CINTEGRATOR_FLASHPROG_FLWREN;
255 writel(val, INTCP_VA_CTRL_BASE + INTCP_FLASHPROG);
256
257 return 0;
258}
259
Marc Zyngier046dfa02011-05-18 10:51:53 +0100260static void intcp_flash_exit(struct platform_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700261{
262 u32 val;
263
264 val = readl(INTCP_VA_CTRL_BASE + INTCP_FLASHPROG);
265 val &= ~(CINTEGRATOR_FLASHPROG_FLVPPEN|CINTEGRATOR_FLASHPROG_FLWREN);
266 writel(val, INTCP_VA_CTRL_BASE + INTCP_FLASHPROG);
267}
268
Marc Zyngier667f3902011-05-18 10:51:55 +0100269static void intcp_flash_set_vpp(struct platform_device *pdev, int on)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700270{
271 u32 val;
272
273 val = readl(INTCP_VA_CTRL_BASE + INTCP_FLASHPROG);
274 if (on)
275 val |= CINTEGRATOR_FLASHPROG_FLVPPEN;
276 else
277 val &= ~CINTEGRATOR_FLASHPROG_FLVPPEN;
278 writel(val, INTCP_VA_CTRL_BASE + INTCP_FLASHPROG);
279}
280
Marc Zyngier046dfa02011-05-18 10:51:53 +0100281static struct physmap_flash_data intcp_flash_data = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700282 .width = 4,
283 .init = intcp_flash_init,
284 .exit = intcp_flash_exit,
285 .set_vpp = intcp_flash_set_vpp,
286};
287
288static struct resource intcp_flash_resource = {
289 .start = INTCP_PA_FLASH_BASE,
290 .end = INTCP_PA_FLASH_BASE + INTCP_FLASH_SIZE - 1,
291 .flags = IORESOURCE_MEM,
292};
293
294static struct platform_device intcp_flash_device = {
Marc Zyngier046dfa02011-05-18 10:51:53 +0100295 .name = "physmap-flash",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700296 .id = 0,
297 .dev = {
298 .platform_data = &intcp_flash_data,
299 },
300 .num_resources = 1,
301 .resource = &intcp_flash_resource,
302};
303
304static struct resource smc91x_resources[] = {
305 [0] = {
Russell Kingda7ba952010-01-17 19:59:58 +0000306 .start = INTEGRATOR_CP_ETH_BASE,
307 .end = INTEGRATOR_CP_ETH_BASE + INTCP_ETH_SIZE - 1,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700308 .flags = IORESOURCE_MEM,
309 },
310 [1] = {
311 .start = IRQ_CP_ETHINT,
312 .end = IRQ_CP_ETHINT,
313 .flags = IORESOURCE_IRQ,
314 },
315};
316
317static struct platform_device smc91x_device = {
318 .name = "smc91x",
319 .id = 0,
320 .num_resources = ARRAY_SIZE(smc91x_resources),
321 .resource = smc91x_resources,
322};
323
324static struct platform_device *intcp_devs[] __initdata = {
325 &intcp_flash_device,
326 &smc91x_device,
327};
328
329/*
330 * It seems that the card insertion interrupt remains active after
331 * we've acknowledged it. We therefore ignore the interrupt, and
332 * rely on reading it from the SIC. This also means that we must
333 * clear the latched interrupt.
334 */
335static unsigned int mmc_status(struct device *dev)
336{
Russell Kingb830b9b2010-01-17 20:45:12 +0000337 unsigned int status = readl(IO_ADDRESS(0xca000000 + 4));
338 writel(8, IO_ADDRESS(INTEGRATOR_CP_CTL_BASE + 8));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700339
340 return status & 8;
341}
342
Linus Walleij6ef297f2009-09-22 14:29:36 +0100343static struct mmci_platform_data mmc_data = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700344 .ocr_mask = MMC_VDD_32_33|MMC_VDD_33_34,
345 .status = mmc_status,
Russell King7fb2bbf2009-07-09 15:15:12 +0100346 .gpio_wp = -1,
347 .gpio_cd = -1,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700348};
349
Russell King2f64ccd2011-12-18 14:50:51 +0000350#define INTEGRATOR_CP_MMC_IRQS { IRQ_CP_MMCIINT0, IRQ_CP_MMCIINT1 }
351#define INTEGRATOR_CP_AACI_IRQS { IRQ_CP_AACIINT }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700352
Russell King2f64ccd2011-12-18 14:50:51 +0000353static AMBA_APB_DEVICE(mmc, "mb:1c", 0, INTEGRATOR_CP_MMC_BASE,
354 INTEGRATOR_CP_MMC_IRQS, &mmc_data);
355
356static AMBA_APB_DEVICE(aaci, "mb:1d", 0, INTEGRATOR_CP_AACI_BASE,
357 INTEGRATOR_CP_AACI_IRQS, NULL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700358
359
360/*
361 * CLCD support
362 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700363/*
364 * Ensure VGA is selected.
365 */
366static void cp_clcd_enable(struct clcd_fb *fb)
367{
Russell Kinge6b9c1f2011-01-22 11:02:10 +0000368 struct fb_var_screeninfo *var = &fb->fb.var;
369 u32 val = CM_CTRL_STATIC1 | CM_CTRL_STATIC2;
Russell King4774e222005-04-30 23:32:38 +0100370
Russell Kinge6b9c1f2011-01-22 11:02:10 +0000371 if (var->bits_per_pixel <= 8 ||
372 (var->bits_per_pixel == 16 && var->green.length == 5))
373 /* Pseudocolor, RGB555, BGR555 */
374 val |= CM_CTRL_LCDMUXSEL_VGA555_TFT555;
Russell King4774e222005-04-30 23:32:38 +0100375 else if (fb->fb.var.bits_per_pixel <= 16)
Russell Kinge6b9c1f2011-01-22 11:02:10 +0000376 /* truecolor RGB565 */
377 val |= CM_CTRL_LCDMUXSEL_VGA565_TFT555;
Russell King4774e222005-04-30 23:32:38 +0100378 else
379 val = 0; /* no idea for this, don't trust the docs */
380
381 cm_control(CM_CTRL_LCDMUXSEL_MASK|
382 CM_CTRL_LCDEN0|
383 CM_CTRL_LCDEN1|
384 CM_CTRL_STATIC1|
385 CM_CTRL_STATIC2|
386 CM_CTRL_STATIC|
387 CM_CTRL_n24BITEN, val);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700388}
389
Linus Torvalds1da177e2005-04-16 15:20:36 -0700390static int cp_clcd_setup(struct clcd_fb *fb)
391{
Russell King9dfec4f2011-01-18 20:10:10 +0000392 fb->panel = versatile_clcd_get_panel("VGA");
393 if (!fb->panel)
394 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700395
Russell King9dfec4f2011-01-18 20:10:10 +0000396 return versatile_clcd_setup_dma(fb, SZ_1M);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700397}
398
399static struct clcd_board clcd_data = {
400 .name = "Integrator/CP",
Russell King9dfec4f2011-01-18 20:10:10 +0000401 .caps = CLCD_CAP_5551 | CLCD_CAP_RGB565 | CLCD_CAP_888,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700402 .check = clcdfb_check,
403 .decode = clcdfb_decode,
404 .enable = cp_clcd_enable,
405 .setup = cp_clcd_setup,
Russell King9dfec4f2011-01-18 20:10:10 +0000406 .mmap = versatile_clcd_mmap_dma,
407 .remove = versatile_clcd_remove_dma,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700408};
409
Russell King2f64ccd2011-12-18 14:50:51 +0000410static AMBA_AHB_DEVICE(clcd, "mb:c0", 0, INTCP_PA_CLCD_BASE,
411 { IRQ_CP_CLCDCINT }, &clcd_data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700412
413static struct amba_device *amba_devs[] __initdata = {
414 &mmc_device,
415 &aaci_device,
416 &clcd_device,
417};
418
Russell Kingd77e2702011-01-22 11:37:54 +0000419#define REFCOUNTER (__io_address(INTEGRATOR_HDR_BASE) + 0x28)
420
Russell Kingc735c982011-01-11 13:00:04 +0000421static void __init intcp_init_early(void)
422{
423 clkdev_add_table(cp_lookups, ARRAY_SIZE(cp_lookups));
424
425 integrator_init_early();
Russell Kingd77e2702011-01-22 11:37:54 +0000426
427#ifdef CONFIG_PLAT_VERSATILE_SCHED_CLOCK
428 versatile_sched_clock_init(REFCOUNTER, 24000000);
429#endif
Russell Kingc735c982011-01-11 13:00:04 +0000430}
431
Linus Torvalds1da177e2005-04-16 15:20:36 -0700432static void __init intcp_init(void)
433{
434 int i;
435
Linus Torvalds1da177e2005-04-16 15:20:36 -0700436 platform_add_devices(intcp_devs, ARRAY_SIZE(intcp_devs));
437
438 for (i = 0; i < ARRAY_SIZE(amba_devs); i++) {
439 struct amba_device *d = amba_devs[i];
440 amba_device_register(d, &iomem_resource);
441 }
442}
443
Russell King5a463342010-01-16 23:52:12 +0000444#define TIMER0_VA_BASE __io_address(INTEGRATOR_TIMER0_BASE)
445#define TIMER1_VA_BASE __io_address(INTEGRATOR_TIMER1_BASE)
446#define TIMER2_VA_BASE __io_address(INTEGRATOR_TIMER2_BASE)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700447
448static void __init intcp_timer_init(void)
449{
Russell King5a463342010-01-16 23:52:12 +0000450 writel(0, TIMER0_VA_BASE + TIMER_CTRL);
451 writel(0, TIMER1_VA_BASE + TIMER_CTRL);
452 writel(0, TIMER2_VA_BASE + TIMER_CTRL);
453
Russell Kingfb593cf2011-05-12 12:08:23 +0100454 sp804_clocksource_init(TIMER2_VA_BASE, "timer2");
Russell King57cc4f72011-05-12 15:31:13 +0100455 sp804_clockevents_init(TIMER1_VA_BASE, IRQ_TIMERINT1, "timer1");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700456}
457
458static struct sys_timer cp_timer = {
459 .init = intcp_timer_init,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700460};
461
462MACHINE_START(CINTEGRATOR, "ARM-IntegratorCP")
Russell Kinge9dea0c2005-07-03 17:38:58 +0100463 /* Maintainer: ARM Ltd/Deep Blue Solutions Ltd */
Nicolas Pitrec5e587a2011-07-05 22:38:12 -0400464 .atag_offset = 0x100,
Russell King98c672c2010-05-22 18:18:57 +0100465 .reserve = integrator_reserve,
Russell Kingc735c982011-01-11 13:00:04 +0000466 .map_io = intcp_map_io,
467 .init_early = intcp_init_early,
Russell Kinge9dea0c2005-07-03 17:38:58 +0100468 .init_irq = intcp_init_irq,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700469 .timer = &cp_timer,
Russell Kinge9dea0c2005-07-03 17:38:58 +0100470 .init_machine = intcp_init,
Russell King6338b662011-11-03 19:54:37 +0000471 .restart = integrator_restart,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700472MACHINE_END