Add support for processed coreboot payload chainloading.
This commit is contained in:
parent
e6930a454d
commit
99c971afd3
2 changed files with 197 additions and 50 deletions
|
@ -1,3 +1,7 @@
|
||||||
|
2013-06-16 Vladimir Serbinenko <phcoder@gmail.com>
|
||||||
|
|
||||||
|
Add support for processed coreboot payload chainloading.
|
||||||
|
|
||||||
2013-06-16 Vladimir Serbinenko <phcoder@gmail.com>
|
2013-06-16 Vladimir Serbinenko <phcoder@gmail.com>
|
||||||
|
|
||||||
Enable coreboot information commands even when not loaded as
|
Enable coreboot information commands even when not loaded as
|
||||||
|
|
|
@ -29,6 +29,7 @@
|
||||||
#include <grub/i386/relocator.h>
|
#include <grub/i386/relocator.h>
|
||||||
#include <grub/command.h>
|
#include <grub/command.h>
|
||||||
#include <grub/i18n.h>
|
#include <grub/i18n.h>
|
||||||
|
#include <grub/cbfs_core.h>
|
||||||
|
|
||||||
GRUB_MOD_LICENSE ("GPLv3+");
|
GRUB_MOD_LICENSE ("GPLv3+");
|
||||||
|
|
||||||
|
@ -55,14 +56,176 @@ grub_chain_unload (void)
|
||||||
return GRUB_ERR_NONE;
|
return GRUB_ERR_NONE;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static grub_err_t
|
||||||
|
load_elf (grub_file_t file, const char *filename)
|
||||||
|
{
|
||||||
|
grub_elf_t elf;
|
||||||
|
Elf32_Phdr *phdr;
|
||||||
|
grub_err_t err;
|
||||||
|
|
||||||
|
elf = grub_elf_file (file, filename);
|
||||||
|
if (!elf)
|
||||||
|
return grub_errno;
|
||||||
|
|
||||||
|
if (!grub_elf_is_elf32 (elf))
|
||||||
|
return grub_error (GRUB_ERR_BAD_OS, "only ELF32 can be coreboot payload");
|
||||||
|
|
||||||
|
entry = elf->ehdr.ehdr32.e_entry;
|
||||||
|
|
||||||
|
FOR_ELF32_PHDRS(elf, phdr)
|
||||||
|
{
|
||||||
|
grub_uint8_t *load_addr;
|
||||||
|
grub_relocator_chunk_t ch;
|
||||||
|
|
||||||
|
if (phdr->p_type != PT_LOAD)
|
||||||
|
continue;
|
||||||
|
|
||||||
|
err = grub_relocator_alloc_chunk_addr (relocator, &ch,
|
||||||
|
phdr->p_paddr, phdr->p_memsz);
|
||||||
|
if (err)
|
||||||
|
{
|
||||||
|
elf->file = 0;
|
||||||
|
grub_elf_close (elf);
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
|
load_addr = get_virtual_current_address (ch);
|
||||||
|
|
||||||
|
if (grub_file_seek (elf->file, phdr->p_offset) == (grub_off_t) -1)
|
||||||
|
{
|
||||||
|
elf->file = 0;
|
||||||
|
grub_elf_close (elf);
|
||||||
|
return grub_errno;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (phdr->p_filesz)
|
||||||
|
{
|
||||||
|
grub_ssize_t read;
|
||||||
|
read = grub_file_read (elf->file, load_addr, phdr->p_filesz);
|
||||||
|
if (read != (grub_ssize_t) phdr->p_filesz)
|
||||||
|
{
|
||||||
|
if (!grub_errno)
|
||||||
|
grub_error (GRUB_ERR_FILE_READ_ERROR,
|
||||||
|
N_("premature end of file %s"),
|
||||||
|
filename);
|
||||||
|
elf->file = 0;
|
||||||
|
grub_elf_close (elf);
|
||||||
|
return grub_errno;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if (phdr->p_filesz < phdr->p_memsz)
|
||||||
|
grub_memset ((load_addr + phdr->p_filesz),
|
||||||
|
0, phdr->p_memsz - phdr->p_filesz);
|
||||||
|
}
|
||||||
|
|
||||||
|
elf->file = 0;
|
||||||
|
grub_elf_close (elf);
|
||||||
|
return GRUB_ERR_NONE;
|
||||||
|
}
|
||||||
|
|
||||||
|
static grub_err_t
|
||||||
|
load_segment (grub_file_t file, const char *filename,
|
||||||
|
void *load_addr, grub_uint32_t comp,
|
||||||
|
grub_size_t size)
|
||||||
|
{
|
||||||
|
switch (comp)
|
||||||
|
{
|
||||||
|
case grub_cpu_to_be32_compile_time (CBFS_COMPRESS_NONE):
|
||||||
|
if (grub_file_read (file, load_addr, size)
|
||||||
|
!= (grub_ssize_t) size)
|
||||||
|
{
|
||||||
|
if (!grub_errno)
|
||||||
|
grub_error (GRUB_ERR_FILE_READ_ERROR,
|
||||||
|
N_("premature end of file %s"),
|
||||||
|
filename);
|
||||||
|
return grub_errno;
|
||||||
|
}
|
||||||
|
return GRUB_ERR_NONE;
|
||||||
|
default:
|
||||||
|
return grub_error (GRUB_ERR_BAD_OS, "unsupported compression %d",
|
||||||
|
grub_be_to_cpu32 (comp));
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static grub_err_t
|
||||||
|
load_chewed (grub_file_t file, const char *filename)
|
||||||
|
{
|
||||||
|
grub_size_t i;
|
||||||
|
for (i = 0;; i++)
|
||||||
|
{
|
||||||
|
struct cbfs_payload_segment segment;
|
||||||
|
grub_err_t err;
|
||||||
|
|
||||||
|
if (grub_file_seek (file, sizeof (segment) * i) == (grub_off_t) -1
|
||||||
|
|| grub_file_read (file, &segment, sizeof (segment))
|
||||||
|
!= sizeof (segment))
|
||||||
|
{
|
||||||
|
if (!grub_errno)
|
||||||
|
return grub_error (GRUB_ERR_BAD_OS,
|
||||||
|
"payload is too short");
|
||||||
|
return grub_errno;
|
||||||
|
}
|
||||||
|
|
||||||
|
switch (segment.type)
|
||||||
|
{
|
||||||
|
case PAYLOAD_SEGMENT_PARAMS:
|
||||||
|
break;
|
||||||
|
|
||||||
|
case PAYLOAD_SEGMENT_ENTRY:
|
||||||
|
entry = grub_be_to_cpu64 (segment.load_addr);
|
||||||
|
return GRUB_ERR_NONE;
|
||||||
|
|
||||||
|
case PAYLOAD_SEGMENT_BSS:
|
||||||
|
segment.len = 0;
|
||||||
|
segment.offset = 0;
|
||||||
|
segment.len = 0;
|
||||||
|
case PAYLOAD_SEGMENT_CODE:
|
||||||
|
case PAYLOAD_SEGMENT_DATA:
|
||||||
|
{
|
||||||
|
grub_uint32_t target = grub_be_to_cpu64 (segment.load_addr);
|
||||||
|
grub_uint32_t memsize = grub_be_to_cpu32 (segment.mem_len);
|
||||||
|
grub_uint32_t filesize = grub_be_to_cpu32 (segment.len);
|
||||||
|
grub_uint8_t *load_addr;
|
||||||
|
grub_relocator_chunk_t ch;
|
||||||
|
|
||||||
|
if (memsize < filesize)
|
||||||
|
memsize = filesize;
|
||||||
|
|
||||||
|
err = grub_relocator_alloc_chunk_addr (relocator, &ch,
|
||||||
|
target, memsize);
|
||||||
|
if (err)
|
||||||
|
return err;
|
||||||
|
|
||||||
|
load_addr = get_virtual_current_address (ch);
|
||||||
|
|
||||||
|
if (filesize)
|
||||||
|
{
|
||||||
|
if (grub_file_seek (file, grub_be_to_cpu32 (segment.offset))
|
||||||
|
== (grub_off_t) -1)
|
||||||
|
return grub_errno;
|
||||||
|
|
||||||
|
err = load_segment (file, filename, load_addr,
|
||||||
|
segment.compression, filesize);
|
||||||
|
if (err)
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (filesize < memsize)
|
||||||
|
grub_memset ((load_addr + filesize),
|
||||||
|
0, memsize - filesize);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
static grub_err_t
|
static grub_err_t
|
||||||
grub_cmd_chain (grub_command_t cmd __attribute__ ((unused)),
|
grub_cmd_chain (grub_command_t cmd __attribute__ ((unused)),
|
||||||
int argc, char *argv[])
|
int argc, char *argv[])
|
||||||
{
|
{
|
||||||
grub_err_t err;
|
grub_err_t err;
|
||||||
grub_file_t file;
|
grub_file_t file;
|
||||||
grub_elf_t elf;
|
grub_uint32_t head;
|
||||||
Elf32_Phdr *phdr;
|
|
||||||
|
|
||||||
if (argc != 1)
|
if (argc != 1)
|
||||||
return grub_error (GRUB_ERR_BAD_ARGUMENT, N_("filename expected"));
|
return grub_error (GRUB_ERR_BAD_ARGUMENT, N_("filename expected"));
|
||||||
|
@ -80,63 +243,43 @@ grub_cmd_chain (grub_command_t cmd __attribute__ ((unused)),
|
||||||
return grub_errno;
|
return grub_errno;
|
||||||
}
|
}
|
||||||
|
|
||||||
elf = grub_elf_file (file, argv[0]);
|
if (grub_file_read (file, &head, sizeof (head)) != sizeof (head)
|
||||||
if (!elf)
|
|| grub_file_seek (file, 0) == (grub_off_t) -1)
|
||||||
{
|
{
|
||||||
grub_relocator_unload (relocator);
|
|
||||||
relocator = 0;
|
|
||||||
grub_file_close (file);
|
grub_file_close (file);
|
||||||
|
grub_relocator_unload (relocator);
|
||||||
|
relocator = 0;
|
||||||
|
if (!grub_errno)
|
||||||
|
return grub_error (GRUB_ERR_BAD_OS,
|
||||||
|
"payload is too short");
|
||||||
|
return grub_errno;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (!grub_elf_is_elf32 (elf))
|
switch (head)
|
||||||
|
{
|
||||||
|
case ELFMAG0 | (ELFMAG1 << 8) | (ELFMAG2 << 16) | (ELFMAG3 << 24):
|
||||||
|
err = load_elf (file, argv[0]);
|
||||||
|
break;
|
||||||
|
case PAYLOAD_SEGMENT_CODE:
|
||||||
|
case PAYLOAD_SEGMENT_DATA:
|
||||||
|
case PAYLOAD_SEGMENT_PARAMS:
|
||||||
|
case PAYLOAD_SEGMENT_BSS:
|
||||||
|
case PAYLOAD_SEGMENT_ENTRY:
|
||||||
|
err = load_chewed (file, argv[0]);
|
||||||
|
break;
|
||||||
|
|
||||||
|
default:
|
||||||
|
err = grub_error (GRUB_ERR_BAD_OS, "unrecognised payload type");
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
grub_file_close (file);
|
||||||
|
if (err)
|
||||||
{
|
{
|
||||||
grub_relocator_unload (relocator);
|
grub_relocator_unload (relocator);
|
||||||
relocator = 0;
|
relocator = 0;
|
||||||
grub_elf_close (elf);
|
return err;
|
||||||
}
|
}
|
||||||
|
|
||||||
entry = elf->ehdr.ehdr32.e_entry;
|
|
||||||
|
|
||||||
FOR_ELF32_PHDRS(elf, phdr)
|
|
||||||
{
|
|
||||||
grub_uint8_t *load_addr;
|
|
||||||
grub_relocator_chunk_t ch;
|
|
||||||
|
|
||||||
if (phdr->p_type != PT_LOAD)
|
|
||||||
continue;
|
|
||||||
|
|
||||||
err = grub_relocator_alloc_chunk_addr (relocator, &ch,
|
|
||||||
phdr->p_paddr, phdr->p_memsz);
|
|
||||||
if (err)
|
|
||||||
break;
|
|
||||||
|
|
||||||
load_addr = get_virtual_current_address (ch);
|
|
||||||
|
|
||||||
if (grub_file_seek (elf->file, phdr->p_offset) == (grub_off_t) -1)
|
|
||||||
return grub_errno;
|
|
||||||
|
|
||||||
if (phdr->p_filesz)
|
|
||||||
{
|
|
||||||
grub_ssize_t read;
|
|
||||||
read = grub_file_read (elf->file, load_addr, phdr->p_filesz);
|
|
||||||
if (read != (grub_ssize_t) phdr->p_filesz)
|
|
||||||
{
|
|
||||||
if (!grub_errno)
|
|
||||||
grub_error (GRUB_ERR_FILE_READ_ERROR, N_("premature end of file %s"),
|
|
||||||
argv[0]);
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
if (phdr->p_filesz < phdr->p_memsz)
|
|
||||||
grub_memset ((load_addr + phdr->p_filesz),
|
|
||||||
0, phdr->p_memsz - phdr->p_filesz);
|
|
||||||
}
|
|
||||||
|
|
||||||
grub_elf_close (elf);
|
|
||||||
if (grub_errno)
|
|
||||||
return grub_errno;
|
|
||||||
|
|
||||||
grub_loader_set (grub_chain_boot, grub_chain_unload, 0);
|
grub_loader_set (grub_chain_boot, grub_chain_unload, 0);
|
||||||
return GRUB_ERR_NONE;
|
return GRUB_ERR_NONE;
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in a new issue