1
2
3
4
5
6
7
8
9
10#include <common.h>
11#include <config.h>
12#include <asm/io.h>
13#include <asm/arch/imx-regs.h>
14#include <asm/arch/sys_proto.h>
15#include <asm/gpio.h>
16#include <linux/compiler.h>
17
18#include "mxs_init.h"
19
20DECLARE_GLOBAL_DATA_PTR;
21static gd_t gdata __section(".data");
22#ifdef CONFIG_SPL_SERIAL_SUPPORT
23static bd_t bdata __section(".data");
24#endif
25
26
27
28
29
30
31
32void early_delay(int delay)
33{
34 struct mxs_digctl_regs *digctl_regs =
35 (struct mxs_digctl_regs *)MXS_DIGCTL_BASE;
36
37 uint32_t st = readl(&digctl_regs->hw_digctl_microseconds);
38 st += delay;
39 while (st > readl(&digctl_regs->hw_digctl_microseconds))
40 ;
41}
42
43#define MUX_CONFIG_BOOTMODE_PAD (MXS_PAD_3V3 | MXS_PAD_4MA | MXS_PAD_NOPULL)
44static const iomux_cfg_t iomux_boot[] = {
45#if defined(CONFIG_MX23)
46 MX23_PAD_LCD_D00__GPIO_1_0 | MUX_CONFIG_BOOTMODE_PAD,
47 MX23_PAD_LCD_D01__GPIO_1_1 | MUX_CONFIG_BOOTMODE_PAD,
48 MX23_PAD_LCD_D02__GPIO_1_2 | MUX_CONFIG_BOOTMODE_PAD,
49 MX23_PAD_LCD_D03__GPIO_1_3 | MUX_CONFIG_BOOTMODE_PAD,
50 MX23_PAD_LCD_D04__GPIO_1_4 | MUX_CONFIG_BOOTMODE_PAD,
51 MX23_PAD_LCD_D05__GPIO_1_5 | MUX_CONFIG_BOOTMODE_PAD,
52#endif
53};
54
55static uint8_t mxs_get_bootmode_index(void)
56{
57 uint8_t bootmode = 0;
58 int i;
59 uint8_t masked;
60
61#if defined(CONFIG_MX23)
62
63 mxs_iomux_setup_multiple_pads(iomux_boot, ARRAY_SIZE(iomux_boot));
64
65
66 gpio_direction_input(MX23_PAD_LCD_D00__GPIO_1_0);
67 gpio_direction_input(MX23_PAD_LCD_D01__GPIO_1_1);
68 gpio_direction_input(MX23_PAD_LCD_D02__GPIO_1_2);
69 gpio_direction_input(MX23_PAD_LCD_D03__GPIO_1_3);
70 gpio_direction_input(MX23_PAD_LCD_D05__GPIO_1_5);
71
72
73 bootmode |= (gpio_get_value(MX23_PAD_LCD_D00__GPIO_1_0) ? 1 : 0) << 0;
74 bootmode |= (gpio_get_value(MX23_PAD_LCD_D01__GPIO_1_1) ? 1 : 0) << 1;
75 bootmode |= (gpio_get_value(MX23_PAD_LCD_D02__GPIO_1_2) ? 1 : 0) << 2;
76 bootmode |= (gpio_get_value(MX23_PAD_LCD_D03__GPIO_1_3) ? 1 : 0) << 3;
77 bootmode |= (gpio_get_value(MX23_PAD_LCD_D05__GPIO_1_5) ? 1 : 0) << 5;
78#elif defined(CONFIG_MX28)
79
80
81
82#define GLOBAL_BOOT_MODE_ADDR 0x00019BF0
83 bootmode = __raw_readl(GLOBAL_BOOT_MODE_ADDR);
84#endif
85
86 for (i = 0; i < ARRAY_SIZE(mxs_boot_modes); i++) {
87 masked = bootmode & mxs_boot_modes[i].boot_mask;
88 if (masked == mxs_boot_modes[i].boot_pads)
89 break;
90 }
91
92 return i;
93}
94
95static void mxs_spl_fixup_vectors(void)
96{
97
98
99
100
101
102
103 extern uint32_t _start;
104
105
106 memcpy(0x0, &_start, 0x60);
107}
108
109static void mxs_spl_console_init(void)
110{
111#ifdef CONFIG_SPL_SERIAL_SUPPORT
112 gd->bd = &bdata;
113 gd->baudrate = CONFIG_BAUDRATE;
114 serial_init();
115 gd->have_console = 1;
116#endif
117}
118
119void mxs_common_spl_init(const uint32_t arg, const uint32_t *resptr,
120 const iomux_cfg_t *iomux_setup,
121 const unsigned int iomux_size)
122{
123 struct mxs_spl_data *data = (struct mxs_spl_data *)
124 ((CONFIG_SYS_TEXT_BASE - sizeof(struct mxs_spl_data)) & ~0xf);
125 uint8_t bootmode = mxs_get_bootmode_index();
126 gd = &gdata;
127
128 mxs_spl_fixup_vectors();
129
130 mxs_iomux_setup_multiple_pads(iomux_setup, iomux_size);
131
132 mxs_spl_console_init();
133 debug("SPL: Serial Console Initialised\n");
134
135 mxs_power_init();
136
137 mxs_mem_init();
138 data->mem_dram_size = mxs_mem_get_size();
139
140 data->boot_mode_idx = bootmode;
141
142 mxs_power_wait_pswitch();
143
144 if (mxs_boot_modes[data->boot_mode_idx].boot_pads == MXS_BM_JTAG) {
145 debug("SPL: Waiting for JTAG user\n");
146 asm volatile ("x: b x");
147 }
148}
149
150
151inline void board_init_f(unsigned long bootflag)
152{
153 for (;;)
154 ;
155}
156
157inline void board_init_r(gd_t *id, ulong dest_addr)
158{
159 for (;;)
160 ;
161}
162