1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16#include <common.h>
17#include <command.h>
18#include <linux/ctype.h>
19#include <net.h>
20#include <elf.h>
21#include <vxworks.h>
22
23#if defined(CONFIG_WALNUT) || defined(CONFIG_SYS_VXWORKS_MAC_PTR)
24DECLARE_GLOBAL_DATA_PTR;
25#endif
26
27int valid_elf_image (unsigned long addr);
28unsigned long load_elf_image (unsigned long addr);
29
30
31__attribute__((weak))
32unsigned long do_bootelf_exec (ulong (*entry)(int, char *[]), int argc, char *argv[])
33{
34 unsigned long ret;
35
36
37
38
39
40 int dcache = dcache_status ();
41 if (dcache)
42 dcache_disable ();
43
44
45
46
47
48 ret = entry (argc, argv);
49
50 if (dcache)
51 dcache_enable ();
52
53 return ret;
54}
55
56
57
58
59int do_bootelf (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
60{
61 unsigned long addr;
62 unsigned long rc;
63
64
65 int rcode = 0;
66
67 if (argc < 2)
68 addr = load_addr;
69 else
70 addr = simple_strtoul (argv[1], NULL, 16);
71
72 if (!valid_elf_image (addr))
73 return 1;
74
75 addr = load_elf_image (addr);
76
77 printf ("## Starting application at 0x%08lx ...\n", addr);
78
79
80
81
82
83 rc = do_bootelf_exec ((void *)addr, argc - 1, argv + 1);
84 if (rc != 0)
85 rcode = 1;
86
87 printf ("## Application terminated, rc = 0x%lx\n", rc);
88 return rcode;
89}
90
91
92
93
94
95
96int do_bootvx (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
97{
98 unsigned long addr;
99 unsigned long bootaddr;
100 char *bootline;
101 char *tmp;
102 char build_buf[128];
103
104
105
106
107
108
109
110 if (argc < 2)
111 addr = load_addr;
112 else
113 addr = simple_strtoul (argv[1], NULL, 16);
114
115#if defined(CONFIG_CMD_NET)
116
117
118 if ((argc == 2) && (strcmp (argv[1], "tftp") == 0)) {
119 if (NetLoop (TFTP) <= 0)
120 return 1;
121 printf ("Automatic boot of VxWorks image at address 0x%08lx ... \n",
122 addr);
123 }
124#endif
125
126
127
128
129
130
131
132#if defined(CONFIG_WALNUT)
133 tmp = (char *) CONFIG_SYS_NVRAM_BASE_ADDR + 0x500;
134 memcpy ((char *) tmp, (char *) &gd->bd->bi_enetaddr[3], 3);
135#elif defined(CONFIG_SYS_VXWORKS_MAC_PTR)
136 tmp = (char *) CONFIG_SYS_VXWORKS_MAC_PTR;
137 memcpy ((char *) tmp, (char *) &gd->bd->bi_enetaddr[0], 6);
138#else
139 puts ("## Ethernet MAC address not copied to NV RAM\n");
140#endif
141
142
143
144
145
146
147
148
149 if ((tmp = getenv ("bootaddr")) == NULL)
150 bootaddr = CONFIG_SYS_VXWORKS_BOOT_ADDR;
151 else
152 bootaddr = simple_strtoul (tmp, NULL, 16);
153
154
155
156
157
158
159
160 if ((bootline = getenv ("bootargs")) != NULL) {
161 memcpy ((void *) bootaddr, bootline,
162 max (strlen (bootline), 255));
163 flush_cache (bootaddr, max (strlen (bootline), 255));
164 } else {
165
166
167 sprintf (build_buf, CONFIG_SYS_VXWORKS_BOOT_DEVICE);
168 if ((tmp = getenv ("bootfile")) != NULL) {
169 sprintf (&build_buf[strlen (build_buf)],
170 "%s:%s ", CONFIG_SYS_VXWORKS_SERVERNAME, tmp);
171 } else {
172 sprintf (&build_buf[strlen (build_buf)],
173 "%s:file ", CONFIG_SYS_VXWORKS_SERVERNAME);
174 }
175
176 if ((tmp = getenv ("ipaddr")) != NULL) {
177 sprintf (&build_buf[strlen (build_buf)], "e=%s ", tmp);
178 }
179
180 if ((tmp = getenv ("serverip")) != NULL) {
181 sprintf (&build_buf[strlen (build_buf)], "h=%s ", tmp);
182 }
183
184 if ((tmp = getenv ("hostname")) != NULL) {
185 sprintf (&build_buf[strlen (build_buf)], "tn=%s ", tmp);
186 }
187#ifdef CONFIG_SYS_VXWORKS_ADD_PARAMS
188 sprintf (&build_buf[strlen (build_buf)],
189 CONFIG_SYS_VXWORKS_ADD_PARAMS);
190#endif
191
192 memcpy ((void *) bootaddr, build_buf,
193 max (strlen (build_buf), 255));
194 flush_cache (bootaddr, max (strlen (build_buf), 255));
195 }
196
197
198
199
200
201
202
203 if (valid_elf_image (addr)) {
204 addr = load_elf_image (addr);
205 } else {
206 puts ("## Not an ELF image, assuming binary\n");
207
208 }
209
210 printf ("## Using bootline (@ 0x%lx): %s\n", bootaddr,
211 (char *) bootaddr);
212 printf ("## Starting vxWorks at 0x%08lx ...\n", addr);
213
214 ((void (*)(void)) addr) ();
215
216 puts ("## vxWorks terminated\n");
217 return 1;
218}
219
220
221
222
223
224
225int valid_elf_image (unsigned long addr)
226{
227 Elf32_Ehdr *ehdr;
228
229
230
231 ehdr = (Elf32_Ehdr *) addr;
232
233 if (!IS_ELF (*ehdr)) {
234 printf ("## No elf image at address 0x%08lx\n", addr);
235 return 0;
236 }
237
238 if (ehdr->e_type != ET_EXEC) {
239 printf ("## Not a 32-bit elf image at address 0x%08lx\n", addr);
240 return 0;
241 }
242
243#if 0
244 if (ehdr->e_machine != EM_PPC) {
245 printf ("## Not a PowerPC elf image at address 0x%08lx\n",
246 addr);
247 return 0;
248 }
249#endif
250
251 return 1;
252}
253
254
255
256
257
258unsigned long load_elf_image (unsigned long addr)
259{
260 Elf32_Ehdr *ehdr;
261 Elf32_Shdr *shdr;
262 unsigned char *strtab = 0;
263 unsigned char *image;
264 int i;
265
266
267
268 ehdr = (Elf32_Ehdr *) addr;
269
270
271 shdr = (Elf32_Shdr *) (addr + ehdr->e_shoff +
272 (ehdr->e_shstrndx * sizeof (Elf32_Shdr)));
273
274 if (shdr->sh_type == SHT_STRTAB)
275 strtab = (unsigned char *) (addr + shdr->sh_offset);
276
277
278 for (i = 0; i < ehdr->e_shnum; ++i) {
279 shdr = (Elf32_Shdr *) (addr + ehdr->e_shoff +
280 (i * sizeof (Elf32_Shdr)));
281
282 if (!(shdr->sh_flags & SHF_ALLOC)
283 || shdr->sh_addr == 0 || shdr->sh_size == 0) {
284 continue;
285 }
286
287 if (strtab) {
288 printf ("%sing %s @ 0x%08lx (%ld bytes)\n",
289 (shdr->sh_type == SHT_NOBITS) ?
290 "Clear" : "Load",
291 &strtab[shdr->sh_name],
292 (unsigned long) shdr->sh_addr,
293 (long) shdr->sh_size);
294 }
295
296 if (shdr->sh_type == SHT_NOBITS) {
297 memset ((void *)shdr->sh_addr, 0, shdr->sh_size);
298 } else {
299 image = (unsigned char *) addr + shdr->sh_offset;
300 memcpy ((void *) shdr->sh_addr,
301 (const void *) image,
302 shdr->sh_size);
303 }
304 flush_cache (shdr->sh_addr, shdr->sh_size);
305 }
306
307 return ehdr->e_entry;
308}
309
310
311U_BOOT_CMD(
312 bootelf, 2, 0, do_bootelf,
313 "Boot from an ELF image in memory",
314 " [address] - load address of ELF image.\n"
315);
316
317U_BOOT_CMD(
318 bootvx, 2, 0, do_bootvx,
319 "Boot vxWorks from an ELF image",
320 " [address] - load address of vxWorks ELF image.\n"
321);
322