common: Move relocate_code() to init.h
[oweals/u-boot.git] / board / freescale / t104xrdb / spl.c
1 // SPDX-License-Identifier: GPL-2.0+
2 /* Copyright 2013 Freescale Semiconductor, Inc.
3  */
4
5 #include <common.h>
6 #include <console.h>
7 #include <env_internal.h>
8 #include <init.h>
9 #include <malloc.h>
10 #include <ns16550.h>
11 #include <nand.h>
12 #include <i2c.h>
13 #include <mmc.h>
14 #include <fsl_esdhc.h>
15 #include <spi_flash.h>
16 #include "../common/sleep.h"
17 #include "../common/spl.h"
18
19 DECLARE_GLOBAL_DATA_PTR;
20
21 phys_size_t get_effective_memsize(void)
22 {
23         return CONFIG_SYS_L3_SIZE;
24 }
25
26 unsigned long get_board_sys_clk(void)
27 {
28         return CONFIG_SYS_CLK_FREQ;
29 }
30
31 unsigned long get_board_ddr_clk(void)
32 {
33         return CONFIG_DDR_CLK_FREQ;
34 }
35
36 #define FSL_CORENET_CCSR_PORSR1_RCW_MASK        0xFF800000
37 void board_init_f(ulong bootflag)
38 {
39         u32 plat_ratio, sys_clk, uart_clk;
40 #if defined(CONFIG_SPL_NAND_BOOT) && defined(CONFIG_A008044_WORKAROUND)
41         u32 porsr1, pinctl;
42         u32 svr = get_svr();
43 #endif
44         ccsr_gur_t *gur = (void *)CONFIG_SYS_MPC85xx_GUTS_ADDR;
45
46 #if defined(CONFIG_SPL_NAND_BOOT) && defined(CONFIG_A008044_WORKAROUND)
47         if (IS_SVR_REV(svr, 1, 0)) {
48                 /*
49                  * There is T1040 SoC issue where NOR, FPGA are inaccessible
50                  * during NAND boot because IFC signals > IFC_AD7 are not
51                  * enabled. This workaround changes RCW source to make all
52                  * signals enabled.
53                  */
54                 porsr1 = in_be32(&gur->porsr1);
55                 pinctl = ((porsr1 & ~(FSL_CORENET_CCSR_PORSR1_RCW_MASK))
56                           | 0x24800000);
57                 out_be32((unsigned int *)(CONFIG_SYS_DCSRBAR + 0x20000),
58                          pinctl);
59         }
60 #endif
61
62         /* Memcpy existing GD at CONFIG_SPL_GD_ADDR */
63         memcpy((void *)CONFIG_SPL_GD_ADDR, (void *)gd, sizeof(gd_t));
64
65         /* Update GD pointer */
66         gd = (gd_t *)(CONFIG_SPL_GD_ADDR);
67
68 #ifdef CONFIG_DEEP_SLEEP
69         /* disable the console if boot from deep sleep */
70         if (is_warm_boot())
71                 fsl_dp_disable_console();
72 #endif
73         /* compiler optimization barrier needed for GCC >= 3.4 */
74         __asm__ __volatile__("" : : : "memory");
75
76         console_init_f();
77
78         /* initialize selected port with appropriate baud rate */
79         sys_clk = get_board_sys_clk();
80         plat_ratio = (in_be32(&gur->rcwsr[0]) >> 25) & 0x1f;
81         uart_clk = sys_clk * plat_ratio / 2;
82
83         NS16550_init((NS16550_t)CONFIG_SYS_NS16550_COM1,
84                      uart_clk / 16 / CONFIG_BAUDRATE);
85
86         relocate_code(CONFIG_SPL_RELOC_STACK, (gd_t *)CONFIG_SPL_GD_ADDR, 0x0);
87 }
88
89 void board_init_r(gd_t *gd, ulong dest_addr)
90 {
91         bd_t *bd;
92
93         bd = (bd_t *)(gd + sizeof(gd_t));
94         memset(bd, 0, sizeof(bd_t));
95         gd->bd = bd;
96         bd->bi_memstart = CONFIG_SYS_INIT_L3_ADDR;
97         bd->bi_memsize = CONFIG_SYS_L3_SIZE;
98
99         arch_cpu_init();
100         get_clocks();
101         mem_malloc_init(CONFIG_SPL_RELOC_MALLOC_ADDR,
102                         CONFIG_SPL_RELOC_MALLOC_SIZE);
103         gd->flags |= GD_FLG_FULL_MALLOC_INIT;
104
105 #ifdef CONFIG_SPL_MMC_BOOT
106         mmc_initialize(bd);
107 #endif
108
109         /* relocate environment function pointers etc. */
110 #if defined(CONFIG_ENV_IS_IN_NAND) || defined(CONFIG_ENV_IS_IN_MMC) || \
111         defined(CONFIG_ENV_IS_IN_SPI_FLASH)
112 #ifdef CONFIG_SPL_NAND_BOOT
113         nand_spl_load_image(CONFIG_ENV_OFFSET, CONFIG_ENV_SIZE,
114                             (uchar *)SPL_ENV_ADDR);
115 #endif
116 #ifdef CONFIG_SPL_MMC_BOOT
117         mmc_spl_load_image(CONFIG_ENV_OFFSET, CONFIG_ENV_SIZE,
118                            (uchar *)SPL_ENV_ADDR);
119 #endif
120 #ifdef CONFIG_SPL_SPI_BOOT
121         fsl_spi_spl_load_image(CONFIG_ENV_OFFSET, CONFIG_ENV_SIZE,
122                                (uchar *)SPL_ENV_ADDR);
123 #endif
124         gd->env_addr  = (ulong)(SPL_ENV_ADDR);
125         gd->env_valid = ENV_VALID;
126 #endif
127
128         i2c_init_all();
129
130         puts("\n\n");
131
132         dram_init();
133
134 #ifdef CONFIG_SPL_MMC_BOOT
135         mmc_boot();
136 #elif defined(CONFIG_SPL_SPI_BOOT)
137         fsl_spi_boot();
138 #elif defined(CONFIG_SPL_NAND_BOOT)
139         nand_boot();
140 #endif
141 }