board_f.c 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright (c) 2011 The Chromium OS Authors.
  4. * (C) Copyright 2002-2006
  5. * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
  6. *
  7. * (C) Copyright 2002
  8. * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
  9. * Marius Groeger <mgroeger@sysgo.de>
  10. */
  11. #include <common.h>
  12. #include <console.h>
  13. #include <environment.h>
  14. #include <dm.h>
  15. #include <fdtdec.h>
  16. #include <fs.h>
  17. #include <i2c.h>
  18. #include <initcall.h>
  19. #include <malloc.h>
  20. #include <mapmem.h>
  21. #include <os.h>
  22. #include <post.h>
  23. #include <relocate.h>
  24. #include <spi.h>
  25. #include <status_led.h>
  26. #include <timer.h>
  27. #include <trace.h>
  28. #include <video.h>
  29. #include <watchdog.h>
  30. #ifdef CONFIG_MACH_TYPE
  31. #include <asm/mach-types.h>
  32. #endif
  33. #if defined(CONFIG_MP) && defined(CONFIG_PPC)
  34. #include <asm/mp.h>
  35. #endif
  36. #include <asm/io.h>
  37. #include <asm/sections.h>
  38. #include <dm/root.h>
  39. #include <linux/errno.h>
  40. /*
  41. * Pointer to initial global data area
  42. *
  43. * Here we initialize it if needed.
  44. */
  45. #ifdef XTRN_DECLARE_GLOBAL_DATA_PTR
  46. #undef XTRN_DECLARE_GLOBAL_DATA_PTR
  47. #define XTRN_DECLARE_GLOBAL_DATA_PTR /* empty = allocate here */
  48. DECLARE_GLOBAL_DATA_PTR = (gd_t *)(CONFIG_SYS_INIT_GD_ADDR);
  49. #else
  50. DECLARE_GLOBAL_DATA_PTR;
  51. #endif
  52. /*
  53. * TODO(sjg@chromium.org): IMO this code should be
  54. * refactored to a single function, something like:
  55. *
  56. * void led_set_state(enum led_colour_t colour, int on);
  57. */
  58. /************************************************************************
  59. * Coloured LED functionality
  60. ************************************************************************
  61. * May be supplied by boards if desired
  62. */
  63. __weak void coloured_LED_init(void) {}
  64. __weak void red_led_on(void) {}
  65. __weak void red_led_off(void) {}
  66. __weak void green_led_on(void) {}
  67. __weak void green_led_off(void) {}
  68. __weak void yellow_led_on(void) {}
  69. __weak void yellow_led_off(void) {}
  70. __weak void blue_led_on(void) {}
  71. __weak void blue_led_off(void) {}
  72. /*
  73. * Why is gd allocated a register? Prior to reloc it might be better to
  74. * just pass it around to each function in this file?
  75. *
  76. * After reloc one could argue that it is hardly used and doesn't need
  77. * to be in a register. Or if it is it should perhaps hold pointers to all
  78. * global data for all modules, so that post-reloc we can avoid the massive
  79. * literal pool we get on ARM. Or perhaps just encourage each module to use
  80. * a structure...
  81. */
  82. #if defined(CONFIG_WATCHDOG) || defined(CONFIG_HW_WATCHDOG)
  83. static int init_func_watchdog_init(void)
  84. {
  85. # if defined(CONFIG_HW_WATCHDOG) && \
  86. (defined(CONFIG_M68K) || defined(CONFIG_MICROBLAZE) || \
  87. defined(CONFIG_SH) || defined(CONFIG_AT91SAM9_WATCHDOG) || \
  88. defined(CONFIG_DESIGNWARE_WATCHDOG) || \
  89. defined(CONFIG_IMX_WATCHDOG))
  90. hw_watchdog_init();
  91. puts(" Watchdog enabled\n");
  92. # endif
  93. WATCHDOG_RESET();
  94. return 0;
  95. }
  96. int init_func_watchdog_reset(void)
  97. {
  98. WATCHDOG_RESET();
  99. return 0;
  100. }
  101. #endif /* CONFIG_WATCHDOG */
  102. __weak void board_add_ram_info(int use_default)
  103. {
  104. /* please define platform specific board_add_ram_info() */
  105. }
  106. static int init_baud_rate(void)
  107. {
  108. gd->baudrate = env_get_ulong("baudrate", 10, CONFIG_BAUDRATE);
  109. return 0;
  110. }
  111. static int display_text_info(void)
  112. {
  113. #if !defined(CONFIG_SANDBOX) && !defined(CONFIG_EFI_APP)
  114. ulong bss_start, bss_end, text_base;
  115. bss_start = (ulong)&__bss_start;
  116. bss_end = (ulong)&__bss_end;
  117. #ifdef CONFIG_SYS_TEXT_BASE
  118. text_base = CONFIG_SYS_TEXT_BASE;
  119. #else
  120. text_base = CONFIG_SYS_MONITOR_BASE;
  121. #endif
  122. debug("U-Boot code: %08lX -> %08lX BSS: -> %08lX\n",
  123. text_base, bss_start, bss_end);
  124. #endif
  125. return 0;
  126. }
  127. static int announce_dram_init(void)
  128. {
  129. puts("DRAM: ");
  130. return 0;
  131. }
  132. static int show_dram_config(void)
  133. {
  134. unsigned long long size;
  135. #ifdef CONFIG_NR_DRAM_BANKS
  136. int i;
  137. debug("\nRAM Configuration:\n");
  138. for (i = size = 0; i < CONFIG_NR_DRAM_BANKS; i++) {
  139. size += gd->bd->bi_dram[i].size;
  140. debug("Bank #%d: %llx ", i,
  141. (unsigned long long)(gd->bd->bi_dram[i].start));
  142. #ifdef DEBUG
  143. print_size(gd->bd->bi_dram[i].size, "\n");
  144. #endif
  145. }
  146. debug("\nDRAM: ");
  147. #else
  148. size = gd->ram_size;
  149. #endif
  150. print_size(size, "");
  151. board_add_ram_info(0);
  152. putc('\n');
  153. return 0;
  154. }
  155. __weak int dram_init_banksize(void)
  156. {
  157. #if defined(CONFIG_NR_DRAM_BANKS) && defined(CONFIG_SYS_SDRAM_BASE)
  158. gd->bd->bi_dram[0].start = CONFIG_SYS_SDRAM_BASE;
  159. gd->bd->bi_dram[0].size = get_effective_memsize();
  160. #endif
  161. return 0;
  162. }
  163. #if defined(CONFIG_SYS_I2C)
  164. static int init_func_i2c(void)
  165. {
  166. puts("I2C: ");
  167. #ifdef CONFIG_SYS_I2C
  168. i2c_init_all();
  169. #else
  170. i2c_init(CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE);
  171. #endif
  172. puts("ready\n");
  173. return 0;
  174. }
  175. #endif
  176. #if defined(CONFIG_VID)
  177. __weak int init_func_vid(void)
  178. {
  179. return 0;
  180. }
  181. #endif
  182. #if defined(CONFIG_HARD_SPI)
  183. static int init_func_spi(void)
  184. {
  185. puts("SPI: ");
  186. spi_init();
  187. puts("ready\n");
  188. return 0;
  189. }
  190. #endif
  191. static int setup_mon_len(void)
  192. {
  193. #if defined(__ARM__) || defined(__MICROBLAZE__)
  194. gd->mon_len = (ulong)&__bss_end - (ulong)_start;
  195. #elif defined(CONFIG_SANDBOX) || defined(CONFIG_EFI_APP)
  196. gd->mon_len = (ulong)&_end - (ulong)_init;
  197. #elif defined(CONFIG_NIOS2) || defined(CONFIG_XTENSA)
  198. gd->mon_len = CONFIG_SYS_MONITOR_LEN;
  199. #elif defined(CONFIG_NDS32) || defined(CONFIG_SH) || defined(CONFIG_RISCV)
  200. gd->mon_len = (ulong)(&__bss_end) - (ulong)(&_start);
  201. #elif defined(CONFIG_SYS_MONITOR_BASE)
  202. /* TODO: use (ulong)&__bss_end - (ulong)&__text_start; ? */
  203. gd->mon_len = (ulong)&__bss_end - CONFIG_SYS_MONITOR_BASE;
  204. #endif
  205. return 0;
  206. }
  207. __weak int arch_cpu_init(void)
  208. {
  209. return 0;
  210. }
  211. __weak int mach_cpu_init(void)
  212. {
  213. return 0;
  214. }
  215. /* Get the top of usable RAM */
  216. __weak ulong board_get_usable_ram_top(ulong total_size)
  217. {
  218. #ifdef CONFIG_SYS_SDRAM_BASE
  219. /*
  220. * Detect whether we have so much RAM that it goes past the end of our
  221. * 32-bit address space. If so, clip the usable RAM so it doesn't.
  222. */
  223. if (gd->ram_top < CONFIG_SYS_SDRAM_BASE)
  224. /*
  225. * Will wrap back to top of 32-bit space when reservations
  226. * are made.
  227. */
  228. return 0;
  229. #endif
  230. return gd->ram_top;
  231. }
  232. static int setup_dest_addr(void)
  233. {
  234. debug("Monitor len: %08lX\n", gd->mon_len);
  235. /*
  236. * Ram is setup, size stored in gd !!
  237. */
  238. debug("Ram size: %08lX\n", (ulong)gd->ram_size);
  239. #if defined(CONFIG_SYS_MEM_TOP_HIDE)
  240. /*
  241. * Subtract specified amount of memory to hide so that it won't
  242. * get "touched" at all by U-Boot. By fixing up gd->ram_size
  243. * the Linux kernel should now get passed the now "corrected"
  244. * memory size and won't touch it either. This should work
  245. * for arch/ppc and arch/powerpc. Only Linux board ports in
  246. * arch/powerpc with bootwrapper support, that recalculate the
  247. * memory size from the SDRAM controller setup will have to
  248. * get fixed.
  249. */
  250. gd->ram_size -= CONFIG_SYS_MEM_TOP_HIDE;
  251. #endif
  252. #ifdef CONFIG_SYS_SDRAM_BASE
  253. gd->ram_top = CONFIG_SYS_SDRAM_BASE;
  254. #endif
  255. gd->ram_top += get_effective_memsize();
  256. gd->ram_top = board_get_usable_ram_top(gd->mon_len);
  257. gd->relocaddr = gd->ram_top;
  258. debug("Ram top: %08lX\n", (ulong)gd->ram_top);
  259. #if defined(CONFIG_MP) && (defined(CONFIG_MPC86xx) || defined(CONFIG_E500))
  260. /*
  261. * We need to make sure the location we intend to put secondary core
  262. * boot code is reserved and not used by any part of u-boot
  263. */
  264. if (gd->relocaddr > determine_mp_bootpg(NULL)) {
  265. gd->relocaddr = determine_mp_bootpg(NULL);
  266. debug("Reserving MP boot page to %08lx\n", gd->relocaddr);
  267. }
  268. #endif
  269. return 0;
  270. }
  271. #ifdef CONFIG_PRAM
  272. /* reserve protected RAM */
  273. static int reserve_pram(void)
  274. {
  275. ulong reg;
  276. reg = env_get_ulong("pram", 10, CONFIG_PRAM);
  277. gd->relocaddr -= (reg << 10); /* size is in kB */
  278. debug("Reserving %ldk for protected RAM at %08lx\n", reg,
  279. gd->relocaddr);
  280. return 0;
  281. }
  282. #endif /* CONFIG_PRAM */
  283. /* Round memory pointer down to next 4 kB limit */
  284. static int reserve_round_4k(void)
  285. {
  286. gd->relocaddr &= ~(4096 - 1);
  287. return 0;
  288. }
  289. #ifdef CONFIG_ARM
  290. __weak int reserve_mmu(void)
  291. {
  292. #if !(defined(CONFIG_SYS_ICACHE_OFF) && defined(CONFIG_SYS_DCACHE_OFF))
  293. /* reserve TLB table */
  294. gd->arch.tlb_size = PGTABLE_SIZE;
  295. gd->relocaddr -= gd->arch.tlb_size;
  296. /* round down to next 64 kB limit */
  297. gd->relocaddr &= ~(0x10000 - 1);
  298. gd->arch.tlb_addr = gd->relocaddr;
  299. debug("TLB table from %08lx to %08lx\n", gd->arch.tlb_addr,
  300. gd->arch.tlb_addr + gd->arch.tlb_size);
  301. #ifdef CONFIG_SYS_MEM_RESERVE_SECURE
  302. /*
  303. * Record allocated tlb_addr in case gd->tlb_addr to be overwritten
  304. * with location within secure ram.
  305. */
  306. gd->arch.tlb_allocated = gd->arch.tlb_addr;
  307. #endif
  308. #endif
  309. return 0;
  310. }
  311. #endif
  312. static int reserve_video(void)
  313. {
  314. #ifdef CONFIG_DM_VIDEO
  315. ulong addr;
  316. int ret;
  317. addr = gd->relocaddr;
  318. ret = video_reserve(&addr);
  319. if (ret)
  320. return ret;
  321. gd->relocaddr = addr;
  322. #elif defined(CONFIG_LCD)
  323. # ifdef CONFIG_FB_ADDR
  324. gd->fb_base = CONFIG_FB_ADDR;
  325. # else
  326. /* reserve memory for LCD display (always full pages) */
  327. gd->relocaddr = lcd_setmem(gd->relocaddr);
  328. gd->fb_base = gd->relocaddr;
  329. # endif /* CONFIG_FB_ADDR */
  330. #elif defined(CONFIG_VIDEO) && \
  331. (!defined(CONFIG_PPC)) && \
  332. !defined(CONFIG_ARM) && !defined(CONFIG_X86) && \
  333. !defined(CONFIG_M68K)
  334. /* reserve memory for video display (always full pages) */
  335. gd->relocaddr = video_setmem(gd->relocaddr);
  336. gd->fb_base = gd->relocaddr;
  337. #endif
  338. return 0;
  339. }
  340. static int reserve_trace(void)
  341. {
  342. #ifdef CONFIG_TRACE
  343. gd->relocaddr -= CONFIG_TRACE_BUFFER_SIZE;
  344. gd->trace_buff = map_sysmem(gd->relocaddr, CONFIG_TRACE_BUFFER_SIZE);
  345. debug("Reserving %dk for trace data at: %08lx\n",
  346. CONFIG_TRACE_BUFFER_SIZE >> 10, gd->relocaddr);
  347. #endif
  348. return 0;
  349. }
  350. static int reserve_uboot(void)
  351. {
  352. if (!(gd->flags & GD_FLG_SKIP_RELOC)) {
  353. /*
  354. * reserve memory for U-Boot code, data & bss
  355. * round down to next 4 kB limit
  356. */
  357. gd->relocaddr -= gd->mon_len;
  358. gd->relocaddr &= ~(4096 - 1);
  359. #if defined(CONFIG_E500) || defined(CONFIG_MIPS)
  360. /* round down to next 64 kB limit so that IVPR stays aligned */
  361. gd->relocaddr &= ~(65536 - 1);
  362. #endif
  363. debug("Reserving %ldk for U-Boot at: %08lx\n",
  364. gd->mon_len >> 10, gd->relocaddr);
  365. }
  366. gd->start_addr_sp = gd->relocaddr;
  367. return 0;
  368. }
  369. /* reserve memory for malloc() area */
  370. static int reserve_malloc(void)
  371. {
  372. gd->start_addr_sp = gd->start_addr_sp - TOTAL_MALLOC_LEN;
  373. debug("Reserving %dk for malloc() at: %08lx\n",
  374. TOTAL_MALLOC_LEN >> 10, gd->start_addr_sp);
  375. return 0;
  376. }
  377. /* (permanently) allocate a Board Info struct */
  378. static int reserve_board(void)
  379. {
  380. if (!gd->bd) {
  381. gd->start_addr_sp -= sizeof(bd_t);
  382. gd->bd = (bd_t *)map_sysmem(gd->start_addr_sp, sizeof(bd_t));
  383. memset(gd->bd, '\0', sizeof(bd_t));
  384. debug("Reserving %zu Bytes for Board Info at: %08lx\n",
  385. sizeof(bd_t), gd->start_addr_sp);
  386. }
  387. return 0;
  388. }
  389. static int setup_machine(void)
  390. {
  391. #ifdef CONFIG_MACH_TYPE
  392. gd->bd->bi_arch_number = CONFIG_MACH_TYPE; /* board id for Linux */
  393. #endif
  394. return 0;
  395. }
  396. static int reserve_global_data(void)
  397. {
  398. gd->start_addr_sp -= sizeof(gd_t);
  399. gd->new_gd = (gd_t *)map_sysmem(gd->start_addr_sp, sizeof(gd_t));
  400. debug("Reserving %zu Bytes for Global Data at: %08lx\n",
  401. sizeof(gd_t), gd->start_addr_sp);
  402. return 0;
  403. }
  404. static int reserve_fdt(void)
  405. {
  406. #ifndef CONFIG_OF_EMBED
  407. /*
  408. * If the device tree is sitting immediately above our image then we
  409. * must relocate it. If it is embedded in the data section, then it
  410. * will be relocated with other data.
  411. */
  412. if (gd->fdt_blob) {
  413. gd->fdt_size = ALIGN(fdt_totalsize(gd->fdt_blob) + 0x1000, 32);
  414. gd->start_addr_sp -= gd->fdt_size;
  415. gd->new_fdt = map_sysmem(gd->start_addr_sp, gd->fdt_size);
  416. debug("Reserving %lu Bytes for FDT at: %08lx\n",
  417. gd->fdt_size, gd->start_addr_sp);
  418. }
  419. #endif
  420. return 0;
  421. }
  422. static int reserve_bootstage(void)
  423. {
  424. #ifdef CONFIG_BOOTSTAGE
  425. int size = bootstage_get_size();
  426. gd->start_addr_sp -= size;
  427. gd->new_bootstage = map_sysmem(gd->start_addr_sp, size);
  428. debug("Reserving %#x Bytes for bootstage at: %08lx\n", size,
  429. gd->start_addr_sp);
  430. #endif
  431. return 0;
  432. }
  433. __weak int arch_reserve_stacks(void)
  434. {
  435. return 0;
  436. }
  437. static int reserve_stacks(void)
  438. {
  439. /* make stack pointer 16-byte aligned */
  440. gd->start_addr_sp -= 16;
  441. gd->start_addr_sp &= ~0xf;
  442. /*
  443. * let the architecture-specific code tailor gd->start_addr_sp and
  444. * gd->irq_sp
  445. */
  446. return arch_reserve_stacks();
  447. }
  448. static int display_new_sp(void)
  449. {
  450. debug("New Stack Pointer is: %08lx\n", gd->start_addr_sp);
  451. return 0;
  452. }
  453. #if defined(CONFIG_M68K) || defined(CONFIG_MIPS) || defined(CONFIG_PPC) || \
  454. defined(CONFIG_SH)
  455. static int setup_board_part1(void)
  456. {
  457. bd_t *bd = gd->bd;
  458. /*
  459. * Save local variables to board info struct
  460. */
  461. bd->bi_memstart = CONFIG_SYS_SDRAM_BASE; /* start of memory */
  462. bd->bi_memsize = gd->ram_size; /* size in bytes */
  463. #ifdef CONFIG_SYS_SRAM_BASE
  464. bd->bi_sramstart = CONFIG_SYS_SRAM_BASE; /* start of SRAM */
  465. bd->bi_sramsize = CONFIG_SYS_SRAM_SIZE; /* size of SRAM */
  466. #endif
  467. #if defined(CONFIG_E500) || defined(CONFIG_MPC86xx)
  468. bd->bi_immr_base = CONFIG_SYS_IMMR; /* base of IMMR register */
  469. #endif
  470. #if defined(CONFIG_M68K)
  471. bd->bi_mbar_base = CONFIG_SYS_MBAR; /* base of internal registers */
  472. #endif
  473. #if defined(CONFIG_MPC83xx)
  474. bd->bi_immrbar = CONFIG_SYS_IMMR;
  475. #endif
  476. return 0;
  477. }
  478. #endif
  479. #if defined(CONFIG_PPC) || defined(CONFIG_M68K)
  480. static int setup_board_part2(void)
  481. {
  482. bd_t *bd = gd->bd;
  483. bd->bi_intfreq = gd->cpu_clk; /* Internal Freq, in Hz */
  484. bd->bi_busfreq = gd->bus_clk; /* Bus Freq, in Hz */
  485. #if defined(CONFIG_CPM2)
  486. bd->bi_cpmfreq = gd->arch.cpm_clk;
  487. bd->bi_brgfreq = gd->arch.brg_clk;
  488. bd->bi_sccfreq = gd->arch.scc_clk;
  489. bd->bi_vco = gd->arch.vco_out;
  490. #endif /* CONFIG_CPM2 */
  491. #if defined(CONFIG_M68K) && defined(CONFIG_PCI)
  492. bd->bi_pcifreq = gd->pci_clk;
  493. #endif
  494. #if defined(CONFIG_EXTRA_CLOCK)
  495. bd->bi_inpfreq = gd->arch.inp_clk; /* input Freq in Hz */
  496. bd->bi_vcofreq = gd->arch.vco_clk; /* vco Freq in Hz */
  497. bd->bi_flbfreq = gd->arch.flb_clk; /* flexbus Freq in Hz */
  498. #endif
  499. return 0;
  500. }
  501. #endif
  502. #ifdef CONFIG_POST
  503. static int init_post(void)
  504. {
  505. post_bootmode_init();
  506. post_run(NULL, POST_ROM | post_bootmode_get(0));
  507. return 0;
  508. }
  509. #endif
  510. static int reloc_fdt(void)
  511. {
  512. #ifndef CONFIG_OF_EMBED
  513. if (gd->flags & GD_FLG_SKIP_RELOC)
  514. return 0;
  515. if (gd->new_fdt) {
  516. memcpy(gd->new_fdt, gd->fdt_blob, gd->fdt_size);
  517. gd->fdt_blob = gd->new_fdt;
  518. }
  519. #endif
  520. return 0;
  521. }
  522. static int reloc_bootstage(void)
  523. {
  524. #ifdef CONFIG_BOOTSTAGE
  525. if (gd->flags & GD_FLG_SKIP_RELOC)
  526. return 0;
  527. if (gd->new_bootstage) {
  528. int size = bootstage_get_size();
  529. debug("Copying bootstage from %p to %p, size %x\n",
  530. gd->bootstage, gd->new_bootstage, size);
  531. memcpy(gd->new_bootstage, gd->bootstage, size);
  532. gd->bootstage = gd->new_bootstage;
  533. }
  534. #endif
  535. return 0;
  536. }
  537. static int setup_reloc(void)
  538. {
  539. if (gd->flags & GD_FLG_SKIP_RELOC) {
  540. debug("Skipping relocation due to flag\n");
  541. return 0;
  542. }
  543. #ifdef CONFIG_SYS_TEXT_BASE
  544. #ifdef ARM
  545. gd->reloc_off = gd->relocaddr - (unsigned long)__image_copy_start;
  546. #elif defined(CONFIG_M68K)
  547. /*
  548. * On all ColdFire arch cpu, monitor code starts always
  549. * just after the default vector table location, so at 0x400
  550. */
  551. gd->reloc_off = gd->relocaddr - (CONFIG_SYS_TEXT_BASE + 0x400);
  552. #else
  553. gd->reloc_off = gd->relocaddr - CONFIG_SYS_TEXT_BASE;
  554. #endif
  555. #endif
  556. memcpy(gd->new_gd, (char *)gd, sizeof(gd_t));
  557. debug("Relocation Offset is: %08lx\n", gd->reloc_off);
  558. debug("Relocating to %08lx, new gd at %08lx, sp at %08lx\n",
  559. gd->relocaddr, (ulong)map_to_sysmem(gd->new_gd),
  560. gd->start_addr_sp);
  561. return 0;
  562. }
  563. #ifdef CONFIG_OF_BOARD_FIXUP
  564. static int fix_fdt(void)
  565. {
  566. return board_fix_fdt((void *)gd->fdt_blob);
  567. }
  568. #endif
  569. /* ARM calls relocate_code from its crt0.S */
  570. #if !defined(CONFIG_ARM) && !defined(CONFIG_SANDBOX) && \
  571. !CONFIG_IS_ENABLED(X86_64)
  572. static int jump_to_copy(void)
  573. {
  574. if (gd->flags & GD_FLG_SKIP_RELOC)
  575. return 0;
  576. /*
  577. * x86 is special, but in a nice way. It uses a trampoline which
  578. * enables the dcache if possible.
  579. *
  580. * For now, other archs use relocate_code(), which is implemented
  581. * similarly for all archs. When we do generic relocation, hopefully
  582. * we can make all archs enable the dcache prior to relocation.
  583. */
  584. #if defined(CONFIG_X86) || defined(CONFIG_ARC)
  585. /*
  586. * SDRAM and console are now initialised. The final stack can now
  587. * be setup in SDRAM. Code execution will continue in Flash, but
  588. * with the stack in SDRAM and Global Data in temporary memory
  589. * (CPU cache)
  590. */
  591. arch_setup_gd(gd->new_gd);
  592. board_init_f_r_trampoline(gd->start_addr_sp);
  593. #else
  594. relocate_code(gd->start_addr_sp, gd->new_gd, gd->relocaddr);
  595. #endif
  596. return 0;
  597. }
  598. #endif
  599. /* Record the board_init_f() bootstage (after arch_cpu_init()) */
  600. static int initf_bootstage(void)
  601. {
  602. bool from_spl = IS_ENABLED(CONFIG_SPL_BOOTSTAGE) &&
  603. IS_ENABLED(CONFIG_BOOTSTAGE_STASH);
  604. int ret;
  605. ret = bootstage_init(!from_spl);
  606. if (ret)
  607. return ret;
  608. if (from_spl) {
  609. const void *stash = map_sysmem(CONFIG_BOOTSTAGE_STASH_ADDR,
  610. CONFIG_BOOTSTAGE_STASH_SIZE);
  611. ret = bootstage_unstash(stash, CONFIG_BOOTSTAGE_STASH_SIZE);
  612. if (ret && ret != -ENOENT) {
  613. debug("Failed to unstash bootstage: err=%d\n", ret);
  614. return ret;
  615. }
  616. }
  617. bootstage_mark_name(BOOTSTAGE_ID_START_UBOOT_F, "board_init_f");
  618. return 0;
  619. }
  620. static int initf_console_record(void)
  621. {
  622. #if defined(CONFIG_CONSOLE_RECORD) && CONFIG_VAL(SYS_MALLOC_F_LEN)
  623. return console_record_init();
  624. #else
  625. return 0;
  626. #endif
  627. }
  628. static int initf_dm(void)
  629. {
  630. #if defined(CONFIG_DM) && CONFIG_VAL(SYS_MALLOC_F_LEN)
  631. int ret;
  632. bootstage_start(BOOTSTATE_ID_ACCUM_DM_F, "dm_f");
  633. ret = dm_init_and_scan(true);
  634. bootstage_accum(BOOTSTATE_ID_ACCUM_DM_F);
  635. if (ret)
  636. return ret;
  637. #endif
  638. #ifdef CONFIG_TIMER_EARLY
  639. ret = dm_timer_init();
  640. if (ret)
  641. return ret;
  642. #endif
  643. return 0;
  644. }
  645. /* Architecture-specific memory reservation */
  646. __weak int reserve_arch(void)
  647. {
  648. return 0;
  649. }
  650. __weak int arch_cpu_init_dm(void)
  651. {
  652. return 0;
  653. }
  654. static const init_fnc_t init_sequence_f[] = {
  655. setup_mon_len,
  656. #ifdef CONFIG_OF_CONTROL
  657. fdtdec_setup,
  658. #endif
  659. #ifdef CONFIG_TRACE
  660. trace_early_init,
  661. #endif
  662. initf_malloc,
  663. log_init,
  664. initf_bootstage, /* uses its own timer, so does not need DM */
  665. initf_console_record,
  666. #if defined(CONFIG_HAVE_FSP)
  667. arch_fsp_init,
  668. #endif
  669. arch_cpu_init, /* basic arch cpu dependent setup */
  670. mach_cpu_init, /* SoC/machine dependent CPU setup */
  671. initf_dm,
  672. arch_cpu_init_dm,
  673. #if defined(CONFIG_BOARD_EARLY_INIT_F)
  674. board_early_init_f,
  675. #endif
  676. #if defined(CONFIG_PPC) || defined(CONFIG_SYS_FSL_CLK) || defined(CONFIG_M68K)
  677. /* get CPU and bus clocks according to the environment variable */
  678. get_clocks, /* get CPU and bus clocks (etc.) */
  679. #endif
  680. #if !defined(CONFIG_M68K)
  681. timer_init, /* initialize timer */
  682. #endif
  683. #if defined(CONFIG_BOARD_POSTCLK_INIT)
  684. board_postclk_init,
  685. #endif
  686. env_init, /* initialize environment */
  687. init_baud_rate, /* initialze baudrate settings */
  688. serial_init, /* serial communications setup */
  689. console_init_f, /* stage 1 init of console */
  690. display_options, /* say that we are here */
  691. display_text_info, /* show debugging info if required */
  692. #if defined(CONFIG_PPC) || defined(CONFIG_SH) || defined(CONFIG_X86)
  693. checkcpu,
  694. #endif
  695. #if defined(CONFIG_DISPLAY_CPUINFO)
  696. print_cpuinfo, /* display cpu info (and speed) */
  697. #endif
  698. #if defined(CONFIG_DTB_RESELECT)
  699. embedded_dtb_select,
  700. #endif
  701. #if defined(CONFIG_DISPLAY_BOARDINFO)
  702. show_board_info,
  703. #endif
  704. INIT_FUNC_WATCHDOG_INIT
  705. #if defined(CONFIG_MISC_INIT_F)
  706. misc_init_f,
  707. #endif
  708. INIT_FUNC_WATCHDOG_RESET
  709. #if defined(CONFIG_SYS_I2C)
  710. init_func_i2c,
  711. #endif
  712. #if defined(CONFIG_VID) && !defined(CONFIG_SPL)
  713. init_func_vid,
  714. #endif
  715. #if defined(CONFIG_HARD_SPI)
  716. init_func_spi,
  717. #endif
  718. announce_dram_init,
  719. dram_init, /* configure available RAM banks */
  720. #ifdef CONFIG_POST
  721. post_init_f,
  722. #endif
  723. INIT_FUNC_WATCHDOG_RESET
  724. #if defined(CONFIG_SYS_DRAM_TEST)
  725. testdram,
  726. #endif /* CONFIG_SYS_DRAM_TEST */
  727. INIT_FUNC_WATCHDOG_RESET
  728. #ifdef CONFIG_POST
  729. init_post,
  730. #endif
  731. INIT_FUNC_WATCHDOG_RESET
  732. /*
  733. * Now that we have DRAM mapped and working, we can
  734. * relocate the code and continue running from DRAM.
  735. *
  736. * Reserve memory at end of RAM for (top down in that order):
  737. * - area that won't get touched by U-Boot and Linux (optional)
  738. * - kernel log buffer
  739. * - protected RAM
  740. * - LCD framebuffer
  741. * - monitor code
  742. * - board info struct
  743. */
  744. setup_dest_addr,
  745. #ifdef CONFIG_PRAM
  746. reserve_pram,
  747. #endif
  748. reserve_round_4k,
  749. #ifdef CONFIG_ARM
  750. reserve_mmu,
  751. #endif
  752. reserve_video,
  753. reserve_trace,
  754. reserve_uboot,
  755. reserve_malloc,
  756. reserve_board,
  757. setup_machine,
  758. reserve_global_data,
  759. reserve_fdt,
  760. reserve_bootstage,
  761. reserve_arch,
  762. reserve_stacks,
  763. dram_init_banksize,
  764. show_dram_config,
  765. #if defined(CONFIG_M68K) || defined(CONFIG_MIPS) || defined(CONFIG_PPC) || \
  766. defined(CONFIG_SH)
  767. setup_board_part1,
  768. #endif
  769. #if defined(CONFIG_PPC) || defined(CONFIG_M68K)
  770. INIT_FUNC_WATCHDOG_RESET
  771. setup_board_part2,
  772. #endif
  773. display_new_sp,
  774. #ifdef CONFIG_OF_BOARD_FIXUP
  775. fix_fdt,
  776. #endif
  777. INIT_FUNC_WATCHDOG_RESET
  778. reloc_fdt,
  779. reloc_bootstage,
  780. setup_reloc,
  781. #if defined(CONFIG_X86) || defined(CONFIG_ARC)
  782. copy_uboot_to_ram,
  783. do_elf_reloc_fixups,
  784. clear_bss,
  785. #endif
  786. #if defined(CONFIG_XTENSA)
  787. clear_bss,
  788. #endif
  789. #if !defined(CONFIG_ARM) && !defined(CONFIG_SANDBOX) && \
  790. !CONFIG_IS_ENABLED(X86_64)
  791. jump_to_copy,
  792. #endif
  793. NULL,
  794. };
  795. void board_init_f(ulong boot_flags)
  796. {
  797. gd->flags = boot_flags;
  798. gd->have_console = 0;
  799. if (initcall_run_list(init_sequence_f))
  800. hang();
  801. #if !defined(CONFIG_ARM) && !defined(CONFIG_SANDBOX) && \
  802. !defined(CONFIG_EFI_APP) && !CONFIG_IS_ENABLED(X86_64) && \
  803. !defined(CONFIG_ARC)
  804. /* NOTREACHED - jump_to_copy() does not return */
  805. hang();
  806. #endif
  807. }
  808. #if defined(CONFIG_X86) || defined(CONFIG_ARC)
  809. /*
  810. * For now this code is only used on x86.
  811. *
  812. * init_sequence_f_r is the list of init functions which are run when
  813. * U-Boot is executing from Flash with a semi-limited 'C' environment.
  814. * The following limitations must be considered when implementing an
  815. * '_f_r' function:
  816. * - 'static' variables are read-only
  817. * - Global Data (gd->xxx) is read/write
  818. *
  819. * The '_f_r' sequence must, as a minimum, copy U-Boot to RAM (if
  820. * supported). It _should_, if possible, copy global data to RAM and
  821. * initialise the CPU caches (to speed up the relocation process)
  822. *
  823. * NOTE: At present only x86 uses this route, but it is intended that
  824. * all archs will move to this when generic relocation is implemented.
  825. */
  826. static const init_fnc_t init_sequence_f_r[] = {
  827. #if !CONFIG_IS_ENABLED(X86_64)
  828. init_cache_f_r,
  829. #endif
  830. NULL,
  831. };
  832. void board_init_f_r(void)
  833. {
  834. if (initcall_run_list(init_sequence_f_r))
  835. hang();
  836. /*
  837. * The pre-relocation drivers may be using memory that has now gone
  838. * away. Mark serial as unavailable - this will fall back to the debug
  839. * UART if available.
  840. *
  841. * Do the same with log drivers since the memory may not be available.
  842. */
  843. gd->flags &= ~(GD_FLG_SERIAL_READY | GD_FLG_LOG_READY);
  844. #ifdef CONFIG_TIMER
  845. gd->timer = NULL;
  846. #endif
  847. /*
  848. * U-Boot has been copied into SDRAM, the BSS has been cleared etc.
  849. * Transfer execution from Flash to RAM by calculating the address
  850. * of the in-RAM copy of board_init_r() and calling it
  851. */
  852. (board_init_r + gd->reloc_off)((gd_t *)gd, gd->relocaddr);
  853. /* NOTREACHED - board_init_r() does not return */
  854. hang();
  855. }
  856. #endif /* CONFIG_X86 */