2 * linux/arch/arm/mach-integrator/integrator_cp.c
4 * Copyright (C) 2003 Deep Blue Solutions Ltd
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.
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/string.h>
17 #include <linux/device.h>
18 #include <linux/amba/bus.h>
19 #include <linux/amba/kmi.h>
20 #include <linux/amba/clcd.h>
21 #include <linux/platform_data/video-clcd-versatile.h>
22 #include <linux/amba/mmci.h>
24 #include <linux/irqchip/versatile-fpga.h>
25 #include <linux/gfp.h>
26 #include <linux/mtd/physmap.h>
27 #include <linux/of_irq.h>
28 #include <linux/of_address.h>
29 #include <linux/of_platform.h>
30 #include <linux/sys_soc.h>
31 #include <linux/sched_clock.h>
33 #include <asm/setup.h>
34 #include <asm/mach-types.h>
35 #include <asm/mach/arch.h>
36 #include <asm/mach/irq.h>
37 #include <asm/mach/map.h>
38 #include <asm/mach/time.h>
44 /* Base address to the CP controller */
45 static void __iomem
*intcp_con_base
;
47 #define INTCP_PA_FLASH_BASE 0x24000000
49 #define INTCP_PA_CLCD_BASE 0xc0000000
51 #define INTCP_FLASHPROG 0x04
52 #define CINTEGRATOR_FLASHPROG_FLVPPEN (1 << 0)
53 #define CINTEGRATOR_FLASHPROG_FLWREN (1 << 1)
57 * f1000000 10000000 Core module registers
58 * f1300000 13000000 Counter/Timer
59 * f1400000 14000000 Interrupt controller
60 * f1600000 16000000 UART 0
61 * f1700000 17000000 UART 1
62 * f1a00000 1a000000 Debug LEDs
63 * fc900000 c9000000 GPIO
64 * fca00000 ca000000 SIC
67 static struct map_desc intcp_io_desc
[] __initdata __maybe_unused
= {
69 .virtual = IO_ADDRESS(INTEGRATOR_HDR_BASE
),
70 .pfn
= __phys_to_pfn(INTEGRATOR_HDR_BASE
),
74 .virtual = IO_ADDRESS(INTEGRATOR_CT_BASE
),
75 .pfn
= __phys_to_pfn(INTEGRATOR_CT_BASE
),
79 .virtual = IO_ADDRESS(INTEGRATOR_IC_BASE
),
80 .pfn
= __phys_to_pfn(INTEGRATOR_IC_BASE
),
84 .virtual = IO_ADDRESS(INTEGRATOR_UART0_BASE
),
85 .pfn
= __phys_to_pfn(INTEGRATOR_UART0_BASE
),
89 .virtual = IO_ADDRESS(INTEGRATOR_DBG_BASE
),
90 .pfn
= __phys_to_pfn(INTEGRATOR_DBG_BASE
),
94 .virtual = IO_ADDRESS(INTEGRATOR_CP_GPIO_BASE
),
95 .pfn
= __phys_to_pfn(INTEGRATOR_CP_GPIO_BASE
),
99 .virtual = IO_ADDRESS(INTEGRATOR_CP_SIC_BASE
),
100 .pfn
= __phys_to_pfn(INTEGRATOR_CP_SIC_BASE
),
106 static void __init
intcp_map_io(void)
108 iotable_init(intcp_io_desc
, ARRAY_SIZE(intcp_io_desc
));
114 static int intcp_flash_init(struct platform_device
*dev
)
118 val
= readl(intcp_con_base
+ INTCP_FLASHPROG
);
119 val
|= CINTEGRATOR_FLASHPROG_FLWREN
;
120 writel(val
, intcp_con_base
+ INTCP_FLASHPROG
);
125 static void intcp_flash_exit(struct platform_device
*dev
)
129 val
= readl(intcp_con_base
+ INTCP_FLASHPROG
);
130 val
&= ~(CINTEGRATOR_FLASHPROG_FLVPPEN
|CINTEGRATOR_FLASHPROG_FLWREN
);
131 writel(val
, intcp_con_base
+ INTCP_FLASHPROG
);
134 static void intcp_flash_set_vpp(struct platform_device
*pdev
, int on
)
138 val
= readl(intcp_con_base
+ INTCP_FLASHPROG
);
140 val
|= CINTEGRATOR_FLASHPROG_FLVPPEN
;
142 val
&= ~CINTEGRATOR_FLASHPROG_FLVPPEN
;
143 writel(val
, intcp_con_base
+ INTCP_FLASHPROG
);
146 static struct physmap_flash_data intcp_flash_data
= {
148 .init
= intcp_flash_init
,
149 .exit
= intcp_flash_exit
,
150 .set_vpp
= intcp_flash_set_vpp
,
154 * It seems that the card insertion interrupt remains active after
155 * we've acknowledged it. We therefore ignore the interrupt, and
156 * rely on reading it from the SIC. This also means that we must
157 * clear the latched interrupt.
159 static unsigned int mmc_status(struct device
*dev
)
161 unsigned int status
= readl(__io_address(0xca000000 + 4));
162 writel(8, intcp_con_base
+ 8);
167 static struct mmci_platform_data mmc_data
= {
168 .ocr_mask
= MMC_VDD_32_33
|MMC_VDD_33_34
,
169 .status
= mmc_status
,
178 * Ensure VGA is selected.
180 static void cp_clcd_enable(struct clcd_fb
*fb
)
182 struct fb_var_screeninfo
*var
= &fb
->fb
.var
;
183 u32 val
= CM_CTRL_STATIC1
| CM_CTRL_STATIC2
184 | CM_CTRL_LCDEN0
| CM_CTRL_LCDEN1
;
186 if (var
->bits_per_pixel
<= 8 ||
187 (var
->bits_per_pixel
== 16 && var
->green
.length
== 5))
188 /* Pseudocolor, RGB555, BGR555 */
189 val
|= CM_CTRL_LCDMUXSEL_VGA555_TFT555
;
190 else if (fb
->fb
.var
.bits_per_pixel
<= 16)
191 /* truecolor RGB565 */
192 val
|= CM_CTRL_LCDMUXSEL_VGA565_TFT555
;
194 val
= 0; /* no idea for this, don't trust the docs */
196 cm_control(CM_CTRL_LCDMUXSEL_MASK
|
202 CM_CTRL_n24BITEN
, val
);
205 static int cp_clcd_setup(struct clcd_fb
*fb
)
207 fb
->panel
= versatile_clcd_get_panel("VGA");
211 return versatile_clcd_setup_dma(fb
, SZ_1M
);
214 static struct clcd_board clcd_data
= {
215 .name
= "Integrator/CP",
216 .caps
= CLCD_CAP_5551
| CLCD_CAP_RGB565
| CLCD_CAP_888
,
217 .check
= clcdfb_check
,
218 .decode
= clcdfb_decode
,
219 .enable
= cp_clcd_enable
,
220 .setup
= cp_clcd_setup
,
221 .mmap
= versatile_clcd_mmap_dma
,
222 .remove
= versatile_clcd_remove_dma
,
225 #define REFCOUNTER (__io_address(INTEGRATOR_HDR_BASE) + 0x28)
227 static u64 notrace
intcp_read_sched_clock(void)
229 return readl(REFCOUNTER
);
232 static void __init
intcp_init_early(void)
234 sched_clock_register(intcp_read_sched_clock
, 32, 24000000);
237 static const struct of_device_id fpga_irq_of_match
[] __initconst
= {
238 { .compatible
= "arm,versatile-fpga-irq", .data
= fpga_irq_of_init
, },
242 static void __init
intcp_init_irq_of(void)
245 of_irq_init(fpga_irq_of_match
);
249 * For the Device Tree, add in the UART, MMC and CLCD specifics as AUXDATA
250 * and enforce the bus names since these are used for clock lookups.
252 static struct of_dev_auxdata intcp_auxdata_lookup
[] __initdata
= {
253 OF_DEV_AUXDATA("arm,primecell", INTEGRATOR_RTC_BASE
,
255 OF_DEV_AUXDATA("arm,primecell", INTEGRATOR_UART0_BASE
,
257 OF_DEV_AUXDATA("arm,primecell", INTEGRATOR_UART1_BASE
,
259 OF_DEV_AUXDATA("arm,primecell", KMI0_BASE
,
261 OF_DEV_AUXDATA("arm,primecell", KMI1_BASE
,
263 OF_DEV_AUXDATA("arm,primecell", INTEGRATOR_CP_MMC_BASE
,
265 OF_DEV_AUXDATA("arm,primecell", INTEGRATOR_CP_AACI_BASE
,
267 OF_DEV_AUXDATA("arm,primecell", INTCP_PA_CLCD_BASE
,
269 OF_DEV_AUXDATA("cfi-flash", INTCP_PA_FLASH_BASE
,
270 "physmap-flash", &intcp_flash_data
),
274 static const struct of_device_id intcp_syscon_match
[] = {
275 { .compatible
= "arm,integrator-cp-syscon"},
279 static void __init
intcp_init_of(void)
281 struct device_node
*root
;
282 struct device_node
*cpcon
;
283 struct device
*parent
;
284 struct soc_device
*soc_dev
;
285 struct soc_device_attribute
*soc_dev_attr
;
289 /* Here we create an SoC device for the root node */
290 root
= of_find_node_by_path("/");
294 cpcon
= of_find_matching_node(root
, intcp_syscon_match
);
298 intcp_con_base
= of_iomap(cpcon
, 0);
302 intcp_sc_id
= readl(intcp_con_base
);
304 soc_dev_attr
= kzalloc(sizeof(*soc_dev_attr
), GFP_KERNEL
);
308 err
= of_property_read_string(root
, "compatible",
309 &soc_dev_attr
->soc_id
);
312 err
= of_property_read_string(root
, "model", &soc_dev_attr
->machine
);
315 soc_dev_attr
->family
= "Integrator";
316 soc_dev_attr
->revision
= kasprintf(GFP_KERNEL
, "%c",
317 'A' + (intcp_sc_id
& 0x0f));
319 soc_dev
= soc_device_register(soc_dev_attr
);
320 if (IS_ERR(soc_dev
)) {
321 kfree(soc_dev_attr
->revision
);
326 parent
= soc_device_to_device(soc_dev
);
327 integrator_init_sysfs(parent
, intcp_sc_id
);
328 of_platform_populate(root
, of_default_bus_match_table
,
329 intcp_auxdata_lookup
, parent
);
332 static const char * intcp_dt_board_compat
[] = {
337 DT_MACHINE_START(INTEGRATOR_CP_DT
, "ARM Integrator/CP (Device Tree)")
338 .reserve
= integrator_reserve
,
339 .map_io
= intcp_map_io
,
340 .init_early
= intcp_init_early
,
341 .init_irq
= intcp_init_irq_of
,
342 .handle_irq
= fpga_handle_irq
,
343 .init_machine
= intcp_init_of
,
344 .restart
= integrator_restart
,
345 .dt_compat
= intcp_dt_board_compat
,