2 * Copyright (C) Paul Mackerras 1997.
4 * Updates for PPC64 by Todd Inglett, Dave Engebretsen & Peter Bergner.
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License
8 * as published by the Free Software Foundation; either version
9 * 2 of the License, or (at your option) any later version.
11 #include "ppc32-types.h"
13 #include <linux/elf.h>
14 #include <linux/string.h>
15 #include <asm/processor.h>
17 #include <asm/bootinfo.h>
19 extern void *finddevice(const char *);
20 extern int getprop(void *, const char *, void *, int);
21 extern void printk(char *fmt
, ...);
22 extern void printf(const char *fmt
, ...);
23 extern int sprintf(char *buf
, const char *fmt
, ...);
24 void gunzip(void *, int, unsigned char *, int *);
25 void *claim(unsigned int, unsigned int, unsigned int);
26 void flush_cache(void *, unsigned long);
28 extern void exit(void);
30 unsigned long strlen(const char *s
);
31 void *memmove(void *dest
, const void *src
, unsigned long n
);
32 void *memcpy(void *dest
, const void *src
, unsigned long n
);
34 /* Value picked to match that used by yaboot */
35 #define PROG_START 0x01400000
36 #define RAM_END (256<<20) // Fixme: use OF */
39 char *begin_avail
, *end_avail
;
41 unsigned int heap_use
;
42 unsigned int heap_max
;
45 extern char _vmlinux_start
[];
46 extern char _vmlinux_end
[];
47 extern char _initrd_start
[];
48 extern char _initrd_end
[];
49 extern unsigned long vmlinux_filesize
;
50 extern unsigned long vmlinux_memsize
;
55 unsigned long memsize
;
57 struct addr_range vmlinux
= {0, 0, 0};
58 struct addr_range vmlinuz
= {0, 0, 0};
59 struct addr_range initrd
= {0, 0, 0};
61 static char scratch
[128<<10]; /* 128kB of scratch space for gunzip */
63 typedef void (*kernel_entry_t
)( unsigned long,
78 static unsigned long claim_base
= PROG_START
;
80 static unsigned long try_claim(unsigned long size
)
82 unsigned long addr
= 0;
84 for(; claim_base
< RAM_END
; claim_base
+= 0x100000) {
86 printf(" trying: 0x%08lx\n\r", claim_base
);
88 addr
= (unsigned long)claim(claim_base
, size
, 0);
89 if ((void *)addr
!= (void *)-1)
94 claim_base
= PAGE_ALIGN(claim_base
+ size
);
98 void start(unsigned long a1
, unsigned long a2
, void *promptr
)
101 kernel_entry_t kernel_entry
;
105 prom
= (int (*)(void *)) promptr
;
106 chosen_handle
= finddevice("/chosen");
107 if (chosen_handle
== (void *) -1)
109 if (getprop(chosen_handle
, "stdout", &stdout
, sizeof(stdout
)) != 4)
112 if (getprop(chosen_handle
, "stdin", &stdin
, sizeof(stdin
)) != 4)
115 printf("\n\rzImage starting: loaded at 0x%x\n\r", (unsigned)_start
);
118 * Now we try to claim some memory for the kernel itself
119 * our "vmlinux_memsize" is the memory footprint in RAM, _HOWEVER_, what
120 * our Makefile stuffs in is an image containing all sort of junk including
121 * an ELF header. We need to do some calculations here to find the right
122 * size... In practice we add 1Mb, that is enough, but we should really
123 * consider fixing the Makefile to put a _raw_ kernel in there !
125 vmlinux_memsize
+= 0x100000;
126 printf("Allocating 0x%lx bytes for kernel ...\n\r", vmlinux_memsize
);
127 vmlinux
.addr
= try_claim(vmlinux_memsize
);
128 if (vmlinux
.addr
== 0) {
129 printf("Can't allocate memory for kernel image !\n\r");
132 vmlinuz
.addr
= (unsigned long)_vmlinux_start
;
133 vmlinuz
.size
= (unsigned long)(_vmlinux_end
- _vmlinux_start
);
134 vmlinux
.size
= PAGE_ALIGN(vmlinux_filesize
);
135 vmlinux
.memsize
= vmlinux_memsize
;
138 * Now we try to claim memory for the initrd (and copy it there)
140 initrd
.size
= (unsigned long)(_initrd_end
- _initrd_start
);
141 initrd
.memsize
= initrd
.size
;
142 if ( initrd
.size
> 0 ) {
143 printf("Allocating 0x%lx bytes for initrd ...\n\r", initrd
.size
);
144 initrd
.addr
= try_claim(initrd
.size
);
145 if (initrd
.addr
== 0) {
146 printf("Can't allocate memory for initial ramdisk !\n\r");
151 printf("initial ramdisk moving 0x%lx <- 0x%lx (%lx bytes)\n\r",
152 initrd
.addr
, (unsigned long)_initrd_start
, initrd
.size
);
153 memmove((void *)initrd
.addr
, (void *)_initrd_start
, initrd
.size
);
154 printf("initrd head: 0x%lx\n\r", *((u32
*)initrd
.addr
));
157 /* Eventually gunzip the kernel */
158 if (*(unsigned short *)vmlinuz
.addr
== 0x1f8b) {
161 begin_avail
= avail_high
= avail_ram
;
162 end_avail
= scratch
+ sizeof(scratch
);
163 printf("gunzipping (0x%lx <- 0x%lx:0x%0lx)...",
164 vmlinux
.addr
, vmlinuz
.addr
, vmlinuz
.addr
+vmlinuz
.size
);
166 gunzip((void *)vmlinux
.addr
, vmlinux
.size
,
167 (unsigned char *)vmlinuz
.addr
, &len
);
168 printf("done 0x%lx bytes\n\r", len
);
169 printf("0x%x bytes of heap consumed, max in use 0x%x\n\r",
170 (unsigned)(avail_high
- begin_avail
), heap_max
);
172 memmove((void *)vmlinux
.addr
,(void *)vmlinuz
.addr
,vmlinuz
.size
);
175 /* Skip over the ELF header */
176 elf64
= (Elf64_Ehdr
*)vmlinux
.addr
;
177 if ( elf64
->e_ident
[EI_MAG0
] != ELFMAG0
||
178 elf64
->e_ident
[EI_MAG1
] != ELFMAG1
||
179 elf64
->e_ident
[EI_MAG2
] != ELFMAG2
||
180 elf64
->e_ident
[EI_MAG3
] != ELFMAG3
||
181 elf64
->e_ident
[EI_CLASS
] != ELFCLASS64
||
182 elf64
->e_ident
[EI_DATA
] != ELFDATA2MSB
||
183 elf64
->e_type
!= ET_EXEC
||
184 elf64
->e_machine
!= EM_PPC64
)
186 printf("Error: not a valid PPC64 ELF file!\n\r");
190 elf64ph
= (Elf64_Phdr
*)((unsigned long)elf64
+
191 (unsigned long)elf64
->e_phoff
);
192 for(i
=0; i
< (unsigned int)elf64
->e_phnum
;i
++,elf64ph
++) {
193 if (elf64ph
->p_type
== PT_LOAD
&& elf64ph
->p_offset
!= 0)
197 printf("... skipping 0x%lx bytes of ELF header\n\r",
198 (unsigned long)elf64ph
->p_offset
);
200 vmlinux
.addr
+= (unsigned long)elf64ph
->p_offset
;
201 vmlinux
.size
-= (unsigned long)elf64ph
->p_offset
;
203 flush_cache((void *)vmlinux
.addr
, vmlinux
.size
);
206 printf("initrd head: 0x%lx\n\r", *((u32
*)initrd
.addr
));
208 kernel_entry
= (kernel_entry_t
)vmlinux
.addr
;
210 printf( "kernel:\n\r"
211 " entry addr = 0x%lx\n\r"
215 " bi_recs = 0x%lx,\n\r",
216 (unsigned long)kernel_entry
, a1
, a2
,
217 (unsigned long)prom
, NULL
);
220 kernel_entry( a1
, a2
, prom
, NULL
);
222 printf("Error: Linux kernel returned to zImage bootloader!\n\r");
230 struct memchunk
*next
;
233 static struct memchunk
*freechunks
;
235 void *zalloc(void *x
, unsigned items
, unsigned size
)
238 struct memchunk
**mpp
, *mp
;
241 size
= _ALIGN(size
, sizeof(struct memchunk
));
243 if (heap_use
> heap_max
)
245 for (mpp
= &freechunks
; (mp
= *mpp
) != 0; mpp
= &mp
->next
) {
246 if (mp
->size
== size
) {
253 if (avail_ram
> avail_high
)
254 avail_high
= avail_ram
;
255 if (avail_ram
> end_avail
) {
256 printf("oops... out of memory\n\r");
262 void zfree(void *x
, void *addr
, unsigned nb
)
264 struct memchunk
*mp
= addr
;
266 nb
= _ALIGN(nb
, sizeof(struct memchunk
));
268 if (avail_ram
== addr
+ nb
) {
273 mp
->next
= freechunks
;
278 #define EXTRA_FIELD 4
281 #define RESERVED 0xe0
285 void gunzip(void *dst
, int dstlen
, unsigned char *src
, int *lenp
)
293 if (src
[2] != DEFLATED
|| (flags
& RESERVED
) != 0) {
294 printf("bad gzipped data\n\r");
297 if ((flags
& EXTRA_FIELD
) != 0)
298 i
= 12 + src
[10] + (src
[11] << 8);
299 if ((flags
& ORIG_NAME
) != 0)
300 while (src
[i
++] != 0)
302 if ((flags
& COMMENT
) != 0)
303 while (src
[i
++] != 0)
305 if ((flags
& HEAD_CRC
) != 0)
308 printf("gunzip: ran out of data in header\n\r");
314 r
= inflateInit2(&s
, -MAX_WBITS
);
316 printf("inflateInit2 returned %d\n\r", r
);
320 s
.avail_in
= *lenp
- i
;
322 s
.avail_out
= dstlen
;
323 r
= inflate(&s
, Z_FINISH
);
324 if (r
!= Z_OK
&& r
!= Z_STREAM_END
) {
325 printf("inflate returned %d msg: %s\n\r", r
, s
.msg
);
328 *lenp
= s
.next_out
- (unsigned char *) dst
;