[PATCH v6 2/4] KEYS: Add ELF class-independent certificate insertion support

From: Mehmet Kayaalp
Date: Wed May 02 2018 - 19:08:56 EST


This patch adds support for handling either 32-bit or 64-bit ELF files
by moving ELF class checks to runtime. This makes it possible to compile
the script for 64-bit, and the kernel for 32-bit (e.g. make ARCH=i386 on
x86-64). Gelf/libelf is purposely not used to avoid the build dependency.

Signed-off-by: Mehmet Kayaalp <mkayaalp@xxxxxxxxxxxxxxxxxx>
---
scripts/insert-sys-cert.c | 331 +++++++++++++++++++++++++-------------
1 file changed, 218 insertions(+), 113 deletions(-)

diff --git a/scripts/insert-sys-cert.c b/scripts/insert-sys-cert.c
index 8902836c2342..10a17504dc87 100644
--- a/scripts/insert-sys-cert.c
+++ b/scripts/insert-sys-cert.c
@@ -25,6 +25,7 @@
#include <fcntl.h>
#include <unistd.h>
#include <elf.h>
+#include <linux/types.h>

#define CERT_SYM "system_extra_cert"
#define USED_SYM "system_extra_cert_used"
@@ -57,6 +58,18 @@ static unsigned char endianness(void)
return ELFDATA2LSB;
}

