1 /* 2 * (C) Copyright 2002 3 * Sysgo Real-Time Solutions, GmbH <www.elinos.com> 4 * Marius Groeger <mgroeger@sysgo.de> 5 * 6 * Copyright (C) 2001 Erik Mouw (J.A.K.Mouw@its.tudelft.nl) 7 * 8 * This program is free software; you can redistribute it and/or modify 9 * it under the terms of the GNU General Public License as published by 10 * the Free Software Foundation; either version 2 of the License, or 11 * (at your option) any later version. 12 * 13 * This program is distributed in the hope that it will be useful, 14 * but WITHOUT ANY WARRANTY; without even the implied warranty of 15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 16 * GNU General Public License for more details. 17 * 18 * You should have received a copy of the GNU General Public License 19 * along with this program; if not, write to the Free Software 20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 21 * 22 */ 23 24 #include <common.h> 25 #include <command.h> 26 #include <image.h> 27 #include <u-boot/zlib.h> 28 #include <asm/byteorder.h> 29 #include <fdt.h> 30 #include <libfdt.h> 31 #include <fdt_support.h> 32 33 DECLARE_GLOBAL_DATA_PTR; 34 35 #if defined (CONFIG_SETUP_MEMORY_TAGS) || \ 36 defined (CONFIG_CMDLINE_TAG) || \ 37 defined (CONFIG_INITRD_TAG) || \ 38 defined (CONFIG_SERIAL_TAG) || \ 39 defined (CONFIG_REVISION_TAG) 40 static void setup_start_tag (bd_t *bd); 41 42 # ifdef CONFIG_SETUP_MEMORY_TAGS 43 static void setup_memory_tags (bd_t *bd); 44 # endif 45 static void setup_commandline_tag (bd_t *bd, char *commandline); 46 47 # ifdef CONFIG_INITRD_TAG 48 static void setup_initrd_tag (bd_t *bd, ulong initrd_start, 49 ulong initrd_end); 50 # endif 51 static void setup_end_tag (bd_t *bd); 52 53 static struct tag *params; 54 #endif /* CONFIG_SETUP_MEMORY_TAGS || CONFIG_CMDLINE_TAG || CONFIG_INITRD_TAG */ 55 56 static ulong get_sp(void); 57 #if defined(CONFIG_OF_LIBFDT) 58 static int bootm_linux_fdt(int machid, bootm_headers_t *images); 59 #endif 60 61 void arch_lmb_reserve(struct lmb *lmb) 62 { 63 ulong sp; 64 65 /* 66 * Booting a (Linux) kernel image 67 * 68 * Allocate space for command line and board info - the 69 * address should be as high as possible within the reach of 70 * the kernel (see CONFIG_SYS_BOOTMAPSZ settings), but in unused 71 * memory, which means far enough below the current stack 72 * pointer. 73 */ 74 sp = get_sp(); 75 debug("## Current stack ends at 0x%08lx ", sp); 76 77 /* adjust sp by 1K to be safe */ 78 sp -= 1024; 79 lmb_reserve(lmb, sp, 80 gd->bd->bi_dram[0].start + gd->bd->bi_dram[0].size - sp); 81 } 82 83 static void announce_and_cleanup(void) 84 { 85 printf("\nStarting kernel ...\n\n"); 86 87 #ifdef CONFIG_USB_DEVICE 88 { 89 extern void udc_disconnect(void); 90 udc_disconnect(); 91 } 92 #endif 93 cleanup_before_linux(); 94 } 95 96 int do_bootm_linux(int flag, int argc, char *argv[], bootm_headers_t *images) 97 { 98 bd_t *bd = gd->bd; 99 char *s; 100 int machid = bd->bi_arch_number; 101 void (*kernel_entry)(int zero, int arch, uint params); 102 103 #ifdef CONFIG_CMDLINE_TAG 104 char *commandline = getenv ("bootargs"); 105 #endif 106 107 if ((flag != 0) && (flag != BOOTM_STATE_OS_GO)) 108 return 1; 109 110 s = getenv ("machid"); 111 if (s) { 112 machid = simple_strtoul (s, NULL, 16); 113 printf ("Using machid 0x%x from environment\n", machid); 114 } 115 116 show_boot_progress (15); 117 118 #ifdef CONFIG_OF_LIBFDT 119 if (images->ft_len) 120 return bootm_linux_fdt(machid, images); 121 #endif 122 123 kernel_entry = (void (*)(int, int, uint))images->ep; 124 125 debug ("## Transferring control to Linux (at address %08lx) ...\n", 126 (ulong) kernel_entry); 127 128 #if defined (CONFIG_SETUP_MEMORY_TAGS) || \ 129 defined (CONFIG_CMDLINE_TAG) || \ 130 defined (CONFIG_INITRD_TAG) || \ 131 defined (CONFIG_SERIAL_TAG) || \ 132 defined (CONFIG_REVISION_TAG) 133 setup_start_tag (bd); 134 #ifdef CONFIG_SERIAL_TAG 135 setup_serial_tag (¶ms); 136 #endif 137 #ifdef CONFIG_REVISION_TAG 138 setup_revision_tag (¶ms); 139 #endif 140 #ifdef CONFIG_SETUP_MEMORY_TAGS 141 setup_memory_tags (bd); 142 #endif 143 #ifdef CONFIG_CMDLINE_TAG 144 setup_commandline_tag (bd, commandline); 145 #endif 146 #ifdef CONFIG_INITRD_TAG 147 if (images->rd_start && images->rd_end) 148 setup_initrd_tag (bd, images->rd_start, images->rd_end); 149 #endif 150 setup_end_tag(bd); 151 #endif 152 153 announce_and_cleanup(); 154 155 kernel_entry(0, machid, bd->bi_boot_params); 156 /* does not return */ 157 158 return 1; 159 } 160 161 #if defined(CONFIG_OF_LIBFDT) 162 static int fixup_memory_node(void *blob) 163 { 164 bd_t *bd = gd->bd; 165 int bank; 166 u64 start[CONFIG_NR_DRAM_BANKS]; 167 u64 size[CONFIG_NR_DRAM_BANKS]; 168 169 for (bank = 0; bank < CONFIG_NR_DRAM_BANKS; bank++) { 170 start[bank] = bd->bi_dram[bank].start; 171 size[bank] = bd->bi_dram[bank].size; 172 } 173 174 return fdt_fixup_memory_banks(blob, start, size, CONFIG_NR_DRAM_BANKS); 175 } 176 177 static int bootm_linux_fdt(int machid, bootm_headers_t *images) 178 { 179 ulong rd_len; 180 void (*kernel_entry)(int zero, int dt_machid, void *dtblob); 181 ulong bootmap_base = getenv_bootm_low(); 182 ulong of_size = images->ft_len; 183 char **of_flat_tree = &images->ft_addr; 184 ulong *initrd_start = &images->initrd_start; 185 ulong *initrd_end = &images->initrd_end; 186 struct lmb *lmb = &images->lmb; 187 int ret; 188 189 kernel_entry = (void (*)(int, int, void *))images->ep; 190 191 rd_len = images->rd_end - images->rd_start; 192 ret = boot_ramdisk_high(lmb, images->rd_start, rd_len, 193 initrd_start, initrd_end); 194 if (ret) 195 return ret; 196 197 ret = boot_relocate_fdt(lmb, bootmap_base, of_flat_tree, &of_size); 198 if (ret) 199 return ret; 200 201 debug("## Transferring control to Linux (at address %08lx) ...\n", 202 (ulong) kernel_entry); 203 204 fdt_chosen(*of_flat_tree, 1); 205 206 fixup_memory_node(*of_flat_tree); 207 208 fdt_initrd(*of_flat_tree, *initrd_start, *initrd_end, 1); 209 210 announce_and_cleanup(); 211 212 kernel_entry(0, machid, *of_flat_tree); 213 /* does not return */ 214 215 return 1; 216 } 217 #endif 218 219 #if defined (CONFIG_SETUP_MEMORY_TAGS) || \ 220 defined (CONFIG_CMDLINE_TAG) || \ 221 defined (CONFIG_INITRD_TAG) || \ 222 defined (CONFIG_SERIAL_TAG) || \ 223 defined (CONFIG_REVISION_TAG) 224 static void setup_start_tag (bd_t *bd) 225 { 226 params = (struct tag *) bd->bi_boot_params; 227 228 params->hdr.tag = ATAG_CORE; 229 params->hdr.size = tag_size (tag_core); 230 231 params->u.core.flags = 0; 232 params->u.core.pagesize = 0; 233 params->u.core.rootdev = 0; 234 235 params = tag_next (params); 236 } 237 238 239 #ifdef CONFIG_SETUP_MEMORY_TAGS 240 static void setup_memory_tags (bd_t *bd) 241 { 242 int i; 243 244 for (i = 0; i < CONFIG_NR_DRAM_BANKS; i++) { 245 params->hdr.tag = ATAG_MEM; 246 params->hdr.size = tag_size (tag_mem32); 247 248 params->u.mem.start = bd->bi_dram[i].start; 249 params->u.mem.size = bd->bi_dram[i].size; 250 251 params = tag_next (params); 252 } 253 } 254 #endif /* CONFIG_SETUP_MEMORY_TAGS */ 255 256 257 static void setup_commandline_tag (bd_t *bd, char *commandline) 258 { 259 char *p; 260 261 if (!commandline) 262 return; 263 264 /* eat leading white space */ 265 for (p = commandline; *p == ' '; p++); 266 267 /* skip non-existent command lines so the kernel will still 268 * use its default command line. 269 */ 270 if (*p == '\0') 271 return; 272 273 params->hdr.tag = ATAG_CMDLINE; 274 params->hdr.size = 275 (sizeof (struct tag_header) + strlen (p) + 1 + 4) >> 2; 276 277 strcpy (params->u.cmdline.cmdline, p); 278 279 params = tag_next (params); 280 } 281 282 283 #ifdef CONFIG_INITRD_TAG 284 static void setup_initrd_tag (bd_t *bd, ulong initrd_start, ulong initrd_end) 285 { 286 /* an ATAG_INITRD node tells the kernel where the compressed 287 * ramdisk can be found. ATAG_RDIMG is a better name, actually. 288 */ 289 params->hdr.tag = ATAG_INITRD2; 290 params->hdr.size = tag_size (tag_initrd); 291 292 params->u.initrd.start = initrd_start; 293 params->u.initrd.size = initrd_end - initrd_start; 294 295 params = tag_next (params); 296 } 297 #endif /* CONFIG_INITRD_TAG */ 298 299 #ifdef CONFIG_SERIAL_TAG 300 void setup_serial_tag (struct tag **tmp) 301 { 302 struct tag *params = *tmp; 303 struct tag_serialnr serialnr; 304 void get_board_serial(struct tag_serialnr *serialnr); 305 306 get_board_serial(&serialnr); 307 params->hdr.tag = ATAG_SERIAL; 308 params->hdr.size = tag_size (tag_serialnr); 309 params->u.serialnr.low = serialnr.low; 310 params->u.serialnr.high= serialnr.high; 311 params = tag_next (params); 312 *tmp = params; 313 } 314 #endif 315 316 #ifdef CONFIG_REVISION_TAG 317 void setup_revision_tag(struct tag **in_params) 318 { 319 u32 rev = 0; 320 u32 get_board_rev(void); 321 322 rev = get_board_rev(); 323 params->hdr.tag = ATAG_REVISION; 324 params->hdr.size = tag_size (tag_revision); 325 params->u.revision.rev = rev; 326 params = tag_next (params); 327 } 328 #endif /* CONFIG_REVISION_TAG */ 329 330 331 static void setup_end_tag (bd_t *bd) 332 { 333 params->hdr.tag = ATAG_NONE; 334 params->hdr.size = 0; 335 } 336 337 static ulong get_sp(void) 338 { 339 ulong ret; 340 341 asm("mov %0, sp" : "=r"(ret) : ); 342 return ret; 343 } 344 345 #endif /* CONFIG_SETUP_MEMORY_TAGS || CONFIG_CMDLINE_TAG || CONFIG_INITRD_TAG */ 346