2 * Copyright (c) 2001 William L. Pitts
5 * Redistribution and use in source and binary forms are freely
6 * permitted provided that the above copyright notice and this
7 * paragraph and the following disclaimer are duplicated in all
10 * This software is provided "AS IS" and without any express or
11 * implied warranties, including, without limitation, the implied
12 * warranties of merchantability and fitness for a particular
23 #include <linux/linkage.h>
27 * A very simple elf loader, assumes the image is valid, returns the
28 * entry point address.
30 static unsigned long load_elf_image_phdr(unsigned long addr
)
32 Elf32_Ehdr
*ehdr
; /* Elf header structure pointer */
33 Elf32_Phdr
*phdr
; /* Program header structure pointer */
36 ehdr
= (Elf32_Ehdr
*)addr
;
37 phdr
= (Elf32_Phdr
*)(addr
+ ehdr
->e_phoff
);
39 /* Load each program header */
40 for (i
= 0; i
< ehdr
->e_phnum
; ++i
) {
41 void *dst
= (void *)(uintptr_t)phdr
->p_paddr
;
42 void *src
= (void *)addr
+ phdr
->p_offset
;
43 debug("Loading phdr %i to 0x%p (%i bytes)\n",
44 i
, dst
, phdr
->p_filesz
);
46 memcpy(dst
, src
, phdr
->p_filesz
);
47 if (phdr
->p_filesz
!= phdr
->p_memsz
)
48 memset(dst
+ phdr
->p_filesz
, 0x00,
49 phdr
->p_memsz
- phdr
->p_filesz
);
50 flush_cache((unsigned long)dst
, phdr
->p_filesz
);
57 static unsigned long load_elf_image_shdr(unsigned long addr
)
59 Elf32_Ehdr
*ehdr
; /* Elf header structure pointer */
60 Elf32_Shdr
*shdr
; /* Section header structure pointer */
61 unsigned char *strtab
= 0; /* String table pointer */
62 unsigned char *image
; /* Binary image pointer */
63 int i
; /* Loop counter */
65 ehdr
= (Elf32_Ehdr
*)addr
;
67 /* Find the section header string table for output info */
68 shdr
= (Elf32_Shdr
*)(addr
+ ehdr
->e_shoff
+
69 (ehdr
->e_shstrndx
* sizeof(Elf32_Shdr
)));
71 if (shdr
->sh_type
== SHT_STRTAB
)
72 strtab
= (unsigned char *)(addr
+ shdr
->sh_offset
);
74 /* Load each appropriate section */
75 for (i
= 0; i
< ehdr
->e_shnum
; ++i
) {
76 shdr
= (Elf32_Shdr
*)(addr
+ ehdr
->e_shoff
+
77 (i
* sizeof(Elf32_Shdr
)));
79 if (!(shdr
->sh_flags
& SHF_ALLOC
) ||
80 shdr
->sh_addr
== 0 || shdr
->sh_size
== 0) {
85 debug("%sing %s @ 0x%08lx (%ld bytes)\n",
86 (shdr
->sh_type
== SHT_NOBITS
) ? "Clear" : "Load",
87 &strtab
[shdr
->sh_name
],
88 (unsigned long)shdr
->sh_addr
,
92 if (shdr
->sh_type
== SHT_NOBITS
) {
93 memset((void *)(uintptr_t)shdr
->sh_addr
, 0,
96 image
= (unsigned char *)addr
+ shdr
->sh_offset
;
97 memcpy((void *)(uintptr_t)shdr
->sh_addr
,
98 (const void *)image
, shdr
->sh_size
);
100 flush_cache(shdr
->sh_addr
, shdr
->sh_size
);
103 return ehdr
->e_entry
;
106 /* Allow ports to override the default behavior */
107 static unsigned long do_bootelf_exec(ulong (*entry
)(int, char * const[]),
108 int argc
, char * const argv
[])
113 * pass address parameter as argv[0] (aka command name),
114 * and all remaining args
116 ret
= entry(argc
, argv
);
122 * Determine if a valid ELF image exists at the given memory location.
123 * First look at the ELF header magic field, then make sure that it is
126 int valid_elf_image(unsigned long addr
)
128 Elf32_Ehdr
*ehdr
; /* Elf header structure pointer */
130 ehdr
= (Elf32_Ehdr
*)addr
;
132 if (!IS_ELF(*ehdr
)) {
133 printf("## No elf image at address 0x%08lx\n", addr
);
137 if (ehdr
->e_type
!= ET_EXEC
) {
138 printf("## Not a 32-bit elf image at address 0x%08lx\n", addr
);
145 /* Interpreter command to boot an arbitrary ELF image from memory */
146 int do_bootelf(cmd_tbl_t
*cmdtp
, int flag
, int argc
, char * const argv
[])
148 unsigned long addr
; /* Address of the ELF image */
149 unsigned long rc
; /* Return value from user code */
151 const char *ep
= env_get("autostart");
154 /* Consume 'bootelf' */
157 /* Check for flag. */
158 if (argc
>= 1 && (argv
[0][0] == '-' && \
159 (argv
[0][1] == 'p' || argv
[0][1] == 's'))) {
164 /* Check for address. */
165 if (argc
>= 1 && strict_strtoul(argv
[0], 16, &addr
) != -EINVAL
) {
166 /* Consume address */
171 if (!valid_elf_image(addr
))
174 if (sload
&& sload
[1] == 'p')
175 addr
= load_elf_image_phdr(addr
);
177 addr
= load_elf_image_shdr(addr
);
179 if (ep
&& !strcmp(ep
, "no"))
182 printf("## Starting application at 0x%08lx ...\n", addr
);
185 * pass address parameter as argv[0] (aka command name),
186 * and all remaining args
188 rc
= do_bootelf_exec((void *)addr
, argc
, argv
);
192 printf("## Application terminated, rc = 0x%lx\n", rc
);
198 * Interpreter command to boot VxWorks from a memory image. The image can
199 * be either an ELF image or a raw binary. Will attempt to setup the
200 * bootline and other parameters correctly.
202 int do_bootvx(cmd_tbl_t
*cmdtp
, int flag
, int argc
, char * const argv
[])
204 unsigned long addr
; /* Address of image */
205 unsigned long bootaddr
; /* Address to put the bootline */
206 char *bootline
; /* Text of the bootline */
207 char *tmp
; /* Temporary char pointer */
208 char build_buf
[128]; /* Buffer for building the bootline */
211 struct e820info
*info
;
212 struct e820entry
*data
;
216 * Check the loadaddr variable.
217 * If we don't know where the image is then we're done.
222 addr
= simple_strtoul(argv
[1], NULL
, 16);
224 #if defined(CONFIG_CMD_NET)
226 * Check to see if we need to tftp the image ourselves
229 if ((argc
== 2) && (strcmp(argv
[1], "tftp") == 0)) {
230 if (net_loop(TFTPGET
) <= 0)
232 printf("Automatic boot of VxWorks image at address 0x%08lx ...\n",
238 * This should equate to
239 * NV_RAM_ADRS + NV_BOOT_OFFSET + NV_ENET_OFFSET
240 * from the VxWorks BSP header files.
241 * This will vary from board to board
243 #if defined(CONFIG_WALNUT)
244 tmp
= (char *)CONFIG_SYS_NVRAM_BASE_ADDR
+ 0x500;
245 eth_env_get_enetaddr("ethaddr", (uchar
*)build_buf
);
246 memcpy(tmp
, &build_buf
[3], 3);
247 #elif defined(CONFIG_SYS_VXWORKS_MAC_PTR)
248 tmp
= (char *)CONFIG_SYS_VXWORKS_MAC_PTR
;
249 eth_env_get_enetaddr("ethaddr", (uchar
*)build_buf
);
250 memcpy(tmp
, build_buf
, 6);
252 puts("## Ethernet MAC address not copied to NV RAM\n");
256 * Use bootaddr to find the location in memory that VxWorks
257 * will look for the bootline string. The default value is
258 * (LOCAL_MEM_LOCAL_ADRS + BOOT_LINE_OFFSET) as defined by
259 * VxWorks BSP. For example, on PowerPC it defaults to 0x4200.
261 tmp
= env_get("bootaddr");
263 printf("## VxWorks bootline address not specified\n");
265 bootaddr
= simple_strtoul(tmp
, NULL
, 16);
268 * Check to see if the bootline is defined in the 'bootargs'
269 * parameter. If it is not defined, we may be able to
270 * construct the info.
272 bootline
= env_get("bootargs");
274 memcpy((void *)bootaddr
, bootline
,
275 max(strlen(bootline
), (size_t)255));
276 flush_cache(bootaddr
, max(strlen(bootline
),
279 tmp
= env_get("bootdev");
281 strcpy(build_buf
, tmp
);
284 printf("## VxWorks boot device not specified\n");
286 tmp
= env_get("bootfile");
288 ptr
+= sprintf(build_buf
+ ptr
,
291 ptr
+= sprintf(build_buf
+ ptr
,
295 * The following parameters are only needed if 'bootdev'
296 * is an ethernet device, otherwise they are optional.
298 tmp
= env_get("ipaddr");
300 ptr
+= sprintf(build_buf
+ ptr
, "e=%s", tmp
);
301 tmp
= env_get("netmask");
303 u32 mask
= env_get_ip("netmask").s_addr
;
304 ptr
+= sprintf(build_buf
+ ptr
,
305 ":%08x ", ntohl(mask
));
307 ptr
+= sprintf(build_buf
+ ptr
, " ");
311 tmp
= env_get("serverip");
313 ptr
+= sprintf(build_buf
+ ptr
, "h=%s ", tmp
);
315 tmp
= env_get("gatewayip");
317 ptr
+= sprintf(build_buf
+ ptr
, "g=%s ", tmp
);
319 tmp
= env_get("hostname");
321 ptr
+= sprintf(build_buf
+ ptr
, "tn=%s ", tmp
);
323 tmp
= env_get("othbootargs");
325 strcpy(build_buf
+ ptr
, tmp
);
329 memcpy((void *)bootaddr
, build_buf
,
330 max(strlen(build_buf
), (size_t)255));
331 flush_cache(bootaddr
, max(strlen(build_buf
),
335 printf("## Using bootline (@ 0x%lx): %s\n", bootaddr
,
341 * Since E820 information is critical to the kernel, if we don't
342 * specify these in the environments, use a default one.
344 tmp
= env_get("e820data");
346 data
= (struct e820entry
*)simple_strtoul(tmp
, NULL
, 16);
348 data
= (struct e820entry
*)VXWORKS_E820_DATA_ADDR
;
349 tmp
= env_get("e820info");
351 info
= (struct e820info
*)simple_strtoul(tmp
, NULL
, 16);
353 info
= (struct e820info
*)VXWORKS_E820_INFO_ADDR
;
355 memset(info
, 0, sizeof(struct e820info
));
356 info
->sign
= E820_SIGNATURE
;
357 info
->entries
= install_e820_map(E820MAX
, data
);
358 info
->addr
= (info
->entries
- 1) * sizeof(struct e820entry
) +
359 VXWORKS_E820_DATA_ADDR
;
363 * If the data at the load address is an elf image, then
364 * treat it like an elf image. Otherwise, assume that it is a
367 if (valid_elf_image(addr
))
368 addr
= load_elf_image_shdr(addr
);
370 puts("## Not an ELF image, assuming binary\n");
372 printf("## Starting vxWorks at 0x%08lx ...\n", addr
);
376 /* VxWorks on x86 uses stack to pass parameters */
377 ((asmlinkage
void (*)(int))addr
)(0);
379 ((void (*)(int))addr
)(0);
382 puts("## vxWorks terminated\n");
388 bootelf
, CONFIG_SYS_MAXARGS
, 0, do_bootelf
,
389 "Boot from an ELF image in memory",
390 "[-p|-s] [address]\n"
391 "\t- load ELF image at [address] via program headers (-p)\n"
392 "\t or via section headers (-s)"
396 bootvx
, 2, 0, do_bootvx
,
397 "Boot vxWorks from an ELF image",
398 " [address] - load address of vxWorks ELF image."