2 * Copyright (C) 2007-2009 Michal Simek <monstr@monstr.eu>
3 * Copyright (C) 2007-2009 PetaLogix
4 * Copyright (C) 2006 Atmark Techno, Inc.
6 * This file is subject to the terms and conditions of the GNU General Public
7 * License. See the file "COPYING" in the main directory of this archive
11 #include <linux/init.h>
12 #include <linux/string.h>
13 #include <linux/seq_file.h>
14 #include <linux/cpu.h>
15 #include <linux/initrd.h>
16 #include <linux/console.h>
17 #include <linux/debugfs.h>
19 #include <asm/setup.h>
20 #include <asm/sections.h>
23 #include <linux/bug.h>
24 #include <linux/param.h>
25 #include <linux/cache.h>
26 #include <asm/cacheflush.h>
27 #include <asm/entry.h>
28 #include <asm/cpuinfo.h>
30 #include <asm/system.h>
32 #include <asm/pgtable.h>
34 DEFINE_PER_CPU(unsigned int, KSP
); /* Saved kernel stack pointer */
35 DEFINE_PER_CPU(unsigned int, KM
); /* Kernel/user mode */
36 DEFINE_PER_CPU(unsigned int, ENTRY_SP
); /* Saved SP on kernel entry */
37 DEFINE_PER_CPU(unsigned int, R11_SAVE
); /* Temp variable for entry */
38 DEFINE_PER_CPU(unsigned int, CURRENT_SAVE
); /* Saved current pointer */
40 unsigned int boot_cpuid
;
41 char cmd_line
[COMMAND_LINE_SIZE
];
43 void __init
setup_arch(char **cmdline_p
)
45 *cmdline_p
= cmd_line
;
49 unflatten_device_tree();
51 /* NOTE I think that this function is not necessary to call */
52 /* irq_early_init(); */
55 __invalidate_icache_all();
58 __invalidate_dcache_all();
65 #if defined(CONFIG_SELFMOD_INTC) || defined(CONFIG_SELFMOD_TIMER)
66 printk(KERN_NOTICE
"Self modified code enable\n");
70 #if defined(CONFIG_XILINX_CONSOLE)
71 conswitchp
= &xil_con
;
72 #elif defined(CONFIG_DUMMY_CONSOLE)
73 conswitchp
= &dummy_con
;
78 #ifdef CONFIG_MTD_UCLINUX
79 /* Handle both romfs and cramfs types, without generating unnecessary
80 code (ie no point checking for CRAMFS if it's not even enabled) */
81 inline unsigned get_romfs_len(unsigned *addr
)
83 #ifdef CONFIG_ROMFS_FS
84 if (memcmp(&addr
[0], "-rom1fs-", 8) == 0) /* romfs */
85 return be32_to_cpu(addr
[2]);
89 if (addr
[0] == le32_to_cpu(0x28cd3d45)) /* cramfs */
90 return le32_to_cpu(addr
[1]);
94 #endif /* CONFIG_MTD_UCLINUX_EBSS */
96 void __init
machine_early_init(const char *cmdline
, unsigned int ram
,
99 unsigned long *src
, *dst
= (unsigned long *)0x0;
101 /* clearing bss section */
102 memset(__bss_start
, 0, __bss_stop
-__bss_start
);
103 memset(_ssbss
, 0, _esbss
-_ssbss
);
105 /* Copy command line passed from bootloader */
106 #ifndef CONFIG_CMDLINE_BOOL
107 if (cmdline
&& cmdline
[0] != '\0')
108 strlcpy(cmd_line
, cmdline
, COMMAND_LINE_SIZE
);
111 /* initialize device tree for usage in early_printk */
112 early_init_devtree((void *)_fdt_start
);
114 #ifdef CONFIG_EARLY_PRINTK
115 setup_early_printk(NULL
);
118 early_printk("Ramdisk addr 0x%08x, FDT 0x%08x\n", ram
, fdt
);
119 printk(KERN_NOTICE
"Found FDT at 0x%08x\n", fdt
);
121 #ifdef CONFIG_MTD_UCLINUX
124 unsigned int romfs_base
;
125 romfs_base
= (ram
? ram
: (unsigned int)&__init_end
);
126 /* if CONFIG_MTD_UCLINUX_EBSS is defined, assume ROMFS is at the
127 * end of kernel, which is ROMFS_LOCATION defined above. */
128 size
= PAGE_ALIGN(get_romfs_len((unsigned *)romfs_base
));
129 early_printk("Found romfs @ 0x%08x (0x%08x)\n",
131 early_printk("#### klimit %p ####\n", klimit
);
132 BUG_ON(size
< 0); /* What else can we do? */
134 /* Use memmove to handle likely case of memory overlap */
135 early_printk("Moving 0x%08x bytes from 0x%08x to 0x%08x\n",
136 size
, romfs_base
, (unsigned)&_ebss
);
137 memmove(&_ebss
, (int *)romfs_base
, size
);
140 klimit
+= PAGE_ALIGN(size
);
141 early_printk("New klimit: 0x%08x\n", (unsigned)klimit
);
145 for (src
= __ivt_start
; src
< __ivt_end
; src
++, dst
++)
148 /* Initialize global data */
149 per_cpu(KM
, 0) = 0x1; /* We start in kernel mode */
150 per_cpu(CURRENT_SAVE
, 0) = (unsigned long)current
;
153 #ifdef CONFIG_DEBUG_FS
154 struct dentry
*of_debugfs_root
;
156 static int microblaze_debugfs_init(void)
158 of_debugfs_root
= debugfs_create_dir("microblaze", NULL
);
160 return of_debugfs_root
== NULL
;
162 arch_initcall(microblaze_debugfs_init
);
165 void machine_restart(char *cmd
)
167 printk(KERN_NOTICE
"Machine restart...\n");
173 void machine_shutdown(void)
175 printk(KERN_NOTICE
"Machine shutdown...\n");
180 void machine_halt(void)
182 printk(KERN_NOTICE
"Machine halt...\n");
187 void machine_power_off(void)
189 printk(KERN_NOTICE
"Machine power off...\n");