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 <environment.h>
8 #include <asm/spl.h>
9 #include <malloc.h>
10 #include <ns16550.h>
11 #include <nand.h>
12 #include <i2c.h>
13 #include "../common/qixis.h"
14 #include "b4860qds_qixis.h"
15
16 DECLARE_GLOBAL_DATA_PTR;
17
get_effective_memsize(void)18 phys_size_t get_effective_memsize(void)
19 {
20 return CONFIG_SYS_L3_SIZE;
21 }
22
get_board_sys_clk(void)23 unsigned long get_board_sys_clk(void)
24 {
25 u8 sysclk_conf = QIXIS_READ(brdcfg[1]);
26
27 switch ((sysclk_conf & 0x0C) >> 2) {
28 case QIXIS_CLK_100:
29 return 100000000;
30 case QIXIS_CLK_125:
31 return 125000000;
32 case QIXIS_CLK_133:
33 return 133333333;
34 }
35 return 66666666;
36 }
37
get_board_ddr_clk(void)38 unsigned long get_board_ddr_clk(void)
39 {
40 u8 ddrclk_conf = QIXIS_READ(brdcfg[1]);
41
42 switch (ddrclk_conf & 0x03) {
43 case QIXIS_CLK_100:
44 return 100000000;
45 case QIXIS_CLK_125:
46 return 125000000;
47 case QIXIS_CLK_133:
48 return 133333333;
49 }
50 return 66666666;
51 }
52
board_init_f(ulong bootflag)53 void board_init_f(ulong bootflag)
54 {
55 u32 plat_ratio, sys_clk, uart_clk;
56 ccsr_gur_t *gur = (void *)CONFIG_SYS_MPC85xx_GUTS_ADDR;
57
58 /* Memcpy existing GD at CONFIG_SPL_GD_ADDR */
59 memcpy((void *)CONFIG_SPL_GD_ADDR, (void *)gd, sizeof(gd_t));
60
61 /* Update GD pointer */
62 gd = (gd_t *)(CONFIG_SPL_GD_ADDR);
63
64 /* compiler optimization barrier needed for GCC >= 3.4 */
65 __asm__ __volatile__("" : : : "memory");
66
67 console_init_f();
68
69 /* initialize selected port with appropriate baud rate */
70 sys_clk = get_board_sys_clk();
71 plat_ratio = (in_be32(&gur->rcwsr[0]) >> 25) & 0x1f;
72 uart_clk = sys_clk * plat_ratio / 2;
73
74 NS16550_init((NS16550_t)CONFIG_SYS_NS16550_COM1,
75 uart_clk / 16 / CONFIG_BAUDRATE);
76
77 relocate_code(CONFIG_SPL_RELOC_STACK, (gd_t *)CONFIG_SPL_GD_ADDR, 0x0);
78 }
79
board_init_r(gd_t * gd,ulong dest_addr)80 void board_init_r(gd_t *gd, ulong dest_addr)
81 {
82 bd_t *bd;
83
84 bd = (bd_t *)(gd + sizeof(gd_t));
85 memset(bd, 0, sizeof(bd_t));
86 gd->bd = bd;
87 bd->bi_memstart = CONFIG_SYS_INIT_L3_ADDR;
88 bd->bi_memsize = CONFIG_SYS_L3_SIZE;
89
90 arch_cpu_init();
91 get_clocks();
92 mem_malloc_init(CONFIG_SPL_RELOC_MALLOC_ADDR,
93 CONFIG_SPL_RELOC_MALLOC_SIZE);
94 gd->flags |= GD_FLG_FULL_MALLOC_INIT;
95
96 #ifndef CONFIG_SPL_NAND_BOOT
97 env_init();
98 env_relocate();
99 #else
100 /* relocate environment function pointers etc. */
101 nand_spl_load_image(CONFIG_ENV_OFFSET, CONFIG_ENV_SIZE,
102 (uchar *)CONFIG_ENV_ADDR);
103 gd->env_addr = (ulong)(CONFIG_ENV_ADDR);
104 gd->env_valid = ENV_VALID;
105 #endif
106
107 i2c_init_all();
108
109 puts("\n\n");
110
111 dram_init();
112
113 #ifdef CONFIG_SPL_NAND_BOOT
114 nand_boot();
115 #endif
116 }
117