2 * Copyright (C) 2009 Extreme Engineering Solutions, Inc.
4 * X-ES board-specific functionality
6 * Based on mpc85xx_ds code from Freescale Semiconductor, Inc.
8 * Author: Nate Case <ncase@xes-inc.com>
10 * This 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.
15 #include <linux/stddef.h>
16 #include <linux/kernel.h>
17 #include <linux/pci.h>
18 #include <linux/kdev_t.h>
19 #include <linux/delay.h>
20 #include <linux/seq_file.h>
21 #include <linux/interrupt.h>
22 #include <linux/of_platform.h>
24 #include <asm/system.h>
26 #include <asm/machdep.h>
27 #include <asm/pci-bridge.h>
28 #include <mm/mmu_decl.h>
33 #include <sysdev/fsl_soc.h>
34 #include <sysdev/fsl_pci.h>
36 /* A few bit definitions needed for fixups on some boards */
37 #define MPC85xx_L2CTL_L2E 0x80000000 /* L2 enable */
38 #define MPC85xx_L2CTL_L2I 0x40000000 /* L2 flash invalidate */
39 #define MPC85xx_L2CTL_L2SIZ_MASK 0x30000000 /* L2 SRAM size (R/O) */
41 void __init
xes_mpc85xx_pic_init(void)
45 struct device_node
*np
;
47 np
= of_find_node_by_type(NULL
, "open-pic");
49 printk(KERN_ERR
"Could not find open-pic node\n");
53 if (of_address_to_resource(np
, 0, &r
)) {
54 printk(KERN_ERR
"Failed to map mpic register space\n");
59 mpic
= mpic_alloc(np
, r
.start
,
60 MPIC_PRIMARY
| MPIC_WANTS_RESET
|
61 MPIC_BIG_ENDIAN
| MPIC_BROKEN_FRR_NIRQS
,
69 static void xes_mpc85xx_configure_l2(void __iomem
*l2_base
)
71 volatile uint32_t ctl
, tmp
;
73 asm volatile("msync; isync");
74 tmp
= in_be32(l2_base
);
77 * xMon may have enabled part of L2 as SRAM, so we need to set it
78 * up for all cache mode just to be safe.
80 printk(KERN_INFO
"xes_mpc85xx: Enabling L2 as cache\n");
82 ctl
= MPC85xx_L2CTL_L2E
| MPC85xx_L2CTL_L2I
;
83 if (of_machine_is_compatible("MPC8540") ||
84 of_machine_is_compatible("MPC8560"))
86 * Assume L2 SRAM is used fully for cache, so set
87 * L2BLKSZ (bits 4:5) to match L2SIZ (bits 2:3).
89 ctl
|= (tmp
& MPC85xx_L2CTL_L2SIZ_MASK
) >> 2;
91 asm volatile("msync; isync");
92 out_be32(l2_base
, ctl
);
93 asm volatile("msync; isync");
96 static void xes_mpc85xx_fixups(void)
98 struct device_node
*np
;
102 * Legacy xMon firmware on some X-ES boards does not enable L2
103 * as cache. We must ensure that they get enabled here.
105 for_each_node_by_name(np
, "l2-cache-controller") {
106 struct resource r
[2];
107 void __iomem
*l2_base
;
109 /* Only MPC8548, MPC8540, and MPC8560 boards are affected */
110 if (!of_device_is_compatible(np
,
111 "fsl,mpc8548-l2-cache-controller") &&
112 !of_device_is_compatible(np
,
113 "fsl,mpc8540-l2-cache-controller") &&
114 !of_device_is_compatible(np
,
115 "fsl,mpc8560-l2-cache-controller"))
118 err
= of_address_to_resource(np
, 0, &r
[0]);
120 printk(KERN_WARNING
"xes_mpc85xx: Could not get "
121 "resource for device tree node '%s'",
126 l2_base
= ioremap(r
[0].start
, r
[0].end
- r
[0].start
+ 1);
128 xes_mpc85xx_configure_l2(l2_base
);
133 static int primary_phb_addr
;
137 * Setup the architecture
140 extern void __init
mpc85xx_smp_init(void);
142 static void __init
xes_mpc85xx_setup_arch(void)
145 struct device_node
*np
;
147 struct device_node
*root
;
148 const char *model
= "Unknown";
150 root
= of_find_node_by_path("/");
154 model
= of_get_property(root
, "model", NULL
);
156 printk(KERN_INFO
"X-ES MPC85xx-based single-board computer: %s\n",
157 model
+ strlen("xes,"));
159 xes_mpc85xx_fixups();
162 for_each_node_by_type(np
, "pci") {
163 if (of_device_is_compatible(np
, "fsl,mpc8540-pci") ||
164 of_device_is_compatible(np
, "fsl,mpc8548-pcie")) {
165 struct resource rsrc
;
166 of_address_to_resource(np
, 0, &rsrc
);
167 if ((rsrc
.start
& 0xfffff) == primary_phb_addr
)
168 fsl_add_bridge(np
, 1);
170 fsl_add_bridge(np
, 0);
180 static struct of_device_id __initdata xes_mpc85xx_ids
[] = {
182 { .compatible
= "soc", },
183 { .compatible
= "simple-bus", },
184 { .compatible
= "gianfar", },
188 static int __init
xes_mpc85xx_publish_devices(void)
190 return of_platform_bus_probe(NULL
, xes_mpc85xx_ids
, NULL
);
192 machine_device_initcall(xes_mpc8572
, xes_mpc85xx_publish_devices
);
193 machine_device_initcall(xes_mpc8548
, xes_mpc85xx_publish_devices
);
194 machine_device_initcall(xes_mpc8540
, xes_mpc85xx_publish_devices
);
197 * Called very early, device-tree isn't unflattened
199 static int __init
xes_mpc8572_probe(void)
201 unsigned long root
= of_get_flat_dt_root();
203 if (of_flat_dt_is_compatible(root
, "xes,MPC8572")) {
205 primary_phb_addr
= 0x8000;
213 static int __init
xes_mpc8548_probe(void)
215 unsigned long root
= of_get_flat_dt_root();
217 if (of_flat_dt_is_compatible(root
, "xes,MPC8548")) {
219 primary_phb_addr
= 0xb000;
227 static int __init
xes_mpc8540_probe(void)
229 unsigned long root
= of_get_flat_dt_root();
231 if (of_flat_dt_is_compatible(root
, "xes,MPC8540")) {
233 primary_phb_addr
= 0xb000;
241 define_machine(xes_mpc8572
) {
242 .name
= "X-ES MPC8572",
243 .probe
= xes_mpc8572_probe
,
244 .setup_arch
= xes_mpc85xx_setup_arch
,
245 .init_IRQ
= xes_mpc85xx_pic_init
,
247 .pcibios_fixup_bus
= fsl_pcibios_fixup_bus
,
249 .get_irq
= mpic_get_irq
,
250 .restart
= fsl_rstcr_restart
,
251 .calibrate_decr
= generic_calibrate_decr
,
252 .progress
= udbg_progress
,
255 define_machine(xes_mpc8548
) {
256 .name
= "X-ES MPC8548",
257 .probe
= xes_mpc8548_probe
,
258 .setup_arch
= xes_mpc85xx_setup_arch
,
259 .init_IRQ
= xes_mpc85xx_pic_init
,
261 .pcibios_fixup_bus
= fsl_pcibios_fixup_bus
,
263 .get_irq
= mpic_get_irq
,
264 .restart
= fsl_rstcr_restart
,
265 .calibrate_decr
= generic_calibrate_decr
,
266 .progress
= udbg_progress
,
269 define_machine(xes_mpc8540
) {
270 .name
= "X-ES MPC8540",
271 .probe
= xes_mpc8540_probe
,
272 .setup_arch
= xes_mpc85xx_setup_arch
,
273 .init_IRQ
= xes_mpc85xx_pic_init
,
275 .pcibios_fixup_bus
= fsl_pcibios_fixup_bus
,
277 .get_irq
= mpic_get_irq
,
278 .restart
= fsl_rstcr_restart
,
279 .calibrate_decr
= generic_calibrate_decr
,
280 .progress
= udbg_progress
,