194b212c2SPaul Mackerras /* 294b212c2SPaul Mackerras * Copyright (C) Paul Mackerras 1997. 394b212c2SPaul Mackerras * 494b212c2SPaul Mackerras * Updates for PPC64 by Todd Inglett, Dave Engebretsen & Peter Bergner. 594b212c2SPaul Mackerras * 694b212c2SPaul Mackerras * This program is free software; you can redistribute it and/or 794b212c2SPaul Mackerras * modify it under the terms of the GNU General Public License 894b212c2SPaul Mackerras * as published by the Free Software Foundation; either version 994b212c2SPaul Mackerras * 2 of the License, or (at your option) any later version. 1094b212c2SPaul Mackerras */ 1194b212c2SPaul Mackerras #include <stdarg.h> 1294b212c2SPaul Mackerras #include <stddef.h> 1394b212c2SPaul Mackerras #include "elf.h" 1494b212c2SPaul Mackerras #include "page.h" 1594b212c2SPaul Mackerras #include "string.h" 1694b212c2SPaul Mackerras #include "stdio.h" 17b2c5f619SMark A. Greer #include "ops.h" 18ad9d2716SDavid Gibson #include "gunzip_util.h" 19b2c5f619SMark A. Greer #include "flatdevtree.h" 20e5a2072bSDavid Gibson #include "reg.h" 2194b212c2SPaul Mackerras 2294b212c2SPaul Mackerras extern char _start[]; 2394b212c2SPaul Mackerras extern char __bss_start[]; 2494b212c2SPaul Mackerras extern char _end[]; 2594b212c2SPaul Mackerras extern char _vmlinux_start[]; 2694b212c2SPaul Mackerras extern char _vmlinux_end[]; 2794b212c2SPaul Mackerras extern char _initrd_start[]; 2894b212c2SPaul Mackerras extern char _initrd_end[]; 29c888554bSMark A. Greer extern char _dtb_start[]; 30c888554bSMark A. Greer extern char _dtb_end[]; 3194b212c2SPaul Mackerras 32ad9d2716SDavid Gibson static struct gunzip_state gzstate; 33ad9d2716SDavid Gibson 3494b212c2SPaul Mackerras struct addr_range { 3579c85419SDavid Gibson void *addr; 3694b212c2SPaul Mackerras unsigned long size; 3794b212c2SPaul Mackerras }; 3894b212c2SPaul Mackerras 3979c85419SDavid Gibson struct elf_info { 4079c85419SDavid Gibson unsigned long loadsize; 4179c85419SDavid Gibson unsigned long memsize; 4279c85419SDavid Gibson unsigned long elfoffset; 4379c85419SDavid Gibson }; 4494b212c2SPaul Mackerras 45b2c5f619SMark A. Greer typedef void (*kernel_entry_t)(unsigned long, unsigned long, void *); 4694b212c2SPaul Mackerras 4794b212c2SPaul Mackerras #undef DEBUG 4894b212c2SPaul Mackerras 4979c85419SDavid Gibson static int parse_elf64(void *hdr, struct elf_info *info) 5094b212c2SPaul Mackerras { 5194b212c2SPaul Mackerras Elf64_Ehdr *elf64 = hdr; 5294b212c2SPaul Mackerras Elf64_Phdr *elf64ph; 5394b212c2SPaul Mackerras unsigned int i; 5494b212c2SPaul Mackerras 5594b212c2SPaul Mackerras if (!(elf64->e_ident[EI_MAG0] == ELFMAG0 && 5694b212c2SPaul Mackerras elf64->e_ident[EI_MAG1] == ELFMAG1 && 5794b212c2SPaul Mackerras elf64->e_ident[EI_MAG2] == ELFMAG2 && 5894b212c2SPaul Mackerras elf64->e_ident[EI_MAG3] == ELFMAG3 && 5994b212c2SPaul Mackerras elf64->e_ident[EI_CLASS] == ELFCLASS64 && 6094b212c2SPaul Mackerras elf64->e_ident[EI_DATA] == ELFDATA2MSB && 6194b212c2SPaul Mackerras elf64->e_type == ET_EXEC && 6294b212c2SPaul Mackerras elf64->e_machine == EM_PPC64)) 6394b212c2SPaul Mackerras return 0; 6494b212c2SPaul Mackerras 6594b212c2SPaul Mackerras elf64ph = (Elf64_Phdr *)((unsigned long)elf64 + 6694b212c2SPaul Mackerras (unsigned long)elf64->e_phoff); 6794b212c2SPaul Mackerras for (i = 0; i < (unsigned int)elf64->e_phnum; i++, elf64ph++) 68158daa4cSOlaf Hering if (elf64ph->p_type == PT_LOAD) 6994b212c2SPaul Mackerras break; 7094b212c2SPaul Mackerras if (i >= (unsigned int)elf64->e_phnum) 7194b212c2SPaul Mackerras return 0; 7294b212c2SPaul Mackerras 7379c85419SDavid Gibson info->loadsize = (unsigned long)elf64ph->p_filesz; 7479c85419SDavid Gibson info->memsize = (unsigned long)elf64ph->p_memsz; 7579c85419SDavid Gibson info->elfoffset = (unsigned long)elf64ph->p_offset; 7666a45dd3SPaul Mackerras 7794b212c2SPaul Mackerras return 1; 7894b212c2SPaul Mackerras } 7994b212c2SPaul Mackerras 8079c85419SDavid Gibson static int parse_elf32(void *hdr, struct elf_info *info) 8194b212c2SPaul Mackerras { 8294b212c2SPaul Mackerras Elf32_Ehdr *elf32 = hdr; 8394b212c2SPaul Mackerras Elf32_Phdr *elf32ph; 8494b212c2SPaul Mackerras unsigned int i; 8594b212c2SPaul Mackerras 8694b212c2SPaul Mackerras if (!(elf32->e_ident[EI_MAG0] == ELFMAG0 && 8794b212c2SPaul Mackerras elf32->e_ident[EI_MAG1] == ELFMAG1 && 8894b212c2SPaul Mackerras elf32->e_ident[EI_MAG2] == ELFMAG2 && 8994b212c2SPaul Mackerras elf32->e_ident[EI_MAG3] == ELFMAG3 && 9094b212c2SPaul Mackerras elf32->e_ident[EI_CLASS] == ELFCLASS32 && 9194b212c2SPaul Mackerras elf32->e_ident[EI_DATA] == ELFDATA2MSB && 9294b212c2SPaul Mackerras elf32->e_type == ET_EXEC && 9394b212c2SPaul Mackerras elf32->e_machine == EM_PPC)) 9494b212c2SPaul Mackerras return 0; 9594b212c2SPaul Mackerras 9694b212c2SPaul Mackerras elf32ph = (Elf32_Phdr *) ((unsigned long)elf32 + elf32->e_phoff); 9794b212c2SPaul Mackerras for (i = 0; i < elf32->e_phnum; i++, elf32ph++) 98158daa4cSOlaf Hering if (elf32ph->p_type == PT_LOAD) 9994b212c2SPaul Mackerras break; 10094b212c2SPaul Mackerras if (i >= elf32->e_phnum) 10194b212c2SPaul Mackerras return 0; 10294b212c2SPaul Mackerras 10379c85419SDavid Gibson info->loadsize = elf32ph->p_filesz; 10479c85419SDavid Gibson info->memsize = elf32ph->p_memsz; 10579c85419SDavid Gibson info->elfoffset = elf32ph->p_offset; 10694b212c2SPaul Mackerras return 1; 10794b212c2SPaul Mackerras } 10894b212c2SPaul Mackerras 10979c85419SDavid Gibson static struct addr_range prep_kernel(void) 11030d8caf7Smostrows@watson.ibm.com { 11179c85419SDavid Gibson char elfheader[256]; 11279c85419SDavid Gibson void *vmlinuz_addr = _vmlinux_start; 11379c85419SDavid Gibson unsigned long vmlinuz_size = _vmlinux_end - _vmlinux_start; 11479c85419SDavid Gibson void *addr = 0; 11579c85419SDavid Gibson struct elf_info ei; 11630d8caf7Smostrows@watson.ibm.com int len; 11766a45dd3SPaul Mackerras 11894b212c2SPaul Mackerras /* gunzip the ELF header of the kernel */ 11979c85419SDavid Gibson gunzip_start(&gzstate, vmlinuz_addr, vmlinuz_size); 120ad9d2716SDavid Gibson gunzip_exactly(&gzstate, elfheader, sizeof(elfheader)); 12194b212c2SPaul Mackerras 1226a923216SMilton Miller if (!parse_elf64(elfheader, &ei) && !parse_elf32(elfheader, &ei)) 1236a923216SMilton Miller fatal("Error: not a valid PPC32 or PPC64 ELF file!\n\r"); 1246a923216SMilton Miller 125b2c5f619SMark A. Greer if (platform_ops.image_hdr) 126b2c5f619SMark A. Greer platform_ops.image_hdr(elfheader); 12794b212c2SPaul Mackerras 128ad9d2716SDavid Gibson /* We need to alloc the memsize: gzip will expand the kernel 129ad9d2716SDavid Gibson * text/data, then possible rubbish we don't care about. But 130ad9d2716SDavid Gibson * the kernel bss must be claimed (it will be zero'd by the 131ad9d2716SDavid Gibson * kernel itself) 13294b212c2SPaul Mackerras */ 13379c85419SDavid Gibson printf("Allocating 0x%lx bytes for kernel ...\n\r", ei.memsize); 13479c85419SDavid Gibson 13579c85419SDavid Gibson if (platform_ops.vmlinux_alloc) { 13679c85419SDavid Gibson addr = platform_ops.vmlinux_alloc(ei.memsize); 13779c85419SDavid Gibson } else { 1386a923216SMilton Miller if ((unsigned long)_start < ei.memsize) 1396a923216SMilton Miller fatal("Insufficient memory for kernel at address 0!" 140fae59c39SDavid Gibson " (_start=%p)\n\r", _start); 14179c85419SDavid Gibson } 14279c85419SDavid Gibson 14379c85419SDavid Gibson /* Finally, gunzip the kernel */ 14479c85419SDavid Gibson printf("gunzipping (0x%p <- 0x%p:0x%p)...", addr, 14579c85419SDavid Gibson vmlinuz_addr, vmlinuz_addr+vmlinuz_size); 14679c85419SDavid Gibson /* discard up to the actual load data */ 14779c85419SDavid Gibson gunzip_discard(&gzstate, ei.elfoffset - sizeof(elfheader)); 14879c85419SDavid Gibson len = gunzip_finish(&gzstate, addr, ei.memsize); 149fae59c39SDavid Gibson printf("done 0x%x bytes\n\r", len); 15079c85419SDavid Gibson 15179c85419SDavid Gibson flush_cache(addr, ei.loadsize); 15279c85419SDavid Gibson 15379c85419SDavid Gibson return (struct addr_range){addr, ei.memsize}; 15479c85419SDavid Gibson } 15579c85419SDavid Gibson 156*27fbaa97SDavid Gibson static struct addr_range prep_initrd(struct addr_range vmlinux, void *chosen, 15779c85419SDavid Gibson unsigned long initrd_addr, 15879c85419SDavid Gibson unsigned long initrd_size) 15979c85419SDavid Gibson { 16079c85419SDavid Gibson /* If we have an image attached to us, it overrides anything 16179c85419SDavid Gibson * supplied by the loader. */ 16279c85419SDavid Gibson if (_initrd_end > _initrd_start) { 16379c85419SDavid Gibson printf("Attached initrd image at 0x%p-0x%p\n\r", 16479c85419SDavid Gibson _initrd_start, _initrd_end); 16579c85419SDavid Gibson initrd_addr = (unsigned long)_initrd_start; 16679c85419SDavid Gibson initrd_size = _initrd_end - _initrd_start; 16779c85419SDavid Gibson } else if (initrd_size > 0) { 16879c85419SDavid Gibson printf("Using loader supplied ramdisk at 0x%lx-0x%lx\n\r", 16979c85419SDavid Gibson initrd_addr, initrd_addr + initrd_size); 17079c85419SDavid Gibson } 17179c85419SDavid Gibson 17279c85419SDavid Gibson /* If there's no initrd at all, we're done */ 17379c85419SDavid Gibson if (! initrd_size) 17479c85419SDavid Gibson return (struct addr_range){0, 0}; 17594b212c2SPaul Mackerras 17694b212c2SPaul Mackerras /* 17779c85419SDavid Gibson * If the initrd is too low it will be clobbered when the 17879c85419SDavid Gibson * kernel relocates to its final location. In this case, 17979c85419SDavid Gibson * allocate a safer place and move it. 18094b212c2SPaul Mackerras */ 18179c85419SDavid Gibson if (initrd_addr < vmlinux.size) { 18279c85419SDavid Gibson void *old_addr = (void *)initrd_addr; 18379c85419SDavid Gibson 184b2c5f619SMark A. Greer printf("Allocating 0x%lx bytes for initrd ...\n\r", 18579c85419SDavid Gibson initrd_size); 18679c85419SDavid Gibson initrd_addr = (unsigned long)malloc(initrd_size); 1876a923216SMilton Miller if (! initrd_addr) 1886a923216SMilton Miller fatal("Can't allocate memory for initial " 189b2c5f619SMark A. Greer "ramdisk !\n\r"); 190fae59c39SDavid Gibson printf("Relocating initrd 0x%lx <- 0x%p (0x%lx bytes)\n\r", 19179c85419SDavid Gibson initrd_addr, old_addr, initrd_size); 19279c85419SDavid Gibson memmove((void *)initrd_addr, old_addr, initrd_size); 19394b212c2SPaul Mackerras } 19494b212c2SPaul Mackerras 19579c85419SDavid Gibson printf("initrd head: 0x%lx\n\r", *((unsigned long *)initrd_addr)); 19694b212c2SPaul Mackerras 19779c85419SDavid Gibson /* Tell the kernel initrd address via device tree */ 198*27fbaa97SDavid Gibson setprop_val(chosen, "linux,initrd-start", (u32)(initrd_addr)); 199*27fbaa97SDavid Gibson setprop_val(chosen, "linux,initrd-end", (u32)(initrd_addr+initrd_size)); 20079c85419SDavid Gibson 20179c85419SDavid Gibson return (struct addr_range){(void *)initrd_addr, initrd_size}; 20294b212c2SPaul Mackerras } 20394b212c2SPaul Mackerras 204b2c5f619SMark A. Greer /* A buffer that may be edited by tools operating on a zImage binary so as to 205b2c5f619SMark A. Greer * edit the command line passed to vmlinux (by setting /chosen/bootargs). 206b2c5f619SMark A. Greer * The buffer is put in it's own section so that tools may locate it easier. 207b2c5f619SMark A. Greer */ 208b2c5f619SMark A. Greer static char builtin_cmdline[COMMAND_LINE_SIZE] 209b2c5f619SMark A. Greer __attribute__((__section__("__builtin_cmdline"))); 210b2c5f619SMark A. Greer 211b2c5f619SMark A. Greer static void get_cmdline(char *buf, int size) 212b2c5f619SMark A. Greer { 213b2c5f619SMark A. Greer void *devp; 214b2c5f619SMark A. Greer int len = strlen(builtin_cmdline); 215b2c5f619SMark A. Greer 216b2c5f619SMark A. Greer buf[0] = '\0'; 217b2c5f619SMark A. Greer 218b2c5f619SMark A. Greer if (len > 0) { /* builtin_cmdline overrides dt's /chosen/bootargs */ 219b2c5f619SMark A. Greer len = min(len, size-1); 220b2c5f619SMark A. Greer strncpy(buf, builtin_cmdline, len); 221b2c5f619SMark A. Greer buf[len] = '\0'; 222b2c5f619SMark A. Greer } 223b2c5f619SMark A. Greer else if ((devp = finddevice("/chosen"))) 224b2c5f619SMark A. Greer getprop(devp, "bootargs", buf, size); 225b2c5f619SMark A. Greer } 226b2c5f619SMark A. Greer 227b2c5f619SMark A. Greer static void set_cmdline(char *buf) 228b2c5f619SMark A. Greer { 229b2c5f619SMark A. Greer void *devp; 230b2c5f619SMark A. Greer 231b2c5f619SMark A. Greer if ((devp = finddevice("/chosen"))) 232b2c5f619SMark A. Greer setprop(devp, "bootargs", buf, strlen(buf) + 1); 233b2c5f619SMark A. Greer } 234b2c5f619SMark A. Greer 235b2c5f619SMark A. Greer struct platform_ops platform_ops; 236b2c5f619SMark A. Greer struct dt_ops dt_ops; 237b2c5f619SMark A. Greer struct console_ops console_ops; 238cd197ffcSDavid Gibson struct loader_info loader_info; 239b2c5f619SMark A. Greer 240e5a2072bSDavid Gibson void start(void) 241b2c5f619SMark A. Greer { 24279c85419SDavid Gibson struct addr_range vmlinux, initrd; 243b2c5f619SMark A. Greer kernel_entry_t kentry; 244b2c5f619SMark A. Greer char cmdline[COMMAND_LINE_SIZE]; 24535af89ebSDavid Gibson unsigned long ft_addr = 0; 246*27fbaa97SDavid Gibson void *chosen; 247b2c5f619SMark A. Greer 248b2c5f619SMark A. Greer if (console_ops.open && (console_ops.open() < 0)) 249b2c5f619SMark A. Greer exit(); 250b2c5f619SMark A. Greer if (platform_ops.fixups) 251b2c5f619SMark A. Greer platform_ops.fixups(); 252b2c5f619SMark A. Greer 253b2c5f619SMark A. Greer printf("\n\rzImage starting: loaded at 0x%p (sp: 0x%p)\n\r", 254e5a2072bSDavid Gibson _start, get_sp()); 255b2c5f619SMark A. Greer 256*27fbaa97SDavid Gibson /* Ensure that the device tree has a /chosen node */ 257*27fbaa97SDavid Gibson chosen = finddevice("/chosen"); 258*27fbaa97SDavid Gibson if (!chosen) 259*27fbaa97SDavid Gibson chosen = create_node(NULL, "chosen"); 260*27fbaa97SDavid Gibson 26179c85419SDavid Gibson vmlinux = prep_kernel(); 262*27fbaa97SDavid Gibson initrd = prep_initrd(vmlinux, chosen, 263*27fbaa97SDavid Gibson loader_info.initrd_addr, loader_info.initrd_size); 264b2c5f619SMark A. Greer 265b2c5f619SMark A. Greer /* If cmdline came from zimage wrapper or if we can edit the one 266b2c5f619SMark A. Greer * in the dt, print it out and edit it, if possible. 267b2c5f619SMark A. Greer */ 268b2c5f619SMark A. Greer if ((strlen(builtin_cmdline) > 0) || console_ops.edit_cmdline) { 269b2c5f619SMark A. Greer get_cmdline(cmdline, COMMAND_LINE_SIZE); 270b2c5f619SMark A. Greer printf("\n\rLinux/PowerPC load: %s", cmdline); 271b2c5f619SMark A. Greer if (console_ops.edit_cmdline) 272b2c5f619SMark A. Greer console_ops.edit_cmdline(cmdline, COMMAND_LINE_SIZE); 273b2c5f619SMark A. Greer printf("\n\r"); 274b2c5f619SMark A. Greer set_cmdline(cmdline); 275b2c5f619SMark A. Greer } 276b2c5f619SMark A. Greer 27735af89ebSDavid Gibson printf("Finalizing device tree..."); 27835af89ebSDavid Gibson if (dt_ops.finalize) 27935af89ebSDavid Gibson ft_addr = dt_ops.finalize(); 28035af89ebSDavid Gibson if (ft_addr) 28135af89ebSDavid Gibson printf(" flat tree at 0x%lx\n\r", ft_addr); 28235af89ebSDavid Gibson else 283cd197ffcSDavid Gibson printf(" using OF tree (promptr=%p)\n\r", loader_info.promptr); 28435af89ebSDavid Gibson 285b2c5f619SMark A. Greer if (console_ops.close) 286b2c5f619SMark A. Greer console_ops.close(); 287b2c5f619SMark A. Greer 288b2c5f619SMark A. Greer kentry = (kernel_entry_t) vmlinux.addr; 28935af89ebSDavid Gibson if (ft_addr) 29035af89ebSDavid Gibson kentry(ft_addr, 0, NULL); 291b2c5f619SMark A. Greer else 292cd197ffcSDavid Gibson kentry((unsigned long)initrd.addr, initrd.size, 293cd197ffcSDavid Gibson loader_info.promptr); 294b2c5f619SMark A. Greer 2956a923216SMilton Miller /* console closed so printf in fatal below may not work */ 2966a923216SMilton Miller fatal("Error: Linux kernel returned to zImage boot wrapper!\n\r"); 297b2c5f619SMark A. Greer } 298