+struct elf {
+ unsigned char *base;
+ int size;
+ unsigned char eclass;
+ unsigned char data;
+ unsigned long shoff;
+ unsigned long shnum;
+ unsigned long shentsize;
+ unsigned char *shstart;
+ unsigned long shsize;
+};
+
struct sym {
char *name;
unsigned long address;
@@ -65,24 +78,92 @@ struct sym {
int size;
};

-static unsigned long get_offset_from_address(Elf_Ehdr *hdr, unsigned long addr)
+static int read_elf_data(struct elf *elf, char *base, int size)
{
- Elf_Shdr *x;
- unsigned int i, num_sections;
+ unsigned char *e_ident;
+ Elf32_Ehdr *e32 = (Elf32_Ehdr *)base;
+ Elf64_Ehdr *e64 = (Elf64_Ehdr *)base;

- x = (void *)hdr + hdr->e_shoff;
- if (hdr->e_shnum == SHN_UNDEF)
- num_sections = x[0].sh_size;
- else
- num_sections = hdr->e_shnum;
+ elf->base = (unsigned char *)base;
+ elf->size = size;
+
+ if (size < EI_NIDENT) {
+ err("Invalid file size for ELF format.\n");
+ return -1;
+ }
+ e_ident = (unsigned char *)base;
+ if (e_ident[EI_MAG0] != ELFMAG0 || e_ident[EI_MAG1] != ELFMAG1 ||
+ e_ident[EI_MAG2] != ELFMAG2 || e_ident[EI_MAG3] != ELFMAG3) {
+ err("Invalid ELF magic.\n");
+ return -1;
+ }
+ elf->eclass = e_ident[EI_CLASS];
+ if (elf->eclass != ELFCLASS32 && elf->eclass != ELFCLASS64) {
+ err("Invalid ELF class.\n");
+ return -1;
+ }
+ elf->data = e_ident[EI_DATA];
+ if (elf->data != endianness()) {
+ err("ELF endian mismatch.\n");
+ return -1;
+ }
+ if (e_ident[EI_VERSION] != EV_CURRENT) {
+ err("Invalid ELF file version.\n");
+ return -1;
+ }
+ if (elf->eclass == ELFCLASS32) {
+ elf->shoff = e32->e_shoff;
+ elf->shnum = e32->e_shnum;
+ elf->shentsize = e32->e_shentsize;
+ } else {
+ elf->shoff = e64->e_shoff;
+ elf->shnum = e64->e_shnum;
+ elf->shentsize = e64->e_shentsize;
+ }
+ if (elf->shoff == 0 || elf->shoff > size) {
+ err("Could not find section header.\n");
+ exit(EXIT_FAILURE);
+ }
+ elf->shstart = elf->base + elf->shoff;
+ elf->shsize = elf->shnum * elf->shentsize;
+ return 0;
+}

- for (i = 1; i < num_sections; i++) {
- unsigned long start = x[i].sh_addr;
- unsigned long end = start + x[i].sh_size;
- unsigned long offset = x[i].sh_offset;
+static char *get_elf_string(struct elf *elf, unsigned long link,
+ unsigned long namendx)
+{
+ unsigned char *p = elf->shstart + link * elf->shentsize;
+ Elf32_Shdr *s32 = (Elf32_Shdr *)p;
+ Elf64_Shdr *s64 = (Elf64_Shdr *)p;

+ if (elf->eclass == ELFCLASS32)
+ return (char *)elf->base + s32->sh_offset + namendx;
+ else
+ return (char *)elf->base + s64->sh_offset + namendx;
+}
+
+static unsigned long get_offset_from_address(struct elf *elf,
+ unsigned long addr)
+{
+ unsigned long start, end, offset;
+ unsigned char *p = elf->shstart;
+
+ while (p < elf->shstart + elf->shsize) {
+ Elf32_Shdr *s32 = (Elf32_Shdr *)p;
+ Elf64_Shdr *s64 = (Elf64_Shdr *)p;
+
+ if (elf->eclass == ELFCLASS32) {
+ start = s32->sh_addr;
+ end = start + s32->sh_size;
+ offset = s32->sh_offset;
+ } else {
+ start = s64->sh_addr;
+ end = start + s64->sh_size;
+ offset = s64->sh_offset;
+ }
if (addr >= start && addr <= end)
return addr - start + offset;
+ p += elf->shentsize;
}
return 0;
}
@@ -90,7 +171,7 @@ static unsigned long get_offset_from_address(Elf_Ehdr *hdr, unsigned long addr)

#define LINE_SIZE 100

-static void get_symbol_from_map(Elf_Ehdr *hdr, FILE *f, char *name,
+static void get_symbol_from_map(struct elf *elf, FILE *f, char *name,
struct sym *s)
{
char l[LINE_SIZE];
@@ -125,76 +206,108 @@ static void get_symbol_from_map(Elf_Ehdr *hdr, FILE *f, char *name,
s->address = strtoul(l, NULL, 16);
if (s->address == 0)
return;
- s->offset = get_offset_from_address(hdr, s->address);
+ s->offset = get_offset_from_address(elf, s->address);
s->name = name;
- s->content = (void *)hdr + s->offset;
+ s->content = elf->base + s->offset;
}

-static Elf_Sym *find_elf_symbol(Elf_Ehdr *hdr, Elf_Shdr *symtab, char *name)
-{
- Elf_Sym *sym, *symtab_start;
- char *strtab, *symname;
- unsigned int link;
- Elf_Shdr *x;
- int i, n;
-
- x = (void *)hdr + hdr->e_shoff;
- link = symtab->sh_link;
- symtab_start = (void *)hdr + symtab->sh_offset;
- n = symtab->sh_size / symtab->sh_entsize;
- strtab = (void *)hdr + x[link].sh_offset;
-
- for (i = 0; i < n; i++) {
- sym = &symtab_start[i];
- symname = strtab + sym->st_name;
- if (strcmp(symname, name) == 0)
- return sym;
- }
- err("Unable to find symbol: %s\n", name);
- return NULL;
-}
-
-static void get_symbol_from_table(Elf_Ehdr *hdr, Elf_Shdr *symtab,
+static void get_symbol_from_table(struct elf *elf, unsigned char *symtab,
char *name, struct sym *s)
{
- Elf_Shdr *sec;
- int secndx;
- Elf_Sym *elf_sym;
- Elf_Shdr *x;
+ Elf32_Shdr *s32 = (Elf32_Shdr *)symtab;
+ Elf64_Shdr *s64 = (Elf64_Shdr *)symtab;
+ unsigned char *p;
+ unsigned long address;
+ unsigned long offset;
+ unsigned long size;
+ unsigned long entsize;
+ unsigned long link;
+ unsigned long shndx;
+ char *symname;
+ int found = 0;

- x = (void *)hdr + hdr->e_shoff;
s->size = 0;
s->address = 0;
s->offset = 0;
- elf_sym = find_elf_symbol(hdr, symtab, name);
- if (!elf_sym)
- return;
- secndx = elf_sym->st_shndx;
- if (!secndx)
+
+ if (elf->eclass == ELFCLASS32) {
+ offset = s32->sh_offset;
+ size = s32->sh_size;
+ entsize = s32->sh_entsize;
+ link = s32->sh_link;
+ } else {
+ offset = s64->sh_offset;
+ size = s64->sh_size;
+ entsize = s64->sh_entsize;
+ link = s64->sh_link;
+ }
+
+ p = elf->base + offset;
+ while (p < elf->base + offset + size) {
+ Elf32_Sym *sym32 = (Elf32_Sym *)p;
+ Elf64_Sym *sym64 = (Elf64_Sym *)p;
+ unsigned long namendx;
+
+ if (elf->eclass == ELFCLASS32) {
+ namendx = sym32->st_name;
+ shndx = sym32->st_shndx;
+ } else {
+ namendx = sym64->st_name;
+ shndx = sym64->st_shndx;
+ }
+
+ symname = get_elf_string(elf, link, namendx);
+ if (strcmp(symname, name) == 0 && shndx) {
+ found = 1;
+ if (elf->eclass == ELFCLASS32) {
+ s->size = sym32->st_size;
+ s->address = sym32->st_value;
+ } else {
+ s->size = sym64->st_size;
+ s->address = sym64->st_value;
+ }
+ break;
+ }
+ p += entsize;
+ }
+
+ if (!found)
return;
- sec = &x[secndx];
- s->size = elf_sym->st_size;
- s->address = elf_sym->st_value;
- s->offset = s->address - sec->sh_addr
- + sec->sh_offset;
+
+ p = elf->shstart + shndx * elf->shentsize;
+ s32 = (Elf32_Shdr *)p;
+ s64 = (Elf64_Shdr *)p;
+
+ if (elf->eclass == ELFCLASS32) {
+ offset = s32->sh_offset;
+ address = s32->sh_addr;
+ } else {
+ offset = s64->sh_offset;
+ address = s64->sh_addr;
+ }
+
+ s->offset = s->address - address + offset;
s->name = name;
- s->content = (void *)hdr + s->offset;
+ s->content = elf->base + s->offset;
}

-static Elf_Shdr *get_symbol_table(Elf_Ehdr *hdr)
+static unsigned char *get_symbol_table(struct elf *elf)
{
- Elf_Shdr *x;
- unsigned int i, num_sections;
-
- x = (void *)hdr + hdr->e_shoff;
- if (hdr->e_shnum == SHN_UNDEF)
- num_sections = x[0].sh_size;
- else
- num_sections = hdr->e_shnum;
-
- for (i = 1; i < num_sections; i++)
- if (x[i].sh_type == SHT_SYMTAB)
- return &x[i];
+ unsigned char *p = elf->shstart;
+
+ while (p < elf->shstart + elf->shsize) {
+ Elf32_Shdr *s32 = (Elf32_Shdr *)p;
+ Elf64_Shdr *s64 = (Elf64_Shdr *)p;
+
+ if (elf->eclass == ELFCLASS32) {
+ if (s32->sh_type == SHT_SYMTAB)
+ return p;
+ } else {
+ if (s64->sh_type == SHT_SYMTAB)
+ return p;
+ }
+ p += elf->shentsize;
+ }
return NULL;
}

@@ -257,7 +370,7 @@ static char *read_file(char *file_name, int *size)
return buf;
}

-static void print_sym(Elf_Ehdr *hdr, struct sym *s)
+static void print_sym(struct sym *s)
{
info("sym: %s\n", s->name);
info("addr: 0x%lx\n", s->address);
@@ -277,14 +390,14 @@ int main(int argc, char **argv)
char *cert_file = NULL;
int vmlinux_size;
int cert_size;
- Elf_Ehdr *hdr;
+ char *vmlinux;
char *cert;
FILE *system_map;
- unsigned long *lsize;
int *used;
int opt;
- Elf_Shdr *symtab = NULL;
struct sym cert_sym, lsize_sym, used_sym;
+ struct elf elf;
+ unsigned char *symtab = NULL;

while ((opt = getopt(argc, argv, "b:c:s:")) != -1) {
switch (opt) {
@@ -311,39 +424,16 @@ int main(int argc, char **argv)
if (!cert)
exit(EXIT_FAILURE);

- hdr = map_file(vmlinux_file, &vmlinux_size);
- if (!hdr)
+ vmlinux = map_file(vmlinux_file, &vmlinux_size);
+ if (!vmlinux)
exit(EXIT_FAILURE);

- if (vmlinux_size < sizeof(*hdr)) {
- err("Invalid ELF file.\n");
- exit(EXIT_FAILURE);
- }
-
- if ((hdr->e_ident[EI_MAG0] != ELFMAG0) ||
- (hdr->e_ident[EI_MAG1] != ELFMAG1) ||
- (hdr->e_ident[EI_MAG2] != ELFMAG2) ||
- (hdr->e_ident[EI_MAG3] != ELFMAG3)) {
- err("Invalid ELF magic.\n");
+ if (read_elf_data(&elf, vmlinux, vmlinux_size)) {
+ err("Unable to read ELF file.\n");
exit(EXIT_FAILURE);
}

- if (hdr->e_ident[EI_CLASS] != CURRENT_ELFCLASS) {
- err("ELF class mismatch.\n");
- exit(EXIT_FAILURE);
- }
-
- if (hdr->e_ident[EI_DATA] != endianness()) {
- err("ELF endian mismatch.\n");
- exit(EXIT_FAILURE);
- }
-
- if (hdr->e_shoff > vmlinux_size) {
- err("Could not find section header.\n");
- exit(EXIT_FAILURE);
- }
-
- symtab = get_symbol_table(hdr);
+ symtab = get_symbol_table(&elf);
if (!symtab) {
warn("Could not find the symbol table.\n");
if (!system_map_file) {
@@ -357,27 +447,28 @@ int main(int argc, char **argv)
perror(system_map_file);
exit(EXIT_FAILURE);
}
- get_symbol_from_map(hdr, system_map, CERT_SYM, &cert_sym);
- get_symbol_from_map(hdr, system_map, USED_SYM, &used_sym);
- get_symbol_from_map(hdr, system_map, LSIZE_SYM, &lsize_sym);
+ get_symbol_from_map(&elf, system_map, CERT_SYM, &cert_sym);
+ get_symbol_from_map(&elf, system_map, USED_SYM, &used_sym);
+ get_symbol_from_map(&elf, system_map, LSIZE_SYM, &lsize_sym);
cert_sym.size = used_sym.address - cert_sym.address;
} else {
info("Symbol table found.\n");
if (system_map_file)
warn("System.map is ignored.\n");
- get_symbol_from_table(hdr, symtab, CERT_SYM, &cert_sym);
- get_symbol_from_table(hdr, symtab, USED_SYM, &used_sym);
- get_symbol_from_table(hdr, symtab, LSIZE_SYM, &lsize_sym);
+ get_symbol_from_table(&elf, symtab, CERT_SYM, &cert_sym);
+ get_symbol_from_table(&elf, symtab, USED_SYM, &used_sym);
+ get_symbol_from_table(&elf, symtab, LSIZE_SYM, &lsize_sym);
}

- if (!cert_sym.offset || !lsize_sym.offset || !used_sym.offset)
+ if (!cert_sym.offset || !lsize_sym.offset || !used_sym.offset) {
+ err("Unable to find symbols.\n");
exit(EXIT_FAILURE);
+ }

- print_sym(hdr, &cert_sym);
- print_sym(hdr, &used_sym);
- print_sym(hdr, &lsize_sym);
+ print_sym(&cert_sym);
+ print_sym(&used_sym);
+ print_sym(&lsize_sym);

- lsize = (unsigned long *)lsize_sym.content;
used = (int *)used_sym.content;

if (cert_sym.size < cert_size) {
@@ -400,11 +491,25 @@ int main(int argc, char **argv)
memset(cert_sym.content + cert_size,
0, cert_sym.size - cert_size);

- *lsize = *lsize + cert_size - *used;
+ if (elf.eclass == ELFCLASS64) {
+ u64 *lsize;
+
+ lsize = (u64 *)lsize_sym.content;
+ *lsize = *lsize + cert_size - *used;
+ } else {
+ u32 *lsize;
+
+ lsize = (u32 *)lsize_sym.content;
+ *lsize = *lsize + cert_size - *used;
+ }
*used = cert_size;
info("Inserted the contents of %s into %lx.\n", cert_file,
cert_sym.address);
info("Used %d bytes out of %d bytes reserved.\n", *used,
cert_sym.size);
+ if (munmap(vmlinux, vmlinux_size) == -1) {
+ perror(vmlinux_file);
+ exit(EXIT_FAILURE);
+ }
exit(EXIT_SUCCESS);
}
--
2.17.0