mods to elf.h to use arch/elf.h
Some updates to the docs, but these will change more. add memcmp. Crude implementation, but it really does not matter. add compute_ip_checksum.c mods to elfboot. Thanks to our new design, BOUNCE BUFFERS ARE DEAD. Yee ha! updates to makefile Signed-off-by: Ronald G. Minnich <rminnich@gmail.com> Acked-by: Ronald G. Minnich <rminnich@gmail.com> Acked-by: Stefan Reinauer <stepan@coresystems.de> git-svn-id: svn://coreboot.org/repository/LinuxBIOSv3@96 f3766cd6-281f-0410-b1cd-43a5c92072e9
This commit is contained in:
parent
281cd76b38
commit
534f6d31be
6 changed files with 161 additions and 240 deletions
|
|
@ -115,6 +115,7 @@ $(obj)/linuxbios.stage2: $(obj)/stage0.init $(obj)/statictree.o
|
|||
$(Q)$(CC) $(INITCFLAGS) -c $(src)/device/device.c -o $(obj)/device.o
|
||||
$(Q)$(CC) $(INITCFLAGS) -c $(src)/device/device_util.c -o $(obj)/device_util.o
|
||||
$(Q)$(CC) $(INITCFLAGS) -c $(src)/device/root_device.c -o $(obj)/root_device.o
|
||||
$(Q)$(CC) $(INITCFLAGS) -c $(src)/lib/elfboot.c -o $(obj)/elfboot.o
|
||||
$(Q)$(CC) $(INITCFLAGS) -c $(src)/lib/mem.c -o $(obj)/mem.o
|
||||
$(Q)$(CC) $(INITCFLAGS) -c $(src)/lib/malloc.c -o $(obj)/malloc.o
|
||||
$(Q)$(CC) $(INITCFLAGS) -c $(src)/lib/clog2.c -o $(obj)/clog2.o
|
||||
|
|
@ -124,7 +125,7 @@ $(obj)/linuxbios.stage2: $(obj)/stage0.init $(obj)/statictree.o
|
|||
$(Q)# leave a .o with full symbols in it for debugging.
|
||||
$(Q)cd $(obj); $(LD) -R $(obj)/stage0.o -Ttext 0x1000 \
|
||||
-o $(obj)/linuxbios.stage2.o stage2.o device.o \
|
||||
device_util.o root_device.o mem.o malloc.o clog2.o mainboard.o \
|
||||
device_util.o root_device.o elfboot.o mem.o malloc.o clog2.o mainboard.o \
|
||||
statictree.o
|
||||
$(Q)objcopy -O binary $(obj)/linuxbios.stage2.o $(obj)/linuxbios.stage2
|
||||
|
||||
|
|
|
|||
|
|
@ -352,7 +352,13 @@ In that directory, need 'initram', 'payload.ext', and others.
|
|||
\end_layout
|
||||
|
||||
\begin_layout Subsection
|
||||
Stage 3
|
||||
Stage 3: elf boot
|
||||
\end_layout
|
||||
|
||||
\begin_layout Quotation
|
||||
WARNING: you can not load any elf segment in the range 0 to 0x1000.
|
||||
That is our stack.
|
||||
|
||||
\end_layout
|
||||
|
||||
\begin_layout Enumerate
|
||||
|
|
|
|||
|
|
@ -5,7 +5,7 @@
|
|||
|
||||
#include <stdint.h>
|
||||
#include <stddef.h>
|
||||
#include <arch/boot/boot.h>
|
||||
#include <arch/elf.h>
|
||||
|
||||
/* Type for a 16-bit quantity. */
|
||||
typedef uint16_t Elf32_Half;
|
||||
|
|
|
|||
53
lib/compute_ip_checksum.c
Normal file
53
lib/compute_ip_checksum.c
Normal file
|
|
@ -0,0 +1,53 @@
|
|||
#include <stdint.h>
|
||||
#include <ip_checksum.h>
|
||||
|
||||
unsigned long compute_ip_checksum(void *addr, unsigned long length)
|
||||
{
|
||||
uint8_t *ptr;
|
||||
volatile union {
|
||||
uint8_t byte[2];
|
||||
uint16_t word;
|
||||
} value;
|
||||
unsigned long sum;
|
||||
unsigned long i;
|
||||
/* In the most straight forward way possible,
|
||||
* compute an ip style checksum.
|
||||
*/
|
||||
sum = 0;
|
||||
ptr = addr;
|
||||
for(i = 0; i < length; i++) {
|
||||
unsigned long value;
|
||||
value = ptr[i];
|
||||
if (i & 1) {
|
||||
value <<= 8;
|
||||
}
|
||||
/* Add the new value */
|
||||
sum += value;
|
||||
/* Wrap around the carry */
|
||||
if (sum > 0xFFFF) {
|
||||
sum = (sum + (sum >> 16)) & 0xFFFF;
|
||||
}
|
||||
}
|
||||
value.byte[0] = sum & 0xff;
|
||||
value.byte[1] = (sum >> 8) & 0xff;
|
||||
return (~value.word) & 0xFFFF;
|
||||
}
|
||||
|
||||
unsigned long add_ip_checksums(unsigned long offset, unsigned long sum, unsigned long new)
|
||||
{
|
||||
unsigned long checksum;
|
||||
sum = ~sum & 0xFFFF;
|
||||
new = ~new & 0xFFFF;
|
||||
if (offset & 1) {
|
||||
/* byte swap the sum if it came from an odd offset
|
||||
* since the computation is endian independant this
|
||||
* works.
|
||||
*/
|
||||
new = ((new >> 8) & 0xff) | ((new << 8) & 0xff00);
|
||||
}
|
||||
checksum = sum + new;
|
||||
if (checksum > 0xFFFF) {
|
||||
checksum -= 0xFFFF;
|
||||
}
|
||||
return (~checksum) & 0xFFFF;
|
||||
}
|
||||
316
lib/elfboot.c
316
lib/elfboot.c
|
|
@ -1,23 +1,13 @@
|
|||
#include <console/console.h>
|
||||
#include <part/fallback_boot.h>
|
||||
#include <boot/elf.h>
|
||||
#include <boot/elf_boot.h>
|
||||
#include <boot/linuxbios_tables.h>
|
||||
//#include <part/fallback_boot.h>
|
||||
#include <elf.h>
|
||||
#include <elf_boot.h>
|
||||
#include <linuxbios_tables.h>
|
||||
#include <ip_checksum.h>
|
||||
#include <stream/read_bytes.h>
|
||||
#include <stdint.h>
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
|
||||
/* Maximum physical address we can use for the linuxBIOS bounce buffer.
|
||||
*/
|
||||
#ifndef MAX_ADDR
|
||||
#define MAX_ADDR -1UL
|
||||
#endif
|
||||
|
||||
extern unsigned char _ram_seg;
|
||||
extern unsigned char _eram_seg;
|
||||
|
||||
struct segment {
|
||||
struct segment *next;
|
||||
struct segment *prev;
|
||||
|
|
@ -42,6 +32,39 @@ struct ip_checksum_vcb {
|
|||
unsigned short ip_checksum;
|
||||
};
|
||||
|
||||
/* streams are a nice way to abstract the pointer/size-based nature of the
|
||||
* memory away. The main good part is that we have a way to fail out if the
|
||||
* elfboot code is running off the end of the array for some reason. So we won't
|
||||
* rip it out just yet.
|
||||
*/
|
||||
unsigned char *streambase = NULL;
|
||||
int streamsize = -1;
|
||||
|
||||
int stream_init(void){
|
||||
return 0;
|
||||
}
|
||||
|
||||
void stream_fini(void){
|
||||
}
|
||||
|
||||
int stream_skip(int bytes){
|
||||
streamsize -= bytes;
|
||||
if (streamsize < 0)
|
||||
return -1;
|
||||
streambase += bytes;
|
||||
|
||||
return bytes;
|
||||
}
|
||||
|
||||
int stream_read(void *dest, int bytes) {
|
||||
if (streamsize < bytes)
|
||||
return -1;
|
||||
|
||||
memcpy(dest, streambase, bytes);
|
||||
stream_skip(bytes);
|
||||
return bytes;
|
||||
}
|
||||
|
||||
int verify_ip_checksum(
|
||||
struct verify_callback *vcb,
|
||||
Elf_ehdr *ehdr, Elf_phdr *phdr, struct segment *head)
|
||||
|
|
@ -76,68 +99,12 @@ int verify_ip_checksum(
|
|||
memcpy(n_desc, buff, 2);
|
||||
}
|
||||
if (checksum != cb->ip_checksum) {
|
||||
printk_err("Image checksum: %04x != computed checksum: %04x\n",
|
||||
printk(BIOS_ERR, "Image checksum: %04x != computed checksum: %04x\n",
|
||||
cb->ip_checksum, checksum);
|
||||
}
|
||||
return checksum == cb->ip_checksum;
|
||||
}
|
||||
|
||||
/* The problem:
|
||||
* Static executables all want to share the same addresses
|
||||
* in memory because only a few addresses are reliably present on
|
||||
* a machine, and implementing general relocation is hard.
|
||||
*
|
||||
* The solution:
|
||||
* - Allocate a buffer twice the size of the linuxBIOS image.
|
||||
* - Anything that would overwrite linuxBIOS copy into the lower half of
|
||||
* the buffer.
|
||||
* - After loading an ELF image copy linuxBIOS to the upper half of the
|
||||
* buffer.
|
||||
* - Then jump to the loaded image.
|
||||
*
|
||||
* Benefits:
|
||||
* - Nearly arbitrary standalone executables can be loaded.
|
||||
* - LinuxBIOS is preserved, so it can be returned to.
|
||||
* - The implementation is still relatively simple,
|
||||
* and much simpler then the general case implemented in kexec.
|
||||
*
|
||||
*/
|
||||
|
||||
static unsigned long get_bounce_buffer(struct lb_memory *mem)
|
||||
{
|
||||
unsigned long lb_size;
|
||||
unsigned long mem_entries;
|
||||
unsigned long buffer;
|
||||
int i;
|
||||
lb_size = (unsigned long)(&_eram_seg - &_ram_seg);
|
||||
/* Double linuxBIOS size so I have somewhere to place a copy to return to */
|
||||
lb_size = lb_size + lb_size;
|
||||
mem_entries = (mem->size - sizeof(*mem))/sizeof(mem->map[0]);
|
||||
buffer = 0;
|
||||
for(i = 0; i < mem_entries; i++) {
|
||||
unsigned long mstart, mend;
|
||||
unsigned long msize;
|
||||
unsigned long tbuffer;
|
||||
if (mem->map[i].type != LB_MEM_RAM)
|
||||
continue;
|
||||
if (unpack_lb64(mem->map[i].start) > MAX_ADDR)
|
||||
continue;
|
||||
if (unpack_lb64(mem->map[i].size) < lb_size)
|
||||
continue;
|
||||
mstart = unpack_lb64(mem->map[i].start);
|
||||
msize = MAX_ADDR - mstart +1;
|
||||
if (msize > unpack_lb64(mem->map[i].size))
|
||||
msize = unpack_lb64(mem->map[i].size);
|
||||
mend = mstart + msize;
|
||||
tbuffer = mend - lb_size;
|
||||
if (tbuffer < buffer)
|
||||
continue;
|
||||
buffer = tbuffer;
|
||||
}
|
||||
return buffer;
|
||||
}
|
||||
|
||||
|
||||
static struct verify_callback *process_elf_notes(
|
||||
unsigned char *header,
|
||||
unsigned long offset, unsigned long length)
|
||||
|
|
@ -186,20 +153,20 @@ static struct verify_callback *process_elf_notes(
|
|||
}
|
||||
}
|
||||
}
|
||||
printk_spew("n_type: %08x n_name(%d): %-*.*s n_desc(%d): %-*.*s\n",
|
||||
printk(BIOS_SPEW, "n_type: %08x n_name(%d): %-*.*s n_desc(%d): %-*.*s\n",
|
||||
hdr->n_type,
|
||||
hdr->n_namesz, hdr->n_namesz, hdr->n_namesz, n_name,
|
||||
hdr->n_descsz,hdr->n_descsz, hdr->n_descsz, n_desc);
|
||||
note = next;
|
||||
}
|
||||
if (program && version) {
|
||||
printk_info("Loading %s version: %s\n",
|
||||
printk(BIOS_INFO, "Loading %s version: %s\n",
|
||||
program, version);
|
||||
}
|
||||
return cb_chain;
|
||||
}
|
||||
|
||||
static int valid_area(struct lb_memory *mem, unsigned long buffer,
|
||||
static int valid_area(struct lb_memory *mem,
|
||||
unsigned long start, unsigned long len)
|
||||
{
|
||||
/* Check through all of the memory segments and ensure
|
||||
|
|
@ -210,11 +177,6 @@ static int valid_area(struct lb_memory *mem, unsigned long buffer,
|
|||
unsigned long end = start + len;
|
||||
unsigned long mem_entries = (mem->size - sizeof(*mem))/sizeof(mem->map[0]);
|
||||
|
||||
/* See if I conflict with the bounce buffer */
|
||||
if (end >= buffer) {
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* Walk through the table of valid memory ranges and see if I
|
||||
* have a match.
|
||||
*/
|
||||
|
|
@ -229,16 +191,16 @@ static int valid_area(struct lb_memory *mem, unsigned long buffer,
|
|||
}
|
||||
}
|
||||
if (i == mem_entries) {
|
||||
printk_err("No matching ram area found for range:\n");
|
||||
printk_err(" [0x%016lx, 0x%016lx)\n", start, end);
|
||||
printk_err("Ram areas\n");
|
||||
printk(BIOS_ERR, "No matching ram area found for range:\n");
|
||||
printk(BIOS_ERR, " [0x%016lx, 0x%016lx)\n", start, end);
|
||||
printk(BIOS_ERR, "Ram areas\n");
|
||||
for(i = 0; i < mem_entries; i++) {
|
||||
uint64_t mstart, mend;
|
||||
uint32_t mtype;
|
||||
mtype = mem->map[i].type;
|
||||
mstart = unpack_lb64(mem->map[i].start);
|
||||
mend = mstart + unpack_lb64(mem->map[i].size);
|
||||
printk_err(" [0x%016lx, 0x%016lx) %s\n",
|
||||
printk(BIOS_ERR, " [0x%016lx, 0x%016lx) %s\n",
|
||||
(unsigned long)mstart,
|
||||
(unsigned long)mend,
|
||||
(mtype == LB_MEM_RAM)?"RAM":"Reserved");
|
||||
|
|
@ -249,118 +211,8 @@ static int valid_area(struct lb_memory *mem, unsigned long buffer,
|
|||
return 1;
|
||||
}
|
||||
|
||||
static void relocate_segment(unsigned long buffer, struct segment *seg)
|
||||
{
|
||||
/* Modify all segments that want to load onto linuxBIOS
|
||||
* to load onto the bounce buffer instead.
|
||||
*/
|
||||
unsigned long lb_start = (unsigned long)&_ram_seg;
|
||||
unsigned long lb_end = (unsigned long)&_eram_seg;
|
||||
unsigned long start, middle, end;
|
||||
|
||||
printk_spew("lb: [0x%016lx, 0x%016lx)\n",
|
||||
lb_start, lb_end);
|
||||
|
||||
start = seg->s_addr;
|
||||
middle = start + seg->s_filesz;
|
||||
end = start + seg->s_memsz;
|
||||
/* I don't conflict with linuxBIOS so get out of here */
|
||||
if ((end <= lb_start) || (start >= lb_end))
|
||||
return;
|
||||
|
||||
printk_spew("segment: [0x%016lx, 0x%016lx, 0x%016lx)\n",
|
||||
start, middle, end);
|
||||
|
||||
/* Slice off a piece at the beginning
|
||||
* that doesn't conflict with linuxBIOS.
|
||||
*/
|
||||
if (start < lb_start) {
|
||||
struct segment *new;
|
||||
unsigned long len = lb_start - start;
|
||||
new = malloc(sizeof(*new));
|
||||
*new = *seg;
|
||||
new->s_memsz = len;
|
||||
seg->s_memsz -= len;
|
||||
seg->s_addr += len;
|
||||
seg->s_offset += len;
|
||||
if (seg->s_filesz > len) {
|
||||
new->s_filesz = len;
|
||||
seg->s_filesz -= len;
|
||||
} else {
|
||||
seg->s_filesz = 0;
|
||||
}
|
||||
|
||||
/* Order by stream offset */
|
||||
new->next = seg;
|
||||
new->prev = seg->prev;
|
||||
seg->prev->next = new;
|
||||
seg->prev = new;
|
||||
/* Order by original program header order */
|
||||
new->phdr_next = seg;
|
||||
new->phdr_prev = seg->phdr_prev;
|
||||
seg->phdr_prev->phdr_next = new;
|
||||
seg->phdr_prev = new;
|
||||
|
||||
/* compute the new value of start */
|
||||
start = seg->s_addr;
|
||||
|
||||
printk_spew(" early: [0x%016lx, 0x%016lx, 0x%016lx)\n",
|
||||
new->s_addr,
|
||||
new->s_addr + new->s_filesz,
|
||||
new->s_addr + new->s_memsz);
|
||||
}
|
||||
|
||||
/* Slice off a piece at the end
|
||||
* that doesn't conflict with linuxBIOS
|
||||
*/
|
||||
if (end > lb_end) {
|
||||
unsigned long len = lb_end - start;
|
||||
struct segment *new;
|
||||
new = malloc(sizeof(*new));
|
||||
*new = *seg;
|
||||
seg->s_memsz = len;
|
||||
new->s_memsz -= len;
|
||||
new->s_addr += len;
|
||||
new->s_offset += len;
|
||||
if (seg->s_filesz > len) {
|
||||
seg->s_filesz = len;
|
||||
new->s_filesz -= len;
|
||||
} else {
|
||||
new->s_filesz = 0;
|
||||
}
|
||||
/* Order by stream offset */
|
||||
new->next = seg->next;
|
||||
new->prev = seg;
|
||||
seg->next->prev = new;
|
||||
seg->next = new;
|
||||
/* Order by original program header order */
|
||||
new->phdr_next = seg->phdr_next;
|
||||
new->phdr_prev = seg;
|
||||
seg->phdr_next->phdr_prev = new;
|
||||
seg->phdr_next = new;
|
||||
|
||||
/* compute the new value of end */
|
||||
end = start + len;
|
||||
|
||||
printk_spew(" late: [0x%016lx, 0x%016lx, 0x%016lx)\n",
|
||||
new->s_addr,
|
||||
new->s_addr + new->s_filesz,
|
||||
new->s_addr + new->s_memsz);
|
||||
|
||||
}
|
||||
/* Now retarget this segment onto the bounce buffer */
|
||||
seg->s_addr = buffer + (seg->s_addr - lb_start);
|
||||
|
||||
printk_spew(" bounce: [0x%016lx, 0x%016lx, 0x%016lx)\n",
|
||||
seg->s_addr,
|
||||
seg->s_addr + seg->s_filesz,
|
||||
seg->s_addr + seg->s_memsz);
|
||||
}
|
||||
|
||||
|
||||
static int build_elf_segment_list(
|
||||
struct segment *head,
|
||||
unsigned long bounce_buffer, struct lb_memory *mem,
|
||||
struct segment *head, struct lb_memory *mem,
|
||||
Elf_phdr *phdr, int headers)
|
||||
{
|
||||
struct segment *ptr;
|
||||
|
|
@ -372,11 +224,11 @@ static int build_elf_segment_list(
|
|||
struct segment *new;
|
||||
/* Ignore data that I don't need to handle */
|
||||
if (phdr[i].p_type != PT_LOAD) {
|
||||
printk_debug("Dropping non PT_LOAD segment\n");
|
||||
printk(BIOS_DEBUG, "Dropping non PT_LOAD segment\n");
|
||||
continue;
|
||||
}
|
||||
if (phdr[i].p_memsz == 0) {
|
||||
printk_debug("Dropping empty segment\n");
|
||||
printk(BIOS_DEBUG, "Dropping empty segment\n");
|
||||
continue;
|
||||
}
|
||||
new = malloc(sizeof(*new));
|
||||
|
|
@ -384,13 +236,13 @@ static int build_elf_segment_list(
|
|||
new->s_memsz = phdr[i].p_memsz;
|
||||
new->s_offset = phdr[i].p_offset;
|
||||
new->s_filesz = phdr[i].p_filesz;
|
||||
printk_debug("New segment addr 0x%lx size 0x%lx offset 0x%lx filesize 0x%lx\n",
|
||||
printk(BIOS_DEBUG, "New segment addr 0x%lx size 0x%lx offset 0x%lx filesize 0x%lx\n",
|
||||
new->s_addr, new->s_memsz, new->s_offset, new->s_filesz);
|
||||
/* Clean up the values */
|
||||
if (new->s_filesz > new->s_memsz) {
|
||||
new->s_filesz = new->s_memsz;
|
||||
}
|
||||
printk_debug("(cleaned up) New segment addr 0x%lx size 0x%lx offset 0x%lx filesize 0x%lx\n",
|
||||
printk(BIOS_DEBUG, "(cleaned up) New segment addr 0x%lx size 0x%lx offset 0x%lx filesize 0x%lx\n",
|
||||
new->s_addr, new->s_memsz, new->s_offset, new->s_filesz);
|
||||
for(ptr = head->next; ptr != head; ptr = ptr->next) {
|
||||
if (new->s_offset < ptr->s_offset)
|
||||
|
|
@ -408,12 +260,8 @@ static int build_elf_segment_list(
|
|||
head->phdr_prev = new;
|
||||
|
||||
/* Verify the memory addresses in the segment are valid */
|
||||
if (!valid_area(mem, bounce_buffer, new->s_addr, new->s_memsz))
|
||||
if (!valid_area(mem, new->s_addr, new->s_memsz))
|
||||
goto out;
|
||||
|
||||
/* Modify the segment to load onto the bounce_buffer if necessary.
|
||||
*/
|
||||
relocate_segment(bounce_buffer, new);
|
||||
}
|
||||
return 1;
|
||||
out:
|
||||
|
|
@ -431,8 +279,8 @@ static int load_elf_segments(
|
|||
unsigned long start_offset;
|
||||
unsigned long skip_bytes, read_bytes;
|
||||
unsigned char *dest, *middle, *end;
|
||||
byte_offset_t result;
|
||||
printk_debug("Loading Segment: addr: 0x%016lx memsz: 0x%016lx filesz: 0x%016lx\n",
|
||||
unsigned long result;
|
||||
printk(BIOS_DEBUG, "Loading Segment: addr: 0x%016lx memsz: 0x%016lx filesz: 0x%016lx\n",
|
||||
ptr->s_addr, ptr->s_memsz, ptr->s_filesz);
|
||||
|
||||
/* Compute the boundaries of the segment */
|
||||
|
|
@ -445,7 +293,7 @@ static int load_elf_segments(
|
|||
start_offset = offset;
|
||||
}
|
||||
|
||||
printk_spew("[ 0x%016lx, %016lx, 0x%016lx) <- %016lx\n",
|
||||
printk(BIOS_SPEW, "[ 0x%016lx, %016lx, 0x%016lx) <- %016lx\n",
|
||||
(unsigned long)dest,
|
||||
(unsigned long)middle,
|
||||
(unsigned long)end,
|
||||
|
|
@ -464,7 +312,7 @@ static int load_elf_segments(
|
|||
skip_bytes = start_offset - offset;
|
||||
if (skip_bytes &&
|
||||
((result = stream_skip(skip_bytes)) != skip_bytes)) {
|
||||
printk_err("ERROR: Skip of %ld bytes skipped %ld bytes\n",
|
||||
printk(BIOS_ERR, "ERROR: Skip of %ld bytes skipped %ld bytes\n",
|
||||
skip_bytes, result);
|
||||
goto out;
|
||||
}
|
||||
|
|
@ -487,7 +335,7 @@ static int load_elf_segments(
|
|||
read_bytes = middle - dest;
|
||||
if (read_bytes &&
|
||||
((result = stream_read(dest, read_bytes)) != read_bytes)) {
|
||||
printk_err("ERROR: Read of %ld bytes read %ld bytes...\n",
|
||||
printk(BIOS_ERR, "ERROR: Read of %ld bytes read %ld bytes...\n",
|
||||
read_bytes, result);
|
||||
goto out;
|
||||
}
|
||||
|
|
@ -495,7 +343,7 @@ static int load_elf_segments(
|
|||
|
||||
/* Zero the extra bytes between middle & end */
|
||||
if (middle < end) {
|
||||
printk_debug("Clearing Segment: addr: 0x%016lx memsz: 0x%016lx\n",
|
||||
printk(BIOS_DEBUG, "Clearing Segment: addr: 0x%016lx memsz: 0x%016lx\n",
|
||||
(unsigned long)middle, end - middle);
|
||||
|
||||
/* Zero the extra bytes */
|
||||
|
|
@ -541,16 +389,9 @@ int elfload(struct lb_memory *mem,
|
|||
Elf_ehdr *ehdr;
|
||||
Elf_phdr *phdr;
|
||||
void *entry;
|
||||
void (*v)(void);
|
||||
struct segment head;
|
||||
struct verify_callback *cb_chain;
|
||||
unsigned long bounce_buffer;
|
||||
|
||||
/* Find a bounce buffer so I can load to linuxBIOS's current location */
|
||||
bounce_buffer = get_bounce_buffer(mem);
|
||||
if (!bounce_buffer) {
|
||||
printk_err("Could not find a bounce buffer...\n");
|
||||
goto out;
|
||||
}
|
||||
|
||||
ehdr = (Elf_ehdr *)header;
|
||||
entry = (void *)(ehdr->e_entry);
|
||||
|
|
@ -565,32 +406,34 @@ int elfload(struct lb_memory *mem,
|
|||
}
|
||||
|
||||
/* Preprocess the elf segments */
|
||||
if (!build_elf_segment_list(&head,
|
||||
bounce_buffer, mem, phdr, ehdr->e_phnum))
|
||||
if (!build_elf_segment_list(&head, mem, phdr, ehdr->e_phnum))
|
||||
goto out;
|
||||
|
||||
/* Load the segments */
|
||||
if (!load_elf_segments(&head, header, header_size))
|
||||
goto out;
|
||||
|
||||
printk_spew("Loaded segments\n");
|
||||
printk(BIOS_SPEW, "Loaded segments\n");
|
||||
/* Verify the loaded image */
|
||||
if (!verify_loaded_image(cb_chain, ehdr, phdr, &head))
|
||||
goto out;
|
||||
|
||||
printk_spew("verified segments\n");
|
||||
printk(BIOS_SPEW, "verified segments\n");
|
||||
/* Shutdown the stream device */
|
||||
stream_fini();
|
||||
|
||||
printk_spew("closed down stream\n");
|
||||
printk(BIOS_SPEW, "closed down stream\n");
|
||||
/* Reset to booting from this image as late as possible */
|
||||
boot_successful();
|
||||
/* what the hell is boot_successful? */
|
||||
//boot_successful();
|
||||
|
||||
printk_debug("Jumping to boot code at 0x%x\n", entry);
|
||||
printk(BIOS_DEBUG, "Jumping to boot code at 0x%x\n", entry);
|
||||
post_code(0xfe);
|
||||
|
||||
/* Jump to kernel */
|
||||
jmp_to_elf_entry(entry, bounce_buffer);
|
||||
/* just call it as a function. If it wants to return, it will. */
|
||||
v = entry;
|
||||
v();
|
||||
return 1;
|
||||
|
||||
out:
|
||||
|
|
@ -605,21 +448,20 @@ int elfboot(struct lb_memory *mem)
|
|||
int i, result;
|
||||
|
||||
result = 0;
|
||||
printk_info("\n");
|
||||
printk_info("Welcome to %s, the open sourced starter.\n", BOOTLOADER);
|
||||
printk_info("January 2002, Eric Biederman.\n");
|
||||
printk_info("Version %s\n", BOOTLOADER_VERSION);
|
||||
printk_info("\n");
|
||||
printk(BIOS_INFO, "\n");
|
||||
printk(BIOS_INFO, "Welcome to %s, the open sourced starter.\n", BOOTLOADER);
|
||||
printk(BIOS_INFO, "Version %s\n", BOOTLOADER_VERSION);
|
||||
printk(BIOS_INFO, "\n");
|
||||
post_code(0xf8);
|
||||
|
||||
if (stream_init() < 0) {
|
||||
printk_err("Could not initialize driver...\n");
|
||||
printk(BIOS_ERR, "Could not initialize driver...\n");
|
||||
goto out;
|
||||
}
|
||||
|
||||
/* Read in the initial ELF_HEAD_SIZE bytes */
|
||||
if (stream_read(header, ELF_HEAD_SIZE) != ELF_HEAD_SIZE) {
|
||||
printk_err("Read failed...\n");
|
||||
printk(BIOS_ERR, "Read failed...\n");
|
||||
goto out;
|
||||
}
|
||||
/* Scan for an elf header */
|
||||
|
|
@ -627,10 +469,10 @@ int elfboot(struct lb_memory *mem)
|
|||
for(i = 0; i < ELF_HEAD_SIZE - (sizeof(Elf_ehdr) + sizeof(Elf_phdr)); i+=16) {
|
||||
ehdr = (Elf_ehdr *)(&header[i]);
|
||||
if (memcmp(ehdr->e_ident, ELFMAG, 4) != 0) {
|
||||
printk_spew("NO header at %d\n", i);
|
||||
printk(BIOS_SPEW, "NO header at %d\n", i);
|
||||
continue;
|
||||
}
|
||||
printk_debug("Found ELF candidate at offset %d\n", i);
|
||||
printk(BIOS_DEBUG, "Found ELF candidate at offset %d\n", i);
|
||||
/* Sanity check the elf header */
|
||||
if ((ehdr->e_type == ET_EXEC) &&
|
||||
elf_check_arch(ehdr) &&
|
||||
|
|
@ -646,12 +488,12 @@ int elfboot(struct lb_memory *mem)
|
|||
}
|
||||
ehdr = 0;
|
||||
}
|
||||
printk_spew("header_offset is %d\n", header_offset);
|
||||
printk(BIOS_SPEW, "header_offset is %d\n", header_offset);
|
||||
if (header_offset == -1) {
|
||||
goto out;
|
||||
}
|
||||
|
||||
printk_spew("Try to load at offset 0x%x\n", header_offset);
|
||||
printk(BIOS_SPEW, "Try to load at offset 0x%x\n", header_offset);
|
||||
result = elfload(mem,
|
||||
header + header_offset , ELF_HEAD_SIZE - header_offset);
|
||||
out:
|
||||
|
|
@ -659,7 +501,7 @@ int elfboot(struct lb_memory *mem)
|
|||
/* Shutdown the stream device */
|
||||
stream_fini();
|
||||
|
||||
printk_err("Cannot Load ELF Image\n");
|
||||
printk(BIOS_ERR, "Cannot Load ELF Image\n");
|
||||
|
||||
post_code(0xff);
|
||||
}
|
||||
|
|
|
|||
19
lib/mem.c
19
lib/mem.c
|
|
@ -21,6 +21,7 @@
|
|||
*/
|
||||
|
||||
/* this one is pretty stupid. Won't handle overlaps, it's not efficient, etc. */
|
||||
/* Please don't be silly and inline these. Inlines are not as wonderful as people think */
|
||||
void memcpy(void *dest, const void *src, int len)
|
||||
{
|
||||
unsigned char *d = dest;
|
||||
|
|
@ -36,3 +37,21 @@ void memset(void *v, unsigned char a, int len)
|
|||
*cp++ = a;
|
||||
}
|
||||
|
||||
/* did you ever notice that the memcmp web page does not specify
|
||||
* a signed or unsigned compare? It matters ... oh well, we assumed unsigned
|
||||
*/
|
||||
int memcmp(const void *s1, const void *s2, size_t n)
|
||||
{
|
||||
const unsigned char *d = s1
|
||||
const unsigned char *s = s2;
|
||||
while (len--){
|
||||
if (*d < *s)
|
||||
return -1;
|
||||
if (*d > *s)
|
||||
return 1;
|
||||
d++, s++;
|
||||
}
|
||||
return 0;
|
||||
|
||||
}
|
||||
|
||||
|
|
|
|||
Loading…
Add table
Add a link
Reference in a new issue