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 void 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) 44 static 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 #elif defined(CONFIG_MX28) 53 MX28_PAD_LCD_D00__GPIO_1_0 | MUX_CONFIG_BOOTMODE_PAD, 54 MX28_PAD_LCD_D01__GPIO_1_1 | MUX_CONFIG_BOOTMODE_PAD, 55 MX28_PAD_LCD_D02__GPIO_1_2 | MUX_CONFIG_BOOTMODE_PAD, 56 MX28_PAD_LCD_D03__GPIO_1_3 | MUX_CONFIG_BOOTMODE_PAD, 57 MX28_PAD_LCD_D04__GPIO_1_4 | MUX_CONFIG_BOOTMODE_PAD, 58 MX28_PAD_LCD_D05__GPIO_1_5 | MUX_CONFIG_BOOTMODE_PAD, 59 #endif 60 }; 61 62 static uint8_t mxs_get_bootmode_index(void) 63 { 64 uint8_t bootmode = 0; 65 int i; 66 uint8_t masked; 67 68 /* Setup IOMUX of bootmode pads to GPIO */ 69 mxs_iomux_setup_multiple_pads(iomux_boot, ARRAY_SIZE(iomux_boot)); 70 71 #if defined(CONFIG_MX23) 72 /* Setup bootmode pins as GPIO input */ 73 gpio_direction_input(MX23_PAD_LCD_D00__GPIO_1_0); 74 gpio_direction_input(MX23_PAD_LCD_D01__GPIO_1_1); 75 gpio_direction_input(MX23_PAD_LCD_D02__GPIO_1_2); 76 gpio_direction_input(MX23_PAD_LCD_D03__GPIO_1_3); 77 gpio_direction_input(MX23_PAD_LCD_D05__GPIO_1_5); 78 79 /* Read bootmode pads */ 80 bootmode |= (gpio_get_value(MX23_PAD_LCD_D00__GPIO_1_0) ? 1 : 0) << 0; 81 bootmode |= (gpio_get_value(MX23_PAD_LCD_D01__GPIO_1_1) ? 1 : 0) << 1; 82 bootmode |= (gpio_get_value(MX23_PAD_LCD_D02__GPIO_1_2) ? 1 : 0) << 2; 83 bootmode |= (gpio_get_value(MX23_PAD_LCD_D03__GPIO_1_3) ? 1 : 0) << 3; 84 bootmode |= (gpio_get_value(MX23_PAD_LCD_D05__GPIO_1_5) ? 1 : 0) << 5; 85 #elif defined(CONFIG_MX28) 86 /* Setup bootmode pins as GPIO input */ 87 gpio_direction_input(MX28_PAD_LCD_D00__GPIO_1_0); 88 gpio_direction_input(MX28_PAD_LCD_D01__GPIO_1_1); 89 gpio_direction_input(MX28_PAD_LCD_D02__GPIO_1_2); 90 gpio_direction_input(MX28_PAD_LCD_D03__GPIO_1_3); 91 gpio_direction_input(MX28_PAD_LCD_D04__GPIO_1_4); 92 gpio_direction_input(MX28_PAD_LCD_D05__GPIO_1_5); 93 94 /* Read bootmode pads */ 95 bootmode |= (gpio_get_value(MX28_PAD_LCD_D00__GPIO_1_0) ? 1 : 0) << 0; 96 bootmode |= (gpio_get_value(MX28_PAD_LCD_D01__GPIO_1_1) ? 1 : 0) << 1; 97 bootmode |= (gpio_get_value(MX28_PAD_LCD_D02__GPIO_1_2) ? 1 : 0) << 2; 98 bootmode |= (gpio_get_value(MX28_PAD_LCD_D03__GPIO_1_3) ? 1 : 0) << 3; 99 bootmode |= (gpio_get_value(MX28_PAD_LCD_D04__GPIO_1_4) ? 1 : 0) << 4; 100 bootmode |= (gpio_get_value(MX28_PAD_LCD_D05__GPIO_1_5) ? 1 : 0) << 5; 101 #endif 102 103 for (i = 0; i < ARRAY_SIZE(mxs_boot_modes); i++) { 104 masked = bootmode & mxs_boot_modes[i].boot_mask; 105 if (masked == mxs_boot_modes[i].boot_pads) 106 break; 107 } 108 109 return i; 110 } 111 112 static void mxs_spl_fixup_vectors(void) 113 { 114 /* 115 * Copy our vector table to 0x0, since due to HAB, we cannot 116 * be loaded to 0x0. We want to have working vectoring though, 117 * thus this fixup. Our vectoring table is PIC, so copying is 118 * fine. 119 */ 120 extern uint32_t _start; 121 memcpy(0x0, &_start, 0x60); 122 } 123 124 static void mxs_spl_console_init(void) 125 { 126 #ifdef CONFIG_SPL_SERIAL_SUPPORT 127 gd->bd = &bdata; 128 gd->baudrate = CONFIG_BAUDRATE; 129 serial_init(); 130 gd->have_console = 1; 131 #endif 132 } 133 134 void mxs_common_spl_init(const uint32_t arg, const uint32_t *resptr, 135 const iomux_cfg_t *iomux_setup, 136 const unsigned int iomux_size) 137 { 138 struct mxs_spl_data *data = (struct mxs_spl_data *) 139 ((CONFIG_SYS_TEXT_BASE - sizeof(struct mxs_spl_data)) & ~0xf); 140 uint8_t bootmode = mxs_get_bootmode_index(); 141 gd = &gdata; 142 143 mxs_spl_fixup_vectors(); 144 145 mxs_iomux_setup_multiple_pads(iomux_setup, iomux_size); 146 147 mxs_spl_console_init(); 148 149 mxs_power_init(); 150 151 mxs_mem_init(); 152 data->mem_dram_size = mxs_mem_get_size(); 153 154 data->boot_mode_idx = bootmode; 155 156 mxs_power_wait_pswitch(); 157 } 158 159 /* Support aparatus */ 160 inline void board_init_f(unsigned long bootflag) 161 { 162 for (;;) 163 ; 164 } 165 166 inline void board_init_r(gd_t *id, ulong dest_addr) 167 { 168 for (;;) 169 ; 170 } 171