1
2
3
4
5
6
7
8
9
10
11
12#include <common.h>
13#include <cpu_func.h>
14#include <mmc.h>
15#include <i2c.h>
16#include <serial.h>
17#include <spl.h>
18#include <asm/gpio.h>
19#include <asm/io.h>
20#include <asm/arch/clock.h>
21#include <asm/arch/gpio.h>
22#include <asm/arch/spl.h>
23#include <asm/arch/sys_proto.h>
24#include <asm/arch/timer.h>
25#include <asm/arch/tzpc.h>
26#include <asm/arch/mmc.h>
27
28#include <linux/compiler.h>
29
30struct fel_stash {
31 uint32_t sp;
32 uint32_t lr;
33 uint32_t cpsr;
34 uint32_t sctlr;
35 uint32_t vbar;
36 uint32_t cr;
37};
38
39struct fel_stash fel_stash __attribute__((section(".data")));
40
41#ifdef CONFIG_ARM64
42#include <asm/armv8/mmu.h>
43
44static struct mm_region sunxi_mem_map[] = {
45 {
46
47 .virt = 0x0UL,
48 .phys = 0x0UL,
49 .size = 0x40000000UL,
50 .attrs = PTE_BLOCK_MEMTYPE(MT_DEVICE_NGNRNE) |
51 PTE_BLOCK_NON_SHARE
52 }, {
53
54 .virt = 0x40000000UL,
55 .phys = 0x40000000UL,
56 .size = 0xC0000000UL,
57 .attrs = PTE_BLOCK_MEMTYPE(MT_NORMAL) |
58 PTE_BLOCK_INNER_SHARE
59 }, {
60
61 0,
62 }
63};
64struct mm_region *mem_map = sunxi_mem_map;
65#endif
66
67static int gpio_init(void)
68{
69 __maybe_unused uint val;
70#if CONFIG_CONS_INDEX == 1 && defined(CONFIG_UART0_PORT_F)
71#if defined(CONFIG_MACH_SUN4I) || \
72 defined(CONFIG_MACH_SUN7I) || \
73 defined(CONFIG_MACH_SUN8I_R40)
74
75 sunxi_gpio_set_cfgpin(SUNXI_GPB(22), SUNXI_GPIO_INPUT);
76 sunxi_gpio_set_cfgpin(SUNXI_GPB(23), SUNXI_GPIO_INPUT);
77#endif
78#if defined(CONFIG_MACH_SUN8I) && !defined(CONFIG_MACH_SUN8I_R40)
79 sunxi_gpio_set_cfgpin(SUNXI_GPF(2), SUN8I_GPF_UART0);
80 sunxi_gpio_set_cfgpin(SUNXI_GPF(4), SUN8I_GPF_UART0);
81#else
82 sunxi_gpio_set_cfgpin(SUNXI_GPF(2), SUNXI_GPF_UART0);
83 sunxi_gpio_set_cfgpin(SUNXI_GPF(4), SUNXI_GPF_UART0);
84#endif
85 sunxi_gpio_set_pull(SUNXI_GPF(4), 1);
86#elif CONFIG_CONS_INDEX == 1 && (defined(CONFIG_MACH_SUN4I) || \
87 defined(CONFIG_MACH_SUN7I) || \
88 defined(CONFIG_MACH_SUN8I_R40))
89 sunxi_gpio_set_cfgpin(SUNXI_GPB(22), SUN4I_GPB_UART0);
90 sunxi_gpio_set_cfgpin(SUNXI_GPB(23), SUN4I_GPB_UART0);
91 sunxi_gpio_set_pull(SUNXI_GPB(23), SUNXI_GPIO_PULL_UP);
92#elif CONFIG_CONS_INDEX == 1 && defined(CONFIG_MACH_SUN5I)
93 sunxi_gpio_set_cfgpin(SUNXI_GPB(19), SUN5I_GPB_UART0);
94 sunxi_gpio_set_cfgpin(SUNXI_GPB(20), SUN5I_GPB_UART0);
95 sunxi_gpio_set_pull(SUNXI_GPB(20), SUNXI_GPIO_PULL_UP);
96#elif CONFIG_CONS_INDEX == 1 && defined(CONFIG_MACH_SUN6I)
97 sunxi_gpio_set_cfgpin(SUNXI_GPH(20), SUN6I_GPH_UART0);
98 sunxi_gpio_set_cfgpin(SUNXI_GPH(21), SUN6I_GPH_UART0);
99 sunxi_gpio_set_pull(SUNXI_GPH(21), SUNXI_GPIO_PULL_UP);
100#elif CONFIG_CONS_INDEX == 1 && defined(CONFIG_MACH_SUN8I_A33)
101 sunxi_gpio_set_cfgpin(SUNXI_GPB(0), SUN8I_A33_GPB_UART0);
102 sunxi_gpio_set_cfgpin(SUNXI_GPB(1), SUN8I_A33_GPB_UART0);
103 sunxi_gpio_set_pull(SUNXI_GPB(1), SUNXI_GPIO_PULL_UP);
104#elif CONFIG_CONS_INDEX == 1 && defined(CONFIG_MACH_SUNXI_H3_H5)
105 sunxi_gpio_set_cfgpin(SUNXI_GPA(4), SUN8I_H3_GPA_UART0);
106 sunxi_gpio_set_cfgpin(SUNXI_GPA(5), SUN8I_H3_GPA_UART0);
107 sunxi_gpio_set_pull(SUNXI_GPA(5), SUNXI_GPIO_PULL_UP);
108#elif CONFIG_CONS_INDEX == 1 && defined(CONFIG_MACH_SUN50I)
109 sunxi_gpio_set_cfgpin(SUNXI_GPB(8), SUN50I_GPB_UART0);
110 sunxi_gpio_set_cfgpin(SUNXI_GPB(9), SUN50I_GPB_UART0);
111 sunxi_gpio_set_pull(SUNXI_GPB(9), SUNXI_GPIO_PULL_UP);
112#elif CONFIG_CONS_INDEX == 1 && defined(CONFIG_MACH_SUN50I_H6)
113 sunxi_gpio_set_cfgpin(SUNXI_GPH(0), SUN50I_H6_GPH_UART0);
114 sunxi_gpio_set_cfgpin(SUNXI_GPH(1), SUN50I_H6_GPH_UART0);
115 sunxi_gpio_set_pull(SUNXI_GPH(1), SUNXI_GPIO_PULL_UP);
116#elif CONFIG_CONS_INDEX == 1 && defined(CONFIG_MACH_SUN8I_A83T)
117 sunxi_gpio_set_cfgpin(SUNXI_GPB(9), SUN8I_A83T_GPB_UART0);
118 sunxi_gpio_set_cfgpin(SUNXI_GPB(10), SUN8I_A83T_GPB_UART0);
119 sunxi_gpio_set_pull(SUNXI_GPB(10), SUNXI_GPIO_PULL_UP);
120#elif CONFIG_CONS_INDEX == 1 && defined(CONFIG_MACH_SUN8I_V3S)
121 sunxi_gpio_set_cfgpin(SUNXI_GPB(8), SUN8I_V3S_GPB_UART0);
122 sunxi_gpio_set_cfgpin(SUNXI_GPB(9), SUN8I_V3S_GPB_UART0);
123 sunxi_gpio_set_pull(SUNXI_GPB(9), SUNXI_GPIO_PULL_UP);
124#elif CONFIG_CONS_INDEX == 1 && defined(CONFIG_MACH_SUN9I)
125 sunxi_gpio_set_cfgpin(SUNXI_GPH(12), SUN9I_GPH_UART0);
126 sunxi_gpio_set_cfgpin(SUNXI_GPH(13), SUN9I_GPH_UART0);
127 sunxi_gpio_set_pull(SUNXI_GPH(13), SUNXI_GPIO_PULL_UP);
128#elif CONFIG_CONS_INDEX == 2 && defined(CONFIG_MACH_SUN5I)
129 sunxi_gpio_set_cfgpin(SUNXI_GPG(3), SUN5I_GPG_UART1);
130 sunxi_gpio_set_cfgpin(SUNXI_GPG(4), SUN5I_GPG_UART1);
131 sunxi_gpio_set_pull(SUNXI_GPG(4), SUNXI_GPIO_PULL_UP);
132#elif CONFIG_CONS_INDEX == 3 && defined(CONFIG_MACH_SUN8I)
133 sunxi_gpio_set_cfgpin(SUNXI_GPB(0), SUN8I_GPB_UART2);
134 sunxi_gpio_set_cfgpin(SUNXI_GPB(1), SUN8I_GPB_UART2);
135 sunxi_gpio_set_pull(SUNXI_GPB(1), SUNXI_GPIO_PULL_UP);
136#elif CONFIG_CONS_INDEX == 5 && defined(CONFIG_MACH_SUN8I)
137 sunxi_gpio_set_cfgpin(SUNXI_GPL(2), SUN8I_GPL_R_UART);
138 sunxi_gpio_set_cfgpin(SUNXI_GPL(3), SUN8I_GPL_R_UART);
139 sunxi_gpio_set_pull(SUNXI_GPL(3), SUNXI_GPIO_PULL_UP);
140#else
141#error Unsupported console port number. Please fix pin mux settings in board.c
142#endif
143
144#ifdef CONFIG_MACH_SUN50I_H6
145
146 val = readl(SUNXI_PIO_BASE + SUN50I_H6_GPIO_POW_MOD_VAL);
147 writel(val, SUNXI_PIO_BASE + SUN50I_H6_GPIO_POW_MOD_SEL);
148 val = readl(SUNXI_R_PIO_BASE + SUN50I_H6_GPIO_POW_MOD_VAL);
149 writel(val, SUNXI_R_PIO_BASE + SUN50I_H6_GPIO_POW_MOD_SEL);
150#endif
151
152 return 0;
153}
154
155#if defined(CONFIG_SPL_BOARD_LOAD_IMAGE) && defined(CONFIG_SPL_BUILD)
156static int spl_board_load_image(struct spl_image_info *spl_image,
157 struct spl_boot_device *bootdev)
158{
159 debug("Returning to FEL sp=%x, lr=%x\n", fel_stash.sp, fel_stash.lr);
160 return_to_fel(fel_stash.sp, fel_stash.lr);
161
162 return 0;
163}
164SPL_LOAD_IMAGE_METHOD("FEL", 0, BOOT_DEVICE_BOARD, spl_board_load_image);
165#endif
166
167void s_init(void)
168{
169
170
171
172
173
174#if defined CONFIG_MACH_SUN6I
175 setbits_le32(SUNXI_SRAMC_BASE + 0x44, 0x1800);
176#elif defined CONFIG_MACH_SUN8I
177 __maybe_unused uint version;
178
179
180 setbits_le32(SUNXI_SRAMC_BASE + 0x24, (1 << 15));
181 version = readl(SUNXI_SRAMC_BASE + 0x24) >> 16;
182 clrbits_le32(SUNXI_SRAMC_BASE + 0x24, (1 << 15));
183
184
185
186
187
188
189#if defined CONFIG_MACH_SUN8I_A23
190 if (version == 0x1650)
191 setbits_le32(SUNXI_SRAMC_BASE + 0x44, 0x1800);
192 else
193 setbits_le32(SUNXI_SRAMC_BASE + 0x44, 0xc0);
194#elif defined CONFIG_MACH_SUN8I_A33
195 if (version != 0x1667)
196 setbits_le32(SUNXI_SRAMC_BASE + 0x44, 0xc0);
197#endif
198
199
200#endif
201
202#if !defined(CONFIG_ARM_CORTEX_CPU_IS_UP) && !defined(CONFIG_ARM64)
203
204 asm volatile(
205 "mrc p15, 0, r0, c1, c0, 1\n"
206 "orr r0, r0, #1 << 6\n"
207 "mcr p15, 0, r0, c1, c0, 1\n"
208 ::: "r0");
209#endif
210#if defined CONFIG_MACH_SUN6I || defined CONFIG_MACH_SUN8I_H3
211
212 tzpc_init();
213#endif
214
215 clock_init();
216 timer_init();
217 gpio_init();
218#ifndef CONFIG_DM_I2C
219 i2c_init_board();
220#endif
221 eth_init_board();
222}
223
224
225
226
227uint32_t sunxi_get_boot_device(void)
228{
229 int boot_source;
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247 if (!is_boot0_magic(SPL_ADDR + 4))
248 return BOOT_DEVICE_BOARD;
249
250 boot_source = readb(SPL_ADDR + 0x28);
251 switch (boot_source) {
252 case SUNXI_BOOTED_FROM_MMC0:
253 case SUNXI_BOOTED_FROM_MMC0_HIGH:
254 return BOOT_DEVICE_MMC1;
255 case SUNXI_BOOTED_FROM_NAND:
256 return BOOT_DEVICE_NAND;
257 case SUNXI_BOOTED_FROM_MMC2:
258 case SUNXI_BOOTED_FROM_MMC2_HIGH:
259 return BOOT_DEVICE_MMC2;
260 case SUNXI_BOOTED_FROM_SPI:
261 return BOOT_DEVICE_SPI;
262 }
263
264 panic("Unknown boot source %d\n", boot_source);
265 return -1;
266}
267
268#ifdef CONFIG_SPL_BUILD
269u32 spl_boot_device(void)
270{
271 return sunxi_get_boot_device();
272}
273
274void board_init_f(ulong dummy)
275{
276 spl_init();
277 preloader_console_init();
278
279#ifdef CONFIG_SPL_I2C_SUPPORT
280
281 i2c_init(CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE);
282#endif
283 sunxi_board_init();
284}
285#endif
286
287void reset_cpu(ulong addr)
288{
289#if defined(CONFIG_SUNXI_GEN_SUN4I) || defined(CONFIG_MACH_SUN8I_R40)
290 static const struct sunxi_wdog *wdog =
291 &((struct sunxi_timer_reg *)SUNXI_TIMER_BASE)->wdog;
292
293
294 writel(WDT_MODE_RESET_EN | WDT_MODE_EN, &wdog->mode);
295 writel(WDT_CTRL_KEY | WDT_CTRL_RESTART, &wdog->ctl);
296
297 while (1) {
298
299 writel(WDT_MODE_RESET_EN | WDT_MODE_EN, &wdog->mode);
300 }
301#elif defined(CONFIG_SUNXI_GEN_SUN6I) || defined(CONFIG_MACH_SUN50I_H6)
302#if defined(CONFIG_MACH_SUN50I_H6)
303
304 static const struct sunxi_wdog *wdog =
305 (struct sunxi_wdog *)SUNXI_R_WDOG_BASE;
306#else
307 static const struct sunxi_wdog *wdog =
308 ((struct sunxi_timer_reg *)SUNXI_TIMER_BASE)->wdog;
309#endif
310
311 writel(WDT_CFG_RESET, &wdog->cfg);
312 writel(WDT_MODE_EN, &wdog->mode);
313 writel(WDT_CTRL_KEY | WDT_CTRL_RESTART, &wdog->ctl);
314 while (1) { }
315#endif
316}
317
318#if !CONFIG_IS_ENABLED(SYS_DCACHE_OFF) && !defined(CONFIG_ARM64)
319void enable_caches(void)
320{
321
322 dcache_enable();
323}
324#endif
325