Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 1 | /* Copyright (C) 2011 |
| 2 | * Corscience GmbH & Co. KG - Simon Schwarz <schwarz@corscience.de> |
| 3 | * - Added prep subcommand support |
| 4 | * - Reorganized source - modeled after powerpc version |
| 5 | * |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 6 | * (C) Copyright 2002 |
| 7 | * Sysgo Real-Time Solutions, GmbH <www.elinos.com> |
| 8 | * Marius Groeger <mgroeger@sysgo.de> |
| 9 | * |
| 10 | * Copyright (C) 2001 Erik Mouw (J.A.K.Mouw@its.tudelft.nl) |
| 11 | * |
Wolfgang Denk | d79de1d | 2013-07-08 09:37:19 +0200 | [diff] [blame] | 12 | * SPDX-License-Identifier: GPL-2.0+ |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 13 | */ |
| 14 | |
| 15 | #include <common.h> |
| 16 | #include <command.h> |
Simon Glass | 11c89f3 | 2017-05-17 17:18:03 -0600 | [diff] [blame] | 17 | #include <dm.h> |
Stefan Roese | 8ab5a1b | 2017-03-20 12:51:50 +0100 | [diff] [blame] | 18 | #include <dm/root.h> |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 19 | #include <image.h> |
Jean-Christophe PLAGNIOL-VILLARD | 6bb9449 | 2009-04-04 12:49:11 +0200 | [diff] [blame] | 20 | #include <u-boot/zlib.h> |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 21 | #include <asm/byteorder.h> |
John Rigby | ab51f1e | 2010-10-13 13:57:36 -0600 | [diff] [blame] | 22 | #include <libfdt.h> |
Joe Hershberger | 65b905b | 2015-03-22 17:08:59 -0500 | [diff] [blame] | 23 | #include <mapmem.h> |
John Rigby | ab51f1e | 2010-10-13 13:57:36 -0600 | [diff] [blame] | 24 | #include <fdt_support.h> |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 25 | #include <asm/bootm.h> |
Marc Zyngier | 855ca66 | 2014-07-12 14:24:03 +0100 | [diff] [blame] | 26 | #include <asm/secure.h> |
Pali Rohár | 5ebe4f1 | 2012-10-19 02:00:04 +0000 | [diff] [blame] | 27 | #include <linux/compiler.h> |
Eric Nelson | b7c236b | 2014-09-30 15:40:01 -0700 | [diff] [blame] | 28 | #include <bootm.h> |
| 29 | #include <vxworks.h> |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 30 | |
Jan Kiszka | ac31b5a | 2015-04-21 07:18:24 +0200 | [diff] [blame] | 31 | #ifdef CONFIG_ARMV7_NONSEC |
Andre Przywara | fe7d925 | 2013-09-19 18:06:43 +0200 | [diff] [blame] | 32 | #include <asm/armv7.h> |
| 33 | #endif |
Simon Glass | 30db774 | 2017-05-17 08:22:59 -0600 | [diff] [blame] | 34 | #include <asm/setup.h> |
Andre Przywara | fe7d925 | 2013-09-19 18:06:43 +0200 | [diff] [blame] | 35 | |
Wolfgang Denk | 6405a15 | 2006-03-31 18:32:53 +0200 | [diff] [blame] | 36 | DECLARE_GLOBAL_DATA_PTR; |
| 37 | |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 38 | static struct tag *params; |
John Rigby | ab51f1e | 2010-10-13 13:57:36 -0600 | [diff] [blame] | 39 | |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 40 | static ulong get_sp(void) |
| 41 | { |
| 42 | ulong ret; |
| 43 | |
| 44 | asm("mov %0, sp" : "=r"(ret) : ); |
| 45 | return ret; |
| 46 | } |
| 47 | |
John Rigby | ab51f1e | 2010-10-13 13:57:36 -0600 | [diff] [blame] | 48 | void arch_lmb_reserve(struct lmb *lmb) |
| 49 | { |
Stephen Warren | 1a0b805 | 2018-01-05 13:04:54 -0700 | [diff] [blame] | 50 | ulong sp, bank_end; |
| 51 | int bank; |
John Rigby | ab51f1e | 2010-10-13 13:57:36 -0600 | [diff] [blame] | 52 | |
| 53 | /* |
| 54 | * Booting a (Linux) kernel image |
| 55 | * |
| 56 | * Allocate space for command line and board info - the |
| 57 | * address should be as high as possible within the reach of |
| 58 | * the kernel (see CONFIG_SYS_BOOTMAPSZ settings), but in unused |
| 59 | * memory, which means far enough below the current stack |
| 60 | * pointer. |
| 61 | */ |
| 62 | sp = get_sp(); |
| 63 | debug("## Current stack ends at 0x%08lx ", sp); |
| 64 | |
Rob Herring | 13137f3 | 2012-06-28 03:54:11 +0000 | [diff] [blame] | 65 | /* adjust sp by 4K to be safe */ |
| 66 | sp -= 4096; |
Stephen Warren | 1a0b805 | 2018-01-05 13:04:54 -0700 | [diff] [blame] | 67 | for (bank = 0; bank < CONFIG_NR_DRAM_BANKS; bank++) { |
| 68 | if (sp < gd->bd->bi_dram[bank].start) |
| 69 | continue; |
| 70 | bank_end = gd->bd->bi_dram[bank].start + |
| 71 | gd->bd->bi_dram[bank].size; |
| 72 | if (sp >= bank_end) |
| 73 | continue; |
| 74 | lmb_reserve(lmb, sp, bank_end - sp); |
| 75 | break; |
| 76 | } |
John Rigby | ab51f1e | 2010-10-13 13:57:36 -0600 | [diff] [blame] | 77 | } |
| 78 | |
Alexander Graf | 2ebeb44 | 2016-11-17 01:02:57 +0100 | [diff] [blame] | 79 | __weak void board_quiesce_devices(void) |
| 80 | { |
| 81 | } |
| 82 | |
Simon Glass | 3c26c58 | 2013-06-19 21:15:10 -0700 | [diff] [blame] | 83 | /** |
| 84 | * announce_and_cleanup() - Print message and prepare for kernel boot |
| 85 | * |
| 86 | * @fake: non-zero to do everything except actually boot |
| 87 | */ |
| 88 | static void announce_and_cleanup(int fake) |
John Rigby | ab51f1e | 2010-10-13 13:57:36 -0600 | [diff] [blame] | 89 | { |
Simon Glass | 3c26c58 | 2013-06-19 21:15:10 -0700 | [diff] [blame] | 90 | printf("\nStarting kernel ...%s\n\n", fake ? |
| 91 | "(fake run for tracing)" : ""); |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 92 | bootstage_mark_name(BOOTSTAGE_ID_BOOTM_HANDOFF, "start_kernel"); |
Simon Glass | 0fa36a4 | 2012-09-28 08:56:37 +0000 | [diff] [blame] | 93 | #ifdef CONFIG_BOOTSTAGE_FDT |
Mela Custodio | 5625c8b | 2014-02-20 00:16:56 +0900 | [diff] [blame] | 94 | bootstage_fdt_add_report(); |
Simon Glass | 0fa36a4 | 2012-09-28 08:56:37 +0000 | [diff] [blame] | 95 | #endif |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 96 | #ifdef CONFIG_BOOTSTAGE_REPORT |
| 97 | bootstage_report(); |
| 98 | #endif |
Wolfgang Denk | 20ec367 | 2008-09-08 23:26:22 +0200 | [diff] [blame] | 99 | |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 100 | #ifdef CONFIG_USB_DEVICE |
| 101 | udc_disconnect(); |
John Rigby | ab51f1e | 2010-10-13 13:57:36 -0600 | [diff] [blame] | 102 | #endif |
Alexander Graf | 2ebeb44 | 2016-11-17 01:02:57 +0100 | [diff] [blame] | 103 | |
| 104 | board_quiesce_devices(); |
| 105 | |
Stefan Roese | 8ab5a1b | 2017-03-20 12:51:50 +0100 | [diff] [blame] | 106 | /* |
| 107 | * Call remove function of all devices with a removal flag set. |
| 108 | * This may be useful for last-stage operations, like cancelling |
| 109 | * of DMA operation or releasing device internal buffers. |
| 110 | */ |
| 111 | dm_remove_devices_flags(DM_REMOVE_ACTIVE_ALL); |
| 112 | |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 113 | cleanup_before_linux(); |
| 114 | } |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 115 | |
wdenk | 8676590 | 2003-12-06 23:55:10 +0000 | [diff] [blame] | 116 | static void setup_start_tag (bd_t *bd) |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 117 | { |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 118 | params = (struct tag *)bd->bi_boot_params; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 119 | |
wdenk | 8676590 | 2003-12-06 23:55:10 +0000 | [diff] [blame] | 120 | params->hdr.tag = ATAG_CORE; |
| 121 | params->hdr.size = tag_size (tag_core); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 122 | |
wdenk | 8676590 | 2003-12-06 23:55:10 +0000 | [diff] [blame] | 123 | params->u.core.flags = 0; |
| 124 | params->u.core.pagesize = 0; |
| 125 | params->u.core.rootdev = 0; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 126 | |
wdenk | 8676590 | 2003-12-06 23:55:10 +0000 | [diff] [blame] | 127 | params = tag_next (params); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 128 | } |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 129 | |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 130 | static void setup_memory_tags(bd_t *bd) |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 131 | { |
wdenk | 8676590 | 2003-12-06 23:55:10 +0000 | [diff] [blame] | 132 | int i; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 133 | |
wdenk | 8676590 | 2003-12-06 23:55:10 +0000 | [diff] [blame] | 134 | for (i = 0; i < CONFIG_NR_DRAM_BANKS; i++) { |
| 135 | params->hdr.tag = ATAG_MEM; |
| 136 | params->hdr.size = tag_size (tag_mem32); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 137 | |
wdenk | 8676590 | 2003-12-06 23:55:10 +0000 | [diff] [blame] | 138 | params->u.mem.start = bd->bi_dram[i].start; |
| 139 | params->u.mem.size = bd->bi_dram[i].size; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 140 | |
wdenk | 8676590 | 2003-12-06 23:55:10 +0000 | [diff] [blame] | 141 | params = tag_next (params); |
| 142 | } |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 143 | } |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 144 | |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 145 | static void setup_commandline_tag(bd_t *bd, char *commandline) |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 146 | { |
wdenk | 8676590 | 2003-12-06 23:55:10 +0000 | [diff] [blame] | 147 | char *p; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 148 | |
wdenk | f16b516 | 2004-03-23 21:43:07 +0000 | [diff] [blame] | 149 | if (!commandline) |
| 150 | return; |
| 151 | |
wdenk | 8676590 | 2003-12-06 23:55:10 +0000 | [diff] [blame] | 152 | /* eat leading white space */ |
| 153 | for (p = commandline; *p == ' '; p++); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 154 | |
wdenk | 8676590 | 2003-12-06 23:55:10 +0000 | [diff] [blame] | 155 | /* skip non-existent command lines so the kernel will still |
| 156 | * use its default command line. |
| 157 | */ |
| 158 | if (*p == '\0') |
| 159 | return; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 160 | |
wdenk | 8676590 | 2003-12-06 23:55:10 +0000 | [diff] [blame] | 161 | params->hdr.tag = ATAG_CMDLINE; |
| 162 | params->hdr.size = |
| 163 | (sizeof (struct tag_header) + strlen (p) + 1 + 4) >> 2; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 164 | |
wdenk | 8676590 | 2003-12-06 23:55:10 +0000 | [diff] [blame] | 165 | strcpy (params->u.cmdline.cmdline, p); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 166 | |
wdenk | 8676590 | 2003-12-06 23:55:10 +0000 | [diff] [blame] | 167 | params = tag_next (params); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 168 | } |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 169 | |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 170 | static void setup_initrd_tag(bd_t *bd, ulong initrd_start, ulong initrd_end) |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 171 | { |
wdenk | 8676590 | 2003-12-06 23:55:10 +0000 | [diff] [blame] | 172 | /* an ATAG_INITRD node tells the kernel where the compressed |
| 173 | * ramdisk can be found. ATAG_RDIMG is a better name, actually. |
| 174 | */ |
wdenk | 19c8fb7 | 2004-04-18 22:26:17 +0000 | [diff] [blame] | 175 | params->hdr.tag = ATAG_INITRD2; |
wdenk | 8676590 | 2003-12-06 23:55:10 +0000 | [diff] [blame] | 176 | params->hdr.size = tag_size (tag_initrd); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 177 | |
wdenk | 8676590 | 2003-12-06 23:55:10 +0000 | [diff] [blame] | 178 | params->u.initrd.start = initrd_start; |
| 179 | params->u.initrd.size = initrd_end - initrd_start; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 180 | |
wdenk | 8676590 | 2003-12-06 23:55:10 +0000 | [diff] [blame] | 181 | params = tag_next (params); |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 182 | } |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 183 | |
Simon Glass | 50ad221 | 2013-05-08 08:06:02 +0000 | [diff] [blame] | 184 | static void setup_serial_tag(struct tag **tmp) |
wdenk | a21ad7b | 2005-05-19 22:39:42 +0000 | [diff] [blame] | 185 | { |
| 186 | struct tag *params = *tmp; |
| 187 | struct tag_serialnr serialnr; |
wdenk | a21ad7b | 2005-05-19 22:39:42 +0000 | [diff] [blame] | 188 | |
| 189 | get_board_serial(&serialnr); |
| 190 | params->hdr.tag = ATAG_SERIAL; |
| 191 | params->hdr.size = tag_size (tag_serialnr); |
| 192 | params->u.serialnr.low = serialnr.low; |
| 193 | params->u.serialnr.high= serialnr.high; |
| 194 | params = tag_next (params); |
| 195 | *tmp = params; |
| 196 | } |
wdenk | a21ad7b | 2005-05-19 22:39:42 +0000 | [diff] [blame] | 197 | |
Simon Glass | 50ad221 | 2013-05-08 08:06:02 +0000 | [diff] [blame] | 198 | static void setup_revision_tag(struct tag **in_params) |
wdenk | cb99da5 | 2005-01-12 00:15:14 +0000 | [diff] [blame] | 199 | { |
| 200 | u32 rev = 0; |
wdenk | cb99da5 | 2005-01-12 00:15:14 +0000 | [diff] [blame] | 201 | |
| 202 | rev = get_board_rev(); |
wdenk | cb99da5 | 2005-01-12 00:15:14 +0000 | [diff] [blame] | 203 | params->hdr.tag = ATAG_REVISION; |
| 204 | params->hdr.size = tag_size (tag_revision); |
| 205 | params->u.revision.rev = rev; |
| 206 | params = tag_next (params); |
| 207 | } |
wdenk | cb99da5 | 2005-01-12 00:15:14 +0000 | [diff] [blame] | 208 | |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 209 | static void setup_end_tag(bd_t *bd) |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 210 | { |
wdenk | 8676590 | 2003-12-06 23:55:10 +0000 | [diff] [blame] | 211 | params->hdr.tag = ATAG_NONE; |
| 212 | params->hdr.size = 0; |
wdenk | c609719 | 2002-11-03 00:24:07 +0000 | [diff] [blame] | 213 | } |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 214 | |
Pali Rohár | 5ebe4f1 | 2012-10-19 02:00:04 +0000 | [diff] [blame] | 215 | __weak void setup_board_tags(struct tag **in_params) {} |
| 216 | |
Marc Zyngier | 855ca66 | 2014-07-12 14:24:03 +0100 | [diff] [blame] | 217 | #ifdef CONFIG_ARM64 |
Andre Przywara | fe7d925 | 2013-09-19 18:06:43 +0200 | [diff] [blame] | 218 | static void do_nonsec_virt_switch(void) |
| 219 | { |
David Feng | 85fd5f1 | 2013-12-14 11:47:35 +0800 | [diff] [blame] | 220 | smp_kick_all_cpus(); |
York Sun | 1ce575f | 2015-01-06 13:18:42 -0800 | [diff] [blame] | 221 | dcache_disable(); /* flush cache before swtiching to EL2 */ |
Andre Przywara | fe7d925 | 2013-09-19 18:06:43 +0200 | [diff] [blame] | 222 | } |
Marc Zyngier | 855ca66 | 2014-07-12 14:24:03 +0100 | [diff] [blame] | 223 | #endif |
Andre Przywara | fe7d925 | 2013-09-19 18:06:43 +0200 | [diff] [blame] | 224 | |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 225 | /* Subcommand: PREP */ |
| 226 | static void boot_prep_linux(bootm_headers_t *images) |
| 227 | { |
Simon Glass | 64b723f | 2017-08-03 12:22:12 -0600 | [diff] [blame] | 228 | char *commandline = env_get("bootargs"); |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 229 | |
Simon Glass | 50ad221 | 2013-05-08 08:06:02 +0000 | [diff] [blame] | 230 | if (IMAGE_ENABLE_OF_LIBFDT && images->ft_len) { |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 231 | #ifdef CONFIG_OF_LIBFDT |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 232 | debug("using: FDT\n"); |
Simon Glass | 653909f | 2013-05-08 08:06:03 +0000 | [diff] [blame] | 233 | if (image_setup_linux(images)) { |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 234 | printf("FDT creation failed! hanging..."); |
| 235 | hang(); |
| 236 | } |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 237 | #endif |
Simon Glass | 50ad221 | 2013-05-08 08:06:02 +0000 | [diff] [blame] | 238 | } else if (BOOTM_ENABLE_TAGS) { |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 239 | debug("using: ATAGS\n"); |
| 240 | setup_start_tag(gd->bd); |
Simon Glass | 50ad221 | 2013-05-08 08:06:02 +0000 | [diff] [blame] | 241 | if (BOOTM_ENABLE_SERIAL_TAG) |
| 242 | setup_serial_tag(¶ms); |
| 243 | if (BOOTM_ENABLE_CMDLINE_TAG) |
| 244 | setup_commandline_tag(gd->bd, commandline); |
| 245 | if (BOOTM_ENABLE_REVISION_TAG) |
| 246 | setup_revision_tag(¶ms); |
| 247 | if (BOOTM_ENABLE_MEMORY_TAGS) |
| 248 | setup_memory_tags(gd->bd); |
| 249 | if (BOOTM_ENABLE_INITRD_TAG) { |
Jeffy Chen | 113094e | 2016-01-14 10:19:36 +0800 | [diff] [blame] | 250 | /* |
| 251 | * In boot_ramdisk_high(), it may relocate ramdisk to |
| 252 | * a specified location. And set images->initrd_start & |
| 253 | * images->initrd_end to relocated ramdisk's start/end |
| 254 | * addresses. So use them instead of images->rd_start & |
| 255 | * images->rd_end when possible. |
| 256 | */ |
| 257 | if (images->initrd_start && images->initrd_end) { |
| 258 | setup_initrd_tag(gd->bd, images->initrd_start, |
| 259 | images->initrd_end); |
| 260 | } else if (images->rd_start && images->rd_end) { |
Simon Glass | 50ad221 | 2013-05-08 08:06:02 +0000 | [diff] [blame] | 261 | setup_initrd_tag(gd->bd, images->rd_start, |
| 262 | images->rd_end); |
| 263 | } |
| 264 | } |
Pali Rohár | 5ebe4f1 | 2012-10-19 02:00:04 +0000 | [diff] [blame] | 265 | setup_board_tags(¶ms); |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 266 | setup_end_tag(gd->bd); |
Simon Glass | 50ad221 | 2013-05-08 08:06:02 +0000 | [diff] [blame] | 267 | } else { |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 268 | printf("FDT and ATAGS support not compiled in - hanging\n"); |
| 269 | hang(); |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 270 | } |
| 271 | } |
| 272 | |
Jon Medhurst \(Tixy\) | 413ca3d | 2016-06-23 13:37:32 +0100 | [diff] [blame] | 273 | __weak bool armv7_boot_nonsec_default(void) |
Hans de Goede | 63fb548 | 2014-11-14 09:34:31 +0100 | [diff] [blame] | 274 | { |
Hans de Goede | 63fb548 | 2014-11-14 09:34:31 +0100 | [diff] [blame] | 275 | #ifdef CONFIG_ARMV7_BOOT_SEC_DEFAULT |
Jon Medhurst \(Tixy\) | 413ca3d | 2016-06-23 13:37:32 +0100 | [diff] [blame] | 276 | return false; |
Hans de Goede | 63fb548 | 2014-11-14 09:34:31 +0100 | [diff] [blame] | 277 | #else |
Jon Medhurst \(Tixy\) | 413ca3d | 2016-06-23 13:37:32 +0100 | [diff] [blame] | 278 | return true; |
Hans de Goede | 63fb548 | 2014-11-14 09:34:31 +0100 | [diff] [blame] | 279 | #endif |
Jon Medhurst \(Tixy\) | 413ca3d | 2016-06-23 13:37:32 +0100 | [diff] [blame] | 280 | } |
| 281 | |
| 282 | #ifdef CONFIG_ARMV7_NONSEC |
| 283 | bool armv7_boot_nonsec(void) |
| 284 | { |
Simon Glass | 64b723f | 2017-08-03 12:22:12 -0600 | [diff] [blame] | 285 | char *s = env_get("bootm_boot_mode"); |
Jon Medhurst \(Tixy\) | 413ca3d | 2016-06-23 13:37:32 +0100 | [diff] [blame] | 286 | bool nonsec = armv7_boot_nonsec_default(); |
Hans de Goede | 63fb548 | 2014-11-14 09:34:31 +0100 | [diff] [blame] | 287 | |
| 288 | if (s && !strcmp(s, "sec")) |
| 289 | nonsec = false; |
| 290 | |
| 291 | if (s && !strcmp(s, "nonsec")) |
| 292 | nonsec = true; |
| 293 | |
| 294 | return nonsec; |
| 295 | } |
| 296 | #endif |
| 297 | |
Alison Wang | 73818d5 | 2016-11-10 10:49:03 +0800 | [diff] [blame] | 298 | #ifdef CONFIG_ARM64 |
Alison Wang | 876c7e1 | 2016-11-10 10:49:04 +0800 | [diff] [blame] | 299 | __weak void update_os_arch_secondary_cores(uint8_t os_arch) |
| 300 | { |
| 301 | } |
| 302 | |
Alison Wang | 73818d5 | 2016-11-10 10:49:03 +0800 | [diff] [blame] | 303 | #ifdef CONFIG_ARMV8_SWITCH_TO_EL1 |
| 304 | static void switch_to_el1(void) |
| 305 | { |
| 306 | if ((IH_ARCH_DEFAULT == IH_ARCH_ARM64) && |
| 307 | (images.os.arch == IH_ARCH_ARM)) |
| 308 | armv8_switch_to_el1(0, (u64)gd->bd->bi_arch_number, |
Alison Wang | eb2088d | 2017-01-17 09:39:17 +0800 | [diff] [blame] | 309 | (u64)images.ft_addr, 0, |
Alison Wang | 73818d5 | 2016-11-10 10:49:03 +0800 | [diff] [blame] | 310 | (u64)images.ep, |
| 311 | ES_TO_AARCH32); |
| 312 | else |
Alison Wang | eb2088d | 2017-01-17 09:39:17 +0800 | [diff] [blame] | 313 | armv8_switch_to_el1((u64)images.ft_addr, 0, 0, 0, |
Alison Wang | 73818d5 | 2016-11-10 10:49:03 +0800 | [diff] [blame] | 314 | images.ep, |
| 315 | ES_TO_AARCH64); |
| 316 | } |
| 317 | #endif |
| 318 | #endif |
| 319 | |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 320 | /* Subcommand: GO */ |
Simon Glass | 3c26c58 | 2013-06-19 21:15:10 -0700 | [diff] [blame] | 321 | static void boot_jump_linux(bootm_headers_t *images, int flag) |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 322 | { |
David Feng | 85fd5f1 | 2013-12-14 11:47:35 +0800 | [diff] [blame] | 323 | #ifdef CONFIG_ARM64 |
Tom Rini | 67d604e | 2014-08-14 06:42:35 -0400 | [diff] [blame] | 324 | void (*kernel_entry)(void *fdt_addr, void *res0, void *res1, |
| 325 | void *res2); |
David Feng | 85fd5f1 | 2013-12-14 11:47:35 +0800 | [diff] [blame] | 326 | int fake = (flag & BOOTM_STATE_OS_FAKE_GO); |
| 327 | |
Tom Rini | 67d604e | 2014-08-14 06:42:35 -0400 | [diff] [blame] | 328 | kernel_entry = (void (*)(void *fdt_addr, void *res0, void *res1, |
| 329 | void *res2))images->ep; |
David Feng | 85fd5f1 | 2013-12-14 11:47:35 +0800 | [diff] [blame] | 330 | |
| 331 | debug("## Transferring control to Linux (at address %lx)...\n", |
| 332 | (ulong) kernel_entry); |
| 333 | bootstage_mark(BOOTSTAGE_ID_RUN_OS); |
| 334 | |
| 335 | announce_and_cleanup(fake); |
| 336 | |
Marc Zyngier | 915a09e | 2014-07-12 14:23:58 +0100 | [diff] [blame] | 337 | if (!fake) { |
macro.wave.z@gmail.com | 05725ed | 2016-12-08 11:58:25 +0800 | [diff] [blame] | 338 | #ifdef CONFIG_ARMV8_PSCI |
| 339 | armv8_setup_psci(); |
| 340 | #endif |
Marc Zyngier | 915a09e | 2014-07-12 14:23:58 +0100 | [diff] [blame] | 341 | do_nonsec_virt_switch(); |
Alison Wang | 73818d5 | 2016-11-10 10:49:03 +0800 | [diff] [blame] | 342 | |
Alison Wang | 876c7e1 | 2016-11-10 10:49:04 +0800 | [diff] [blame] | 343 | update_os_arch_secondary_cores(images->os.arch); |
| 344 | |
Alison Wang | 73818d5 | 2016-11-10 10:49:03 +0800 | [diff] [blame] | 345 | #ifdef CONFIG_ARMV8_SWITCH_TO_EL1 |
Alison Wang | eb2088d | 2017-01-17 09:39:17 +0800 | [diff] [blame] | 346 | armv8_switch_to_el2((u64)images->ft_addr, 0, 0, 0, |
Alison Wang | 73818d5 | 2016-11-10 10:49:03 +0800 | [diff] [blame] | 347 | (u64)switch_to_el1, ES_TO_AARCH64); |
| 348 | #else |
| 349 | if ((IH_ARCH_DEFAULT == IH_ARCH_ARM64) && |
| 350 | (images->os.arch == IH_ARCH_ARM)) |
| 351 | armv8_switch_to_el2(0, (u64)gd->bd->bi_arch_number, |
Alison Wang | eb2088d | 2017-01-17 09:39:17 +0800 | [diff] [blame] | 352 | (u64)images->ft_addr, 0, |
Alison Wang | 73818d5 | 2016-11-10 10:49:03 +0800 | [diff] [blame] | 353 | (u64)images->ep, |
| 354 | ES_TO_AARCH32); |
| 355 | else |
Alison Wang | eb2088d | 2017-01-17 09:39:17 +0800 | [diff] [blame] | 356 | armv8_switch_to_el2((u64)images->ft_addr, 0, 0, 0, |
Alison Wang | 73818d5 | 2016-11-10 10:49:03 +0800 | [diff] [blame] | 357 | images->ep, |
| 358 | ES_TO_AARCH64); |
| 359 | #endif |
Marc Zyngier | 915a09e | 2014-07-12 14:23:58 +0100 | [diff] [blame] | 360 | } |
David Feng | 85fd5f1 | 2013-12-14 11:47:35 +0800 | [diff] [blame] | 361 | #else |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 362 | unsigned long machid = gd->bd->bi_arch_number; |
| 363 | char *s; |
| 364 | void (*kernel_entry)(int zero, int arch, uint params); |
Stephen Warren | c570fba | 2012-04-19 11:34:00 +0000 | [diff] [blame] | 365 | unsigned long r2; |
Simon Glass | 3c26c58 | 2013-06-19 21:15:10 -0700 | [diff] [blame] | 366 | int fake = (flag & BOOTM_STATE_OS_FAKE_GO); |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 367 | |
| 368 | kernel_entry = (void (*)(int, int, uint))images->ep; |
Patrice Chotard | ffb3c0b | 2017-04-25 11:07:46 +0200 | [diff] [blame] | 369 | #ifdef CONFIG_CPU_V7M |
| 370 | ulong addr = (ulong)kernel_entry | 1; |
| 371 | kernel_entry = (void *)addr; |
| 372 | #endif |
Simon Glass | 64b723f | 2017-08-03 12:22:12 -0600 | [diff] [blame] | 373 | s = env_get("machid"); |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 374 | if (s) { |
Peng Fan | c4485e7 | 2015-11-24 16:54:20 +0800 | [diff] [blame] | 375 | if (strict_strtoul(s, 16, &machid) < 0) { |
| 376 | debug("strict_strtoul failed!\n"); |
| 377 | return; |
| 378 | } |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 379 | printf("Using machid 0x%lx from environment\n", machid); |
| 380 | } |
| 381 | |
| 382 | debug("## Transferring control to Linux (at address %08lx)" \ |
| 383 | "...\n", (ulong) kernel_entry); |
| 384 | bootstage_mark(BOOTSTAGE_ID_RUN_OS); |
Simon Glass | 3c26c58 | 2013-06-19 21:15:10 -0700 | [diff] [blame] | 385 | announce_and_cleanup(fake); |
Stephen Warren | c570fba | 2012-04-19 11:34:00 +0000 | [diff] [blame] | 386 | |
Simon Glass | 50ad221 | 2013-05-08 08:06:02 +0000 | [diff] [blame] | 387 | if (IMAGE_ENABLE_OF_LIBFDT && images->ft_len) |
Stephen Warren | c570fba | 2012-04-19 11:34:00 +0000 | [diff] [blame] | 388 | r2 = (unsigned long)images->ft_addr; |
| 389 | else |
Stephen Warren | c570fba | 2012-04-19 11:34:00 +0000 | [diff] [blame] | 390 | r2 = gd->bd->bi_boot_params; |
| 391 | |
Marc Zyngier | 915a09e | 2014-07-12 14:23:58 +0100 | [diff] [blame] | 392 | if (!fake) { |
Jan Kiszka | ac31b5a | 2015-04-21 07:18:24 +0200 | [diff] [blame] | 393 | #ifdef CONFIG_ARMV7_NONSEC |
Ian Campbell | 68bc8f5 | 2014-12-21 09:45:11 +0000 | [diff] [blame] | 394 | if (armv7_boot_nonsec()) { |
Hans de Goede | 63fb548 | 2014-11-14 09:34:31 +0100 | [diff] [blame] | 395 | armv7_init_nonsec(); |
| 396 | secure_ram_addr(_do_nonsec_entry)(kernel_entry, |
| 397 | 0, machid, r2); |
| 398 | } else |
Marc Zyngier | 855ca66 | 2014-07-12 14:24:03 +0100 | [diff] [blame] | 399 | #endif |
Hans de Goede | 63fb548 | 2014-11-14 09:34:31 +0100 | [diff] [blame] | 400 | kernel_entry(0, machid, r2); |
Marc Zyngier | 915a09e | 2014-07-12 14:23:58 +0100 | [diff] [blame] | 401 | } |
David Feng | 85fd5f1 | 2013-12-14 11:47:35 +0800 | [diff] [blame] | 402 | #endif |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 403 | } |
| 404 | |
| 405 | /* Main Entry point for arm bootm implementation |
| 406 | * |
| 407 | * Modeled after the powerpc implementation |
| 408 | * DIFFERENCE: Instead of calling prep and go at the end |
| 409 | * they are called if subcommand is equal 0. |
| 410 | */ |
Eric Nelson | b7c236b | 2014-09-30 15:40:01 -0700 | [diff] [blame] | 411 | int do_bootm_linux(int flag, int argc, char * const argv[], |
| 412 | bootm_headers_t *images) |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 413 | { |
| 414 | /* No need for those on ARM */ |
| 415 | if (flag & BOOTM_STATE_OS_BD_T || flag & BOOTM_STATE_OS_CMDLINE) |
| 416 | return -1; |
| 417 | |
| 418 | if (flag & BOOTM_STATE_OS_PREP) { |
| 419 | boot_prep_linux(images); |
| 420 | return 0; |
| 421 | } |
| 422 | |
Simon Glass | 3c26c58 | 2013-06-19 21:15:10 -0700 | [diff] [blame] | 423 | if (flag & (BOOTM_STATE_OS_GO | BOOTM_STATE_OS_FAKE_GO)) { |
| 424 | boot_jump_linux(images, flag); |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 425 | return 0; |
| 426 | } |
| 427 | |
| 428 | boot_prep_linux(images); |
Simon Glass | 3c26c58 | 2013-06-19 21:15:10 -0700 | [diff] [blame] | 429 | boot_jump_linux(images, flag); |
Simon Schwarz | 6a597b9 | 2012-03-15 04:01:45 +0000 | [diff] [blame] | 430 | return 0; |
John Rigby | ab51f1e | 2010-10-13 13:57:36 -0600 | [diff] [blame] | 431 | } |
Marek Vasut | cf41a9b | 2012-03-14 21:52:45 +0000 | [diff] [blame] | 432 | |
Miao Yan | 1bd5456 | 2013-11-28 17:51:38 +0800 | [diff] [blame] | 433 | #if defined(CONFIG_BOOTM_VXWORKS) |
| 434 | void boot_prep_vxworks(bootm_headers_t *images) |
| 435 | { |
| 436 | #if defined(CONFIG_OF_LIBFDT) |
| 437 | int off; |
| 438 | |
| 439 | if (images->ft_addr) { |
| 440 | off = fdt_path_offset(images->ft_addr, "/memory"); |
| 441 | if (off < 0) { |
Ma Haijun | 6235824 | 2014-07-12 14:24:06 +0100 | [diff] [blame] | 442 | if (arch_fixup_fdt(images->ft_addr)) |
Miao Yan | 1bd5456 | 2013-11-28 17:51:38 +0800 | [diff] [blame] | 443 | puts("## WARNING: fixup memory failed!\n"); |
| 444 | } |
| 445 | } |
| 446 | #endif |
| 447 | cleanup_before_linux(); |
| 448 | } |
| 449 | void boot_jump_vxworks(bootm_headers_t *images) |
| 450 | { |
| 451 | /* ARM VxWorks requires device tree physical address to be passed */ |
| 452 | ((void (*)(void *))images->ep)(images->ft_addr); |
| 453 | } |
| 454 | #endif |