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
18 #include <linux/ctype.h>
23 #if defined(CONFIG_WALNUT) || defined(CONFIG_SYS_VXWORKS_MAC_PTR)
24 DECLARE_GLOBAL_DATA_PTR
;
27 static unsigned long load_elf_image_phdr(unsigned long addr
);
28 static unsigned long load_elf_image_shdr(unsigned long addr
);
30 /* Allow ports to override the default behavior */
32 unsigned long do_bootelf_exec(ulong (*entry
)(int, char * const[]),
33 int argc
, char * const argv
[])
38 * QNX images require the data cache is disabled.
39 * Data cache is already flushed, so just turn it off.
41 int dcache
= dcache_status();
46 * pass address parameter as argv[0] (aka command name),
47 * and all remaining args
49 ret
= entry(argc
, argv
);
57 /* ======================================================================
58 * Determine if a valid ELF image exists at the given memory location.
59 * First looks at the ELF header magic field, the makes sure that it is
60 * executable and makes sure that it is for a PowerPC.
61 * ====================================================================== */
62 int valid_elf_image(unsigned long addr
)
64 Elf32_Ehdr
*ehdr
; /* Elf header structure pointer */
66 /* -------------------------------------------------- */
68 ehdr
= (Elf32_Ehdr
*) addr
;
71 printf("## No elf image at address 0x%08lx\n", addr
);
75 if (ehdr
->e_type
!= ET_EXEC
) {
76 printf("## Not a 32-bit elf image at address 0x%08lx\n", addr
);
81 if (ehdr
->e_machine
!= EM_PPC
) {
82 printf("## Not a PowerPC elf image at address 0x%08lx\n", addr
);
90 /* ======================================================================
91 * Interpreter command to boot an arbitrary ELF image from memory.
92 * ====================================================================== */
93 int do_bootelf(cmd_tbl_t
*cmdtp
, int flag
, int argc
, char * const argv
[])
95 unsigned long addr
; /* Address of the ELF image */
96 unsigned long rc
; /* Return value from user code */
99 /* -------------------------------------------------- */
102 sload
= saddr
= NULL
;
106 } else if (argc
== 2) {
107 if (argv
[1][0] == '-')
114 addr
= simple_strtoul(saddr
, NULL
, 16);
118 if (!valid_elf_image(addr
))
121 if (sload
&& sload
[1] == 'p')
122 addr
= load_elf_image_phdr(addr
);
124 addr
= load_elf_image_shdr(addr
);
126 printf("## Starting application at 0x%08lx ...\n", addr
);
129 * pass address parameter as argv[0] (aka command name),
130 * and all remaining args
132 rc
= do_bootelf_exec((void *)addr
, argc
- 1, argv
+ 1);
136 printf("## Application terminated, rc = 0x%lx\n", rc
);
140 /* ======================================================================
141 * Interpreter command to boot VxWorks from a memory image. The image can
142 * be either an ELF image or a raw binary. Will attempt to setup the
143 * bootline and other parameters correctly.
144 * ====================================================================== */
145 int do_bootvx(cmd_tbl_t
*cmdtp
, int flag
, int argc
, char * const argv
[])
147 unsigned long addr
; /* Address of image */
148 unsigned long bootaddr
; /* Address to put the bootline */
149 char *bootline
; /* Text of the bootline */
150 char *tmp
; /* Temporary char pointer */
151 char build_buf
[128]; /* Buffer for building the bootline */
153 /* ---------------------------------------------------
155 * Check the loadaddr variable.
156 * If we don't know where the image is then we're done.
162 addr
= simple_strtoul(argv
[1], NULL
, 16);
164 #if defined(CONFIG_CMD_NET)
166 * Check to see if we need to tftp the image ourselves before starting
168 if ((argc
== 2) && (strcmp(argv
[1], "tftp") == 0)) {
169 if (NetLoop(TFTPGET
) <= 0)
171 printf("Automatic boot of VxWorks image at address 0x%08lx ...\n",
176 /* This should equate
177 * to NV_RAM_ADRS + NV_BOOT_OFFSET + NV_ENET_OFFSET
178 * from the VxWorks BSP header files.
179 * This will vary from board to board
182 #if defined(CONFIG_WALNUT)
183 tmp
= (char *) CONFIG_SYS_NVRAM_BASE_ADDR
+ 0x500;
184 eth_getenv_enetaddr("ethaddr", (uchar
*)build_buf
);
185 memcpy(tmp
, &build_buf
[3], 3);
186 #elif defined(CONFIG_SYS_VXWORKS_MAC_PTR)
187 tmp
= (char *) CONFIG_SYS_VXWORKS_MAC_PTR
;
188 eth_getenv_enetaddr("ethaddr", (uchar
*)build_buf
);
189 memcpy(tmp
, build_buf
, 6);
191 puts("## Ethernet MAC address not copied to NV RAM\n");
195 * Use bootaddr to find the location in memory that VxWorks
196 * will look for the bootline string. The default value for
197 * PowerPC is LOCAL_MEM_LOCAL_ADRS + BOOT_LINE_OFFSET which
200 tmp
= getenv("bootaddr");
202 bootaddr
= CONFIG_SYS_VXWORKS_BOOT_ADDR
;
204 bootaddr
= simple_strtoul(tmp
, NULL
, 16);
207 * Check to see if the bootline is defined in the 'bootargs'
208 * parameter. If it is not defined, we may be able to
211 bootline
= getenv("bootargs");
213 memcpy((void *) bootaddr
, bootline
,
214 max(strlen(bootline
), 255));
215 flush_cache(bootaddr
, max(strlen(bootline
), 255));
217 sprintf(build_buf
, CONFIG_SYS_VXWORKS_BOOT_DEVICE
);
218 tmp
= getenv("bootfile");
220 sprintf(&build_buf
[strlen(build_buf
)],
221 "%s:%s ", CONFIG_SYS_VXWORKS_SERVERNAME
, tmp
);
223 sprintf(&build_buf
[strlen(build_buf
)],
224 "%s:file ", CONFIG_SYS_VXWORKS_SERVERNAME
);
226 tmp
= getenv("ipaddr");
228 sprintf(&build_buf
[strlen(build_buf
)], "e=%s ", tmp
);
230 tmp
= getenv("serverip");
232 sprintf(&build_buf
[strlen(build_buf
)], "h=%s ", tmp
);
234 tmp
= getenv("hostname");
236 sprintf(&build_buf
[strlen(build_buf
)], "tn=%s ", tmp
);
238 #ifdef CONFIG_SYS_VXWORKS_ADD_PARAMS
239 sprintf(&build_buf
[strlen(build_buf
)],
240 CONFIG_SYS_VXWORKS_ADD_PARAMS
);
243 memcpy((void *) bootaddr
, build_buf
,
244 max(strlen(build_buf
), 255));
245 flush_cache(bootaddr
, max(strlen(build_buf
), 255));
249 * If the data at the load address is an elf image, then
250 * treat it like an elf image. Otherwise, assume that it is a
254 if (valid_elf_image(addr
)) {
255 addr
= load_elf_image_shdr(addr
);
257 puts("## Not an ELF image, assuming binary\n");
258 /* leave addr as load_addr */
261 printf("## Using bootline (@ 0x%lx): %s\n", bootaddr
,
263 printf("## Starting vxWorks at 0x%08lx ...\n", addr
);
266 ((void (*)(int)) addr
) (0);
268 puts("## vxWorks terminated\n");
272 /* ======================================================================
273 * A very simple elf loader, assumes the image is valid, returns the
274 * entry point address.
275 * ====================================================================== */
276 static unsigned long load_elf_image_phdr(unsigned long addr
)
278 Elf32_Ehdr
*ehdr
; /* Elf header structure pointer */
279 Elf32_Phdr
*phdr
; /* Program header structure pointer */
282 ehdr
= (Elf32_Ehdr
*) addr
;
283 phdr
= (Elf32_Phdr
*) (addr
+ ehdr
->e_phoff
);
285 /* Load each program header */
286 for (i
= 0; i
< ehdr
->e_phnum
; ++i
) {
287 void *dst
= (void *)(uintptr_t) phdr
->p_paddr
;
288 void *src
= (void *) addr
+ phdr
->p_offset
;
289 debug("Loading phdr %i to 0x%p (%i bytes)\n",
290 i
, dst
, phdr
->p_filesz
);
292 memcpy(dst
, src
, phdr
->p_filesz
);
293 if (phdr
->p_filesz
!= phdr
->p_memsz
)
294 memset(dst
+ phdr
->p_filesz
, 0x00,
295 phdr
->p_memsz
- phdr
->p_filesz
);
296 flush_cache((unsigned long)dst
, phdr
->p_filesz
);
300 return ehdr
->e_entry
;
303 static unsigned long load_elf_image_shdr(unsigned long addr
)
305 Elf32_Ehdr
*ehdr
; /* Elf header structure pointer */
306 Elf32_Shdr
*shdr
; /* Section header structure pointer */
307 unsigned char *strtab
= 0; /* String table pointer */
308 unsigned char *image
; /* Binary image pointer */
309 int i
; /* Loop counter */
311 /* -------------------------------------------------- */
313 ehdr
= (Elf32_Ehdr
*) addr
;
315 /* Find the section header string table for output info */
316 shdr
= (Elf32_Shdr
*) (addr
+ ehdr
->e_shoff
+
317 (ehdr
->e_shstrndx
* sizeof(Elf32_Shdr
)));
319 if (shdr
->sh_type
== SHT_STRTAB
)
320 strtab
= (unsigned char *) (addr
+ shdr
->sh_offset
);
322 /* Load each appropriate section */
323 for (i
= 0; i
< ehdr
->e_shnum
; ++i
) {
324 shdr
= (Elf32_Shdr
*) (addr
+ ehdr
->e_shoff
+
325 (i
* sizeof(Elf32_Shdr
)));
327 if (!(shdr
->sh_flags
& SHF_ALLOC
)
328 || shdr
->sh_addr
== 0 || shdr
->sh_size
== 0) {
333 debug("%sing %s @ 0x%08lx (%ld bytes)\n",
334 (shdr
->sh_type
== SHT_NOBITS
) ?
336 &strtab
[shdr
->sh_name
],
337 (unsigned long) shdr
->sh_addr
,
338 (long) shdr
->sh_size
);
341 if (shdr
->sh_type
== SHT_NOBITS
) {
342 memset((void *)(uintptr_t) shdr
->sh_addr
, 0,
345 image
= (unsigned char *) addr
+ shdr
->sh_offset
;
346 memcpy((void *)(uintptr_t) shdr
->sh_addr
,
347 (const void *) image
,
350 flush_cache(shdr
->sh_addr
, shdr
->sh_size
);
353 return ehdr
->e_entry
;
356 /* ====================================================================== */
358 bootelf
, 3, 0, do_bootelf
,
359 "Boot from an ELF image in memory",
360 "[-p|-s] [address]\n"
361 "\t- load ELF image at [address] via program headers (-p)\n"
362 "\t or via section headers (-s)"
366 bootvx
, 2, 0, do_bootvx
,
367 "Boot vxWorks from an ELF image",
368 " [address] - load address of vxWorks ELF image."