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 bd_t *bd = gd->bd; 181 char *s; 182 void (*kernel_entry)(int zero, int dt_machid, void *dtblob); 183 ulong bootmap_base = getenv_bootm_low(); 184 ulong of_size = images->ft_len; 185 char **of_flat_tree = &images->ft_addr; 186 ulong *initrd_start = &images->initrd_start; 187 ulong *initrd_end = &images->initrd_end; 188 struct lmb *lmb = &images->lmb; 189 int ret; 190 191 kernel_entry = (void (*)(int, int, void *))images->ep; 192 193 rd_len = images->rd_end - images->rd_start; 194 ret = boot_ramdisk_high(lmb, images->rd_start, rd_len, 195 initrd_start, initrd_end); 196 if (ret) 197 return ret; 198 199 ret = boot_relocate_fdt(lmb, bootmap_base, of_flat_tree, &of_size); 200 if (ret) 201 return ret; 202 203 debug("## Transferring control to Linux (at address %08lx) ...\n", 204 (ulong) kernel_entry); 205 206 fdt_chosen(*of_flat_tree, 1); 207 208 fixup_memory_node(*of_flat_tree); 209 210 fdt_initrd(*of_flat_tree, *initrd_start, *initrd_end, 1); 211 212 announce_and_cleanup(); 213 214 kernel_entry(0, machid, *of_flat_tree); 215 /* does not return */ 216 217 return 1; 218 } 219 #endif 220 221 #if defined (CONFIG_SETUP_MEMORY_TAGS) || \ 222 defined (CONFIG_CMDLINE_TAG) || \ 223 defined (CONFIG_INITRD_TAG) || \ 224 defined (CONFIG_SERIAL_TAG) || \ 225 defined (CONFIG_REVISION_TAG) 226 static void setup_start_tag (bd_t *bd) 227 { 228 params = (struct tag *) bd->bi_boot_params; 229 230 params->hdr.tag = ATAG_CORE; 231 params->hdr.size = tag_size (tag_core); 232 233 params->u.core.flags = 0; 234 params->u.core.pagesize = 0; 235 params->u.core.rootdev = 0; 236 237 params = tag_next (params); 238 } 239 240 241 #ifdef CONFIG_SETUP_MEMORY_TAGS 242 static void setup_memory_tags (bd_t *bd) 243 { 244 int i; 245 246 for (i = 0; i < CONFIG_NR_DRAM_BANKS; i++) { 247 params->hdr.tag = ATAG_MEM; 248 params->hdr.size = tag_size (tag_mem32); 249 250 params->u.mem.start = bd->bi_dram[i].start; 251 params->u.mem.size = bd->bi_dram[i].size; 252 253 params = tag_next (params); 254 } 255 } 256 #endif /* CONFIG_SETUP_MEMORY_TAGS */ 257 258 259 static void setup_commandline_tag (bd_t *bd, char *commandline) 260 { 261 char *p; 262 263 if (!commandline) 264 return; 265 266 /* eat leading white space */ 267 for (p = commandline; *p == ' '; p++); 268 269 /* skip non-existent command lines so the kernel will still 270 * use its default command line. 271 */ 272 if (*p == '\0') 273 return; 274 275 params->hdr.tag = ATAG_CMDLINE; 276 params->hdr.size = 277 (sizeof (struct tag_header) + strlen (p) + 1 + 4) >> 2; 278 279 strcpy (params->u.cmdline.cmdline, p); 280 281 params = tag_next (params); 282 } 283 284 285 #ifdef CONFIG_INITRD_TAG 286 static void setup_initrd_tag (bd_t *bd, ulong initrd_start, ulong initrd_end) 287 { 288 /* an ATAG_INITRD node tells the kernel where the compressed 289 * ramdisk can be found. ATAG_RDIMG is a better name, actually. 290 */ 291 params->hdr.tag = ATAG_INITRD2; 292 params->hdr.size = tag_size (tag_initrd); 293 294 params->u.initrd.start = initrd_start; 295 params->u.initrd.size = initrd_end - initrd_start; 296 297 params = tag_next (params); 298 } 299 #endif /* CONFIG_INITRD_TAG */ 300 301 #ifdef CONFIG_SERIAL_TAG 302 void setup_serial_tag (struct tag **tmp) 303 { 304 struct tag *params = *tmp; 305 struct tag_serialnr serialnr; 306 void get_board_serial(struct tag_serialnr *serialnr); 307 308 get_board_serial(&serialnr); 309 params->hdr.tag = ATAG_SERIAL; 310 params->hdr.size = tag_size (tag_serialnr); 311 params->u.serialnr.low = serialnr.low; 312 params->u.serialnr.high= serialnr.high; 313 params = tag_next (params); 314 *tmp = params; 315 } 316 #endif 317 318 #ifdef CONFIG_REVISION_TAG 319 void setup_revision_tag(struct tag **in_params) 320 { 321 u32 rev = 0; 322 u32 get_board_rev(void); 323 324 rev = get_board_rev(); 325 params->hdr.tag = ATAG_REVISION; 326 params->hdr.size = tag_size (tag_revision); 327 params->u.revision.rev = rev; 328 params = tag_next (params); 329 } 330 #endif /* CONFIG_REVISION_TAG */ 331 332 333 static void setup_end_tag (bd_t *bd) 334 { 335 params->hdr.tag = ATAG_NONE; 336 params->hdr.size = 0; 337 } 338 339 static ulong get_sp(void) 340 { 341 ulong ret; 342 343 asm("mov %0, sp" : "=r"(ret) : ); 344 return ret; 345 } 346 347 #endif /* CONFIG_SETUP_MEMORY_TAGS || CONFIG_CMDLINE_TAG || CONFIG_INITRD_TAG */ 348