]> git.kernelconcepts.de Git - karo-tx-uboot.git/blob - arch/arm/cpu/arm926ejs/mxs/spl_boot.c
karo: tx6: remove unreachable 'return' statements
[karo-tx-uboot.git] / arch / arm / cpu / arm926ejs / mxs / spl_boot.c
1 /*
2  * Freescale i.MX28 Boot setup
3  *
4  * Copyright (C) 2011 Marek Vasut <marek.vasut@gmail.com>
5  * on behalf of DENX Software Engineering GmbH
6  *
7  * SPDX-License-Identifier:     GPL-2.0+
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
20 DECLARE_GLOBAL_DATA_PTR;
21 static gd_t gdata __section(".data");
22 #ifdef CONFIG_SPL_SERIAL_SUPPORT
23 static bd_t bdata __section(".data");
24 #endif
25
26 /*
27  * This delay function is intended to be used only in early stage of boot, where
28  * clock are not set up yet. The timer used here is reset on every boot and
29  * takes a few seconds to roll. The boot doesn't take that long, so to keep the
30  * code simple, it doesn't take rolling into consideration.
31  */
32 /*
33  * There's nothing to be taken into consideration for the rollover.
34  * Two's complement arithmetic used correctly does all that's needed
35  * automagically.
36  */
37 void early_delay(int delay)
38 {
39         struct mxs_digctl_regs *digctl_regs =
40                 (struct mxs_digctl_regs *)MXS_DIGCTL_BASE;
41         u32 start = readl(&digctl_regs->hw_digctl_microseconds);
42
43         while (readl(&digctl_regs->hw_digctl_microseconds) - start < delay);
44 }
45
46 #define MUX_CONFIG_BOOTMODE_PAD (MXS_PAD_3V3 | MXS_PAD_4MA | MXS_PAD_NOPULL)
47 static const iomux_cfg_t iomux_boot[] = {
48 #if defined(CONFIG_SOC_MX23)
49         MX23_PAD_LCD_D00__GPIO_1_0 | MUX_CONFIG_BOOTMODE_PAD,
50         MX23_PAD_LCD_D01__GPIO_1_1 | MUX_CONFIG_BOOTMODE_PAD,
51         MX23_PAD_LCD_D02__GPIO_1_2 | MUX_CONFIG_BOOTMODE_PAD,
52         MX23_PAD_LCD_D03__GPIO_1_3 | MUX_CONFIG_BOOTMODE_PAD,
53         MX23_PAD_LCD_D04__GPIO_1_4 | MUX_CONFIG_BOOTMODE_PAD,
54         MX23_PAD_LCD_D05__GPIO_1_5 | MUX_CONFIG_BOOTMODE_PAD,
55 #endif
56 };
57
58 static uint8_t mxs_get_bootmode_index(void)
59 {
60         uint8_t bootmode = 0;
61         int i;
62         uint8_t masked;
63
64 #if defined(CONFIG_SOC_MX23)
65         /* Setup IOMUX of bootmode pads to GPIO */
66         mxs_iomux_setup_multiple_pads(iomux_boot, ARRAY_SIZE(iomux_boot));
67
68         /* Setup bootmode pins as GPIO input */
69         gpio_direction_input(MX23_PAD_LCD_D00__GPIO_1_0);
70         gpio_direction_input(MX23_PAD_LCD_D01__GPIO_1_1);
71         gpio_direction_input(MX23_PAD_LCD_D02__GPIO_1_2);
72         gpio_direction_input(MX23_PAD_LCD_D03__GPIO_1_3);
73         gpio_direction_input(MX23_PAD_LCD_D05__GPIO_1_5);
74
75         /* Read bootmode pads */
76         bootmode |= (gpio_get_value(MX23_PAD_LCD_D00__GPIO_1_0) ? 1 : 0) << 0;
77         bootmode |= (gpio_get_value(MX23_PAD_LCD_D01__GPIO_1_1) ? 1 : 0) << 1;
78         bootmode |= (gpio_get_value(MX23_PAD_LCD_D02__GPIO_1_2) ? 1 : 0) << 2;
79         bootmode |= (gpio_get_value(MX23_PAD_LCD_D03__GPIO_1_3) ? 1 : 0) << 3;
80         bootmode |= (gpio_get_value(MX23_PAD_LCD_D05__GPIO_1_5) ? 1 : 0) << 5;
81 #elif defined(CONFIG_SOC_MX28)
82         /* The global boot mode will be detected by ROM code and its value
83          * is stored at the fixed address 0x00019BF0 in OCRAM.
84          */
85 #define GLOBAL_BOOT_MODE_ADDR 0x00019BF0
86         bootmode = __raw_readl(GLOBAL_BOOT_MODE_ADDR);
87 #endif
88
89         for (i = 0; i < ARRAY_SIZE(mxs_boot_modes); i++) {
90                 masked = bootmode & mxs_boot_modes[i].boot_mask;
91                 if (masked == mxs_boot_modes[i].boot_pads)
92                         break;
93         }
94
95         return i;
96 }
97
98 static void mxs_spl_fixup_vectors(void)
99 {
100         /*
101          * Copy our vector table to 0x0, since due to HAB, we cannot
102          * be loaded to 0x0. We want to have working vectoring though,
103          * thus this fixup. Our vectoring table is PIC, so copying is
104          * fine.
105          */
106         extern uint32_t _start;
107
108         /* cppcheck-suppress nullPointer */
109         memcpy(0x0, &_start, 0x60);
110 }
111
112 static void mxs_spl_console_init(void)
113 {
114 #ifdef CONFIG_SPL_SERIAL_SUPPORT
115         gd->bd = &bdata;
116         gd->baudrate = CONFIG_BAUDRATE;
117         serial_init();
118         gd->have_console = 1;
119 #endif
120 }
121
122 void mxs_common_spl_init(const uint32_t arg, const uint32_t *resptr,
123                          const iomux_cfg_t *iomux_setup,
124                          const unsigned int iomux_size)
125 {
126         struct mxs_spl_data *data = (struct mxs_spl_data *)
127                 ((CONFIG_SYS_TEXT_BASE - sizeof(struct mxs_spl_data)) & ~0xf);
128         uint8_t bootmode = mxs_get_bootmode_index();
129         gd = &gdata;
130
131         mxs_spl_fixup_vectors();
132
133         mxs_iomux_setup_multiple_pads(iomux_setup, iomux_size);
134
135         mxs_spl_console_init();
136         debug("SPL: Serial Console Initialised\n");
137
138         mxs_power_init();
139
140         mxs_mem_init();
141         data->mem_dram_size = mxs_mem_get_size();
142
143         data->boot_mode_idx = bootmode;
144
145         mxs_power_wait_pswitch();
146
147         if (mxs_boot_modes[data->boot_mode_idx].boot_pads == MXS_BM_JTAG) {
148                 debug("SPL: Waiting for JTAG user\n");
149                 asm volatile ("x: b x");
150         }
151 }
152
153 /* Support apparatus */
154 inline void board_init_f(unsigned long bootflag)
155 {
156         for (;;)
157                 ;
158 }
159
160 inline void board_init_r(gd_t *id, ulong dest_addr)
161 {
162         for (;;)
163                 ;
164 }