1 /* 2 * (C) Copyright 2008 Semihalf 3 * 4 * (C) Copyright 2000-2006 5 * Wolfgang Denk, DENX Software Engineering, wd@denx.de. 6 * 7 * See file CREDITS for list of people who contributed to this 8 * project. 9 * 10 * This program is free software; you can redistribute it and/or 11 * modify it under the terms of the GNU General Public License as 12 * published by the Free Software Foundation; either version 2 of 13 * the License, or (at your option) any later version. 14 * 15 * This program is distributed in the hope that it will be useful, 16 * but WITHOUT ANY WARRANTY; without even the implied warranty of 17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 18 * GNU General Public License for more details. 19 * 20 * You should have received a copy of the GNU General Public License 21 * along with this program; if not, write to the Free Software 22 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, 23 * MA 02111-1307 USA 24 */ 25 26 27 #include <common.h> 28 #include <watchdog.h> 29 #include <command.h> 30 #include <image.h> 31 #include <malloc.h> 32 #include <u-boot/zlib.h> 33 #include <bzlib.h> 34 #include <environment.h> 35 #include <asm/byteorder.h> 36 #include <asm/mp.h> 37 38 #if defined(CONFIG_OF_LIBFDT) 39 #include <fdt.h> 40 #include <libfdt.h> 41 #include <fdt_support.h> 42 43 #endif 44 45 #ifdef CONFIG_SYS_INIT_RAM_LOCK 46 #include <asm/cache.h> 47 #endif 48 49 DECLARE_GLOBAL_DATA_PTR; 50 51 extern ulong get_effective_memsize(void); 52 static ulong get_sp (void); 53 static void set_clocks_in_mhz (bd_t *kbd); 54 55 #ifndef CONFIG_SYS_LINUX_LOWMEM_MAX_SIZE 56 #define CONFIG_SYS_LINUX_LOWMEM_MAX_SIZE (768*1024*1024) 57 #endif 58 59 static void boot_jump_linux(bootm_headers_t *images) 60 { 61 void (*kernel)(bd_t *, ulong r4, ulong r5, ulong r6, 62 ulong r7, ulong r8, ulong r9); 63 #ifdef CONFIG_OF_LIBFDT 64 char *of_flat_tree = images->ft_addr; 65 #endif 66 67 kernel = (void (*)(bd_t *, ulong, ulong, ulong, 68 ulong, ulong, ulong))images->ep; 69 debug ("## Transferring control to Linux (at address %08lx) ...\n", 70 (ulong)kernel); 71 72 show_boot_progress (15); 73 74 #if defined(CONFIG_SYS_INIT_RAM_LOCK) && !defined(CONFIG_E500) 75 unlock_ram_in_cache(); 76 #endif 77 78 #if defined(CONFIG_OF_LIBFDT) 79 if (of_flat_tree) { /* device tree; boot new style */ 80 /* 81 * Linux Kernel Parameters (passing device tree): 82 * r3: pointer to the fdt 83 * r4: 0 84 * r5: 0 85 * r6: epapr magic 86 * r7: size of IMA in bytes 87 * r8: 0 88 * r9: 0 89 */ 90 #if defined(CONFIG_85xx) || defined(CONFIG_440) 91 #define EPAPR_MAGIC (0x45504150) 92 #else 93 #define EPAPR_MAGIC (0x65504150) 94 #endif 95 96 debug (" Booting using OF flat tree...\n"); 97 WATCHDOG_RESET (); 98 (*kernel) ((bd_t *)of_flat_tree, 0, 0, EPAPR_MAGIC, 99 CONFIG_SYS_BOOTMAPSZ, 0, 0); 100 /* does not return */ 101 } else 102 #endif 103 { 104 /* 105 * Linux Kernel Parameters (passing board info data): 106 * r3: ptr to board info data 107 * r4: initrd_start or 0 if no initrd 108 * r5: initrd_end - unused if r4 is 0 109 * r6: Start of command line string 110 * r7: End of command line string 111 * r8: 0 112 * r9: 0 113 */ 114 ulong cmd_start = images->cmdline_start; 115 ulong cmd_end = images->cmdline_end; 116 ulong initrd_start = images->initrd_start; 117 ulong initrd_end = images->initrd_end; 118 bd_t *kbd = images->kbd; 119 120 debug (" Booting using board info...\n"); 121 WATCHDOG_RESET (); 122 (*kernel) (kbd, initrd_start, initrd_end, 123 cmd_start, cmd_end, 0, 0); 124 /* does not return */ 125 } 126 return ; 127 } 128 129 void arch_lmb_reserve(struct lmb *lmb) 130 { 131 phys_size_t bootm_size; 132 ulong size, sp, bootmap_base; 133 134 bootmap_base = getenv_bootm_low(); 135 bootm_size = getenv_bootm_size(); 136 137 #ifdef DEBUG 138 if (((u64)bootmap_base + bootm_size) > 139 (CONFIG_SYS_SDRAM_BASE + (u64)gd->ram_size)) 140 puts("WARNING: bootm_low + bootm_size exceed total memory\n"); 141 if ((bootmap_base + bootm_size) > get_effective_memsize()) 142 puts("WARNING: bootm_low + bootm_size exceed eff. memory\n"); 143 #endif 144 145 size = min(bootm_size, get_effective_memsize()); 146 size = min(size, CONFIG_SYS_LINUX_LOWMEM_MAX_SIZE); 147 148 if (size < bootm_size) { 149 ulong base = bootmap_base + size; 150 printf("WARNING: adjusting available memory to %lx\n", size); 151 lmb_reserve(lmb, base, bootm_size - size); 152 } 153 154 /* 155 * Booting a (Linux) kernel image 156 * 157 * Allocate space for command line and board info - the 158 * address should be as high as possible within the reach of 159 * the kernel (see CONFIG_SYS_BOOTMAPSZ settings), but in unused 160 * memory, which means far enough below the current stack 161 * pointer. 162 */ 163 sp = get_sp(); 164 debug ("## Current stack ends at 0x%08lx\n", sp); 165 166 /* adjust sp by 4K to be safe */ 167 sp -= 4096; 168 lmb_reserve(lmb, sp, (CONFIG_SYS_SDRAM_BASE + get_effective_memsize() - sp)); 169 170 #ifdef CONFIG_MP 171 cpu_mp_lmb_reserve(lmb); 172 #endif 173 174 return ; 175 } 176 177 static void boot_prep_linux(void) 178 { 179 #ifdef CONFIG_MP 180 /* if we are MP make sure to flush the dcache() to any changes are made 181 * visibile to all other cores */ 182 flush_dcache(); 183 #endif 184 return ; 185 } 186 187 static int boot_cmdline_linux(bootm_headers_t *images) 188 { 189 ulong bootmap_base = getenv_bootm_low(); 190 ulong of_size = images->ft_len; 191 struct lmb *lmb = &images->lmb; 192 ulong *cmd_start = &images->cmdline_start; 193 ulong *cmd_end = &images->cmdline_end; 194 195 int ret = 0; 196 197 if (!of_size) { 198 /* allocate space and init command line */ 199 ret = boot_get_cmdline (lmb, cmd_start, cmd_end, bootmap_base); 200 if (ret) { 201 puts("ERROR with allocation of cmdline\n"); 202 return ret; 203 } 204 } 205 206 return ret; 207 } 208 209 static int boot_bd_t_linux(bootm_headers_t *images) 210 { 211 ulong bootmap_base = getenv_bootm_low(); 212 ulong of_size = images->ft_len; 213 struct lmb *lmb = &images->lmb; 214 bd_t **kbd = &images->kbd; 215 216 int ret = 0; 217 218 if (!of_size) { 219 /* allocate space for kernel copy of board info */ 220 ret = boot_get_kbd (lmb, kbd, bootmap_base); 221 if (ret) { 222 puts("ERROR with allocation of kernel bd\n"); 223 return ret; 224 } 225 set_clocks_in_mhz(*kbd); 226 } 227 228 return ret; 229 } 230 231 static int boot_body_linux(bootm_headers_t *images) 232 { 233 ulong rd_len; 234 struct lmb *lmb = &images->lmb; 235 ulong *initrd_start = &images->initrd_start; 236 ulong *initrd_end = &images->initrd_end; 237 #if defined(CONFIG_OF_LIBFDT) 238 ulong bootmap_base = getenv_bootm_low(); 239 ulong of_size = images->ft_len; 240 char **of_flat_tree = &images->ft_addr; 241 #endif 242 243 int ret; 244 245 /* allocate space and init command line */ 246 ret = boot_cmdline_linux(images); 247 if (ret) 248 return ret; 249 250 /* allocate space for kernel copy of board info */ 251 ret = boot_bd_t_linux(images); 252 if (ret) 253 return ret; 254 255 rd_len = images->rd_end - images->rd_start; 256 ret = boot_ramdisk_high (lmb, images->rd_start, rd_len, initrd_start, initrd_end); 257 if (ret) 258 return ret; 259 260 #if defined(CONFIG_OF_LIBFDT) && defined(CONFIG_SYS_BOOTMAPSZ) 261 ret = boot_relocate_fdt(lmb, bootmap_base, of_flat_tree, &of_size); 262 if (ret) 263 return ret; 264 265 /* 266 * Add the chosen node if it doesn't exist, add the env and bd_t 267 * if the user wants it (the logic is in the subroutines). 268 */ 269 if (of_size) { 270 if (fdt_chosen(*of_flat_tree, 1) < 0) { 271 puts ("ERROR: "); 272 puts ("/chosen node create failed"); 273 puts (" - must RESET the board to recover.\n"); 274 return -1; 275 } 276 #ifdef CONFIG_OF_BOARD_SETUP 277 /* Call the board-specific fixup routine */ 278 ft_board_setup(*of_flat_tree, gd->bd); 279 #endif 280 281 /* Delete the old LMB reservation */ 282 lmb_free(lmb, (phys_addr_t)(u32)*of_flat_tree, 283 (phys_size_t)fdt_totalsize(*of_flat_tree)); 284 285 ret = fdt_resize(*of_flat_tree); 286 if (ret < 0) 287 return ret; 288 of_size = ret; 289 290 if (*initrd_start && *initrd_end) 291 of_size += FDT_RAMDISK_OVERHEAD; 292 /* Create a new LMB reservation */ 293 lmb_reserve(lmb, (ulong)*of_flat_tree, of_size); 294 295 /* fixup the initrd now that we know where it should be */ 296 if (*initrd_start && *initrd_end) 297 fdt_initrd(*of_flat_tree, *initrd_start, *initrd_end, 1); 298 } 299 #endif /* CONFIG_OF_LIBFDT && CONFIG_SYS_BOOTMAPSZ */ 300 return 0; 301 } 302 303 __attribute__((noinline)) 304 int do_bootm_linux(int flag, int argc, char * const argv[], bootm_headers_t *images) 305 { 306 int ret; 307 308 if (flag & BOOTM_STATE_OS_CMDLINE) { 309 boot_cmdline_linux(images); 310 return 0; 311 } 312 313 if (flag & BOOTM_STATE_OS_BD_T) { 314 boot_bd_t_linux(images); 315 return 0; 316 } 317 318 if (flag & BOOTM_STATE_OS_PREP) { 319 boot_prep_linux(); 320 return 0; 321 } 322 323 if (flag & BOOTM_STATE_OS_GO) { 324 boot_jump_linux(images); 325 return 0; 326 } 327 328 boot_prep_linux(); 329 ret = boot_body_linux(images); 330 if (ret) 331 return ret; 332 boot_jump_linux(images); 333 334 return 0; 335 } 336 337 static ulong get_sp (void) 338 { 339 ulong sp; 340 341 asm( "mr %0,1": "=r"(sp) : ); 342 return sp; 343 } 344 345 static void set_clocks_in_mhz (bd_t *kbd) 346 { 347 char *s; 348 349 if ((s = getenv ("clocks_in_mhz")) != NULL) { 350 /* convert all clock information to MHz */ 351 kbd->bi_intfreq /= 1000000L; 352 kbd->bi_busfreq /= 1000000L; 353 #if defined(CONFIG_MPC8220) 354 kbd->bi_inpfreq /= 1000000L; 355 kbd->bi_pcifreq /= 1000000L; 356 kbd->bi_pevfreq /= 1000000L; 357 kbd->bi_flbfreq /= 1000000L; 358 kbd->bi_vcofreq /= 1000000L; 359 #endif 360 #if defined(CONFIG_CPM2) 361 kbd->bi_cpmfreq /= 1000000L; 362 kbd->bi_brgfreq /= 1000000L; 363 kbd->bi_sccfreq /= 1000000L; 364 kbd->bi_vco /= 1000000L; 365 #endif 366 #if defined(CONFIG_MPC5xxx) 367 kbd->bi_ipbfreq /= 1000000L; 368 kbd->bi_pcifreq /= 1000000L; 369 #endif /* CONFIG_MPC5xxx */ 370 } 371 } 372