Context Navigation

-              r13dfa3f9
+              r17341d4
 /*
+ * Copyright (c) 2006 Sergey Bondari
+ * Copyright (c) 2006 Jakub Jermar
+ * Copyright (c) 2011 Jiri Svoboda
+ * Copyright (c) 2016 Jiri Svoboda
  * All rights reserved.
+ *
 …
  * @file
  * @brief       Userspace ELF loader.
+ *
- * This module allows loading ELF binaries (both executables and
- * shared objects) from VFS. The current implementation allocates
- * anonymous memory, fills it with segment data and then adjusts
- * the memory areas' flags to the final value. In the future,
- * the segments will be mapped directly from the file.
  */
+#include <errno.h>
 #include <stdio.h>
+#include <sys/types.h>
+#include <align.h>
+#include <assert.h>
+#include <as.h>
+#include <elf/elf.h>
+#include <unistd.h>
+#include <fcntl.h>
+#include <smc.h>
+#include <loader/pcb.h>
+#include <entry_point.h>
+#include <elf/elf_load.h>
+#include <elf/elf_mod.h>
+#include <rtld/rtld.h>
-#include <elf/elf_load.h>
 #define DPRINTF(...)
+static const char *error_codes[] = {
+        "no error",
+        "invalid image",
+        "address space error",
+        "incompatible image",
+        "unsupported image type",
+        "irrecoverable error"
+};
+static unsigned int elf_load(elf_ld_t *elf, size_t so_bias);
+static int segment_header(elf_ld_t *elf, elf_segment_header_t *entry);
+static int section_header(elf_ld_t *elf, elf_section_header_t *entry);
+static int load_segment(elf_ld_t *elf, elf_segment_header_t *entry);
+/** Load ELF binary from a file.
+/** Load ELF program.
+ *
+ * Load an ELF binary from the specified file. If the file is
+ * an executable program, it is loaded unbiased. If it is a shared
+ * object, it is loaded with the bias @a so_bias. Some information
+ * extracted from the binary is stored in a elf_info_t structure
+ * pointed to by @a info.
+ *
+ * @param file_name Path to the ELF file.
+ * @param so_bias   Bias to use if the file is a shared object.
+ * @param info      Pointer to a structure for storing information
+ *                  extracted from the binary.
+ *
+ * @return EOK on success or negative error code.
+ *
+ * @param file_name File name
+ * @param info Place to store ELF program information
+ * @return EOK on success or non-zero error code
  */
+int elf_load_file(const char *file_name, size_t so_bias, eld_flags_t flags,
+    elf_info_t *info)
+int elf_load(const char *file_name, elf_info_t *info)
+{
+        elf_ld_t elf;
+        int fd;
+#ifdef CONFIG_RTLD
+        rtld_t *env;
+#endif
         int rc;
         fd = open(file_name, O_RDONLY);
         if (fd < 0) {
                 DPRINTF("failed opening file\n");
                 return -1;
+        rc = elf_load_file(file_name, 0, 0, &info->finfo);
+        if (rc != EE_OK) {
+                DPRINTF("Failed to load executable '%s'.\n", file_name);
+                return rc;
+        }
+        elf.fd = fd;
+        elf.info = info;
+        elf.flags = flags;
+        if (info->finfo.interp == NULL) {
+                /* Statically linked program */
+                DPRINTF("Binary is statically linked.\n");
+                info->env = NULL;
+                return EE_OK;
+        }
+        rc = elf_load(&elf, so_bias);
+        DPRINTF("Binary is dynamically linked.\n");
+#ifdef CONFIG_RTLD
+        DPRINTF( "- prog dynamic: %p\n", info->finfo.dynamic);
+        close(fd);
+        rc = rtld_prog_process(&info->finfo, &env);
+        info->env = env;
+#else
+        rc = EE_UNSUPPORTED;
+#endif
         return rc;
+}
 /** Create the program control block (PCB).
+/** Set ELF-related PCB entries.
+ *
  * Fills the program control block @a pcb with information from
 …
+ *
  * @param info  Program info structure
  * @return EOK on success or negative error code
+ * @param pcb PCB
  */
 void elf_create_pcb(elf_info_t *info, pcb_t *pcb)
+void elf_set_pcb(elf_info_t *info, pcb_t *pcb)
+{
+        pcb->entry = info->entry;
+        pcb->dynamic = info->dynamic;
+        pcb->rtld_runtime = NULL;
+}
+/** Load an ELF binary.
+ *
+ * The @a elf structure contains the loader state, including
+ * an open file, from which the binary will be loaded,
+ * a pointer to the @c info structure etc.
+ *
+ * @param elf           Pointer to loader state buffer.
+ * @param so_bias       Bias to use if the file is a shared object.
+ * @return EE_OK on success or EE_xx error code.
+ */
+static unsigned int elf_load(elf_ld_t *elf, size_t so_bias)
+{
+        elf_header_t header_buf;
+        elf_header_t *header = &header_buf;
+        int i, rc;
+        rc = read(elf->fd, header, sizeof(elf_header_t));
+        if (rc != sizeof(elf_header_t)) {
+                DPRINTF("Read error.\n");
+                return EE_INVALID;
+        }
+        elf->header = header;
+        /* Identify ELF */
+        if (header->e_ident[EI_MAG0] != ELFMAG0 ||
+            header->e_ident[EI_MAG1] != ELFMAG1 ||
+            header->e_ident[EI_MAG2] != ELFMAG2 ||
+            header->e_ident[EI_MAG3] != ELFMAG3) {
+                DPRINTF("Invalid header.\n");
+                return EE_INVALID;
+        }
+        /* Identify ELF compatibility */
+        if (header->e_ident[EI_DATA] != ELF_DATA_ENCODING ||
+            header->e_machine != ELF_MACHINE ||
+            header->e_ident[EI_VERSION] != EV_CURRENT ||
+            header->e_version != EV_CURRENT ||
+            header->e_ident[EI_CLASS] != ELF_CLASS) {
+                DPRINTF("Incompatible data/version/class.\n");
+                return EE_INCOMPATIBLE;
+        }
+        if (header->e_phentsize != sizeof(elf_segment_header_t)) {
+                DPRINTF("e_phentsize: %u != %zu\n", header->e_phentsize,
+                    sizeof(elf_segment_header_t));
+                return EE_INCOMPATIBLE;
+        }
+        if (header->e_shentsize != sizeof(elf_section_header_t)) {
+                DPRINTF("e_shentsize: %u != %zu\n", header->e_shentsize,
+                    sizeof(elf_section_header_t));
+                return EE_INCOMPATIBLE;
+        }
+        /* Check if the object type is supported. */
+        if (header->e_type != ET_EXEC && header->e_type != ET_DYN) {
+                DPRINTF("Object type %d is not supported\n", header->e_type);
+                return EE_UNSUPPORTED;
+        }
+        /* Shared objects can be loaded with a bias */
+        if (header->e_type == ET_DYN)
+                elf->bias = so_bias;
+        else
+                elf->bias = 0;
+        elf->info->interp = NULL;
+        elf->info->dynamic = NULL;
+        /* Walk through all segment headers and process them. */
+        for (i = 0; i < header->e_phnum; i++) {
+                elf_segment_header_t segment_hdr;
+                /* Seek to start of segment header */
+                lseek(elf->fd, header->e_phoff
+                        + i * sizeof(elf_segment_header_t), SEEK_SET);
+                rc = read(elf->fd, &segment_hdr,
+                    sizeof(elf_segment_header_t));
+                if (rc != sizeof(elf_segment_header_t)) {
+                        DPRINTF("Read error.\n");
+                        return EE_INVALID;
+                }
+                rc = segment_header(elf, &segment_hdr);
+                if (rc != EE_OK)
+                        return rc;
+        }
+        DPRINTF("Parse sections.\n");
+        /* Inspect all section headers and proccess them. */
+        for (i = 0; i < header->e_shnum; i++) {
+                elf_section_header_t section_hdr;
+                /* Seek to start of section header */
+                lseek(elf->fd, header->e_shoff
+                    + i * sizeof(elf_section_header_t), SEEK_SET);
+                rc = read(elf->fd, &section_hdr,
+                    sizeof(elf_section_header_t));
+                if (rc != sizeof(elf_section_header_t)) {
+                        DPRINTF("Read error.\n");
+                        return EE_INVALID;
+                }
+                rc = section_header(elf, &section_hdr);
+                if (rc != EE_OK)
+                        return rc;
+        }
+        elf->info->entry =
+            (entry_point_t)((uint8_t *)header->e_entry + elf->bias);
+        DPRINTF("Done.\n");
+        return EE_OK;
+}
+/** Print error message according to error code.
+ *
+ * @param rc Return code returned by elf_load().
+ *
+ * @return NULL terminated description of error.
+ */
+const char *elf_error(unsigned int rc)
+{
+        assert(rc < sizeof(error_codes) / sizeof(char *));
+        return error_codes[rc];
+}
+/** Process segment header.
+ *
+ * @param entry Segment header.
+ *
+ * @return EE_OK on success, error code otherwise.
+ */
+static int segment_header(elf_ld_t *elf, elf_segment_header_t *entry)
+{
+        switch (entry->p_type) {
+        case PT_NULL:
+        case PT_PHDR:
+        case PT_NOTE:
+                break;
+        case PT_LOAD:
+                return load_segment(elf, entry);
+                break;
+        case PT_INTERP:
+                /* Assume silently interp == "/app/dload" */
+                elf->info->interp = "/app/dload";
+                break;
+        case PT_DYNAMIC:
+                /* Record pointer to dynamic section into info structure */
+                elf->info->dynamic =
+                    (void *)((uint8_t *)entry->p_vaddr + elf->bias);
+                DPRINTF("dynamic section found at %p\n",
+                        (void *)elf->info->dynamic);
+                break;
+        case 0x70000000:
+                /* FIXME: MIPS reginfo */
+                break;
+        case PT_SHLIB:
+//      case PT_LOPROC:
+//      case PT_HIPROC:
+        default:
+                DPRINTF("Segment p_type %d unknown.\n", entry->p_type);
+                return EE_UNSUPPORTED;
+                break;
+        }
+        return EE_OK;
+}
+/** Load segment described by program header entry.
+ *
+ * @param elf   Loader state.
+ * @param entry Program header entry describing segment to be loaded.
+ *
+ * @return EE_OK on success, error code otherwise.
+ */
+int load_segment(elf_ld_t *elf, elf_segment_header_t *entry)
+{
+        void *a;
+        int flags = 0;
+        uintptr_t bias;
+        uintptr_t base;
+        void *seg_ptr;
+        uintptr_t seg_addr;
+        size_t mem_sz;
+        ssize_t rc;
+        bias = elf->bias;
+        seg_addr = entry->p_vaddr + bias;
+        seg_ptr = (void *) seg_addr;
+        DPRINTF("Load segment at addr %p, size 0x%zx\n", (void *) seg_addr,
+                entry->p_memsz);
+        if (entry->p_align > 1) {
+                if ((entry->p_offset % entry->p_align) !=
+                    (seg_addr % entry->p_align)) {
+                        DPRINTF("Align check 1 failed offset%%align=0x%zx, "
+                            "vaddr%%align=0x%zx\n",
+                            entry->p_offset % entry->p_align,
+                            seg_addr % entry->p_align);
+                        return EE_INVALID;
+                }
+        }
+        /* Final flags that will be set for the memory area */
+        if (entry->p_flags & PF_X)
+                flags |= AS_AREA_EXEC;
+        if (entry->p_flags & PF_W)
+                flags |= AS_AREA_WRITE;
+        if (entry->p_flags & PF_R)
+                flags |= AS_AREA_READ;
+        flags |= AS_AREA_CACHEABLE;
+        base = ALIGN_DOWN(entry->p_vaddr, PAGE_SIZE);
+        mem_sz = entry->p_memsz + (entry->p_vaddr - base);
+        DPRINTF("Map to seg_addr=%p-%p.\n", (void *) seg_addr,
+            (void *) (entry->p_vaddr + bias +
+            ALIGN_UP(entry->p_memsz, PAGE_SIZE)));
+        /*
+         * For the course of loading, the area needs to be readable
+         * and writeable.
+         */
+        a = as_area_create((uint8_t *) base + bias, mem_sz,
+            AS_AREA_READ | AS_AREA_WRITE | AS_AREA_CACHEABLE);
+        if (a == AS_MAP_FAILED) {
+                DPRINTF("memory mapping failed (%p, %zu)\n",
+                    (void *) (base + bias), mem_sz);
+                return EE_MEMORY;
+        }
+        DPRINTF("as_area_create(%p, %#zx, %d) -> %p\n",
+            (void *) (base + bias), mem_sz, flags, (void *) a);
+        /*
+         * Load segment data
+         */
+        rc = lseek(elf->fd, entry->p_offset, SEEK_SET);
+        if (rc < 0) {
+                printf("seek error\n");
+                return EE_INVALID;
+        }
+/*      rc = read(fd, (void *)(entry->p_vaddr + bias), entry->p_filesz);
+        if (rc < 0) { printf("read error\n"); return EE_INVALID; }*/
+        /* Long reads are not possible yet. Load segment piecewise. */
+        unsigned left, now;
+        uint8_t *dp;
+        left = entry->p_filesz;
+        dp = seg_ptr;
+        while (left > 0) {
+                now = 16384;
+                if (now > left) now = left;
+                rc = read(elf->fd, dp, now);
+                if (rc != (ssize_t) now) {
+                        DPRINTF("Read error.\n");
+                        return EE_INVALID;
+                }
+                left -= now;
+                dp += now;
+        }
+        /*
+         * The caller wants to modify the segments first. He will then
+         * need to set the right access mode and ensure SMC coherence.
+         */
+        if ((elf->flags & ELDF_RW) != 0) return EE_OK;
+//      printf("set area flags to %d\n", flags);
+        rc = as_area_change_flags(seg_ptr, flags);
+        if (rc != 0) {
+                DPRINTF("Failed to set memory area flags.\n");
+                return EE_MEMORY;
+        }
+        if (flags & AS_AREA_EXEC) {
+                /* Enforce SMC coherence for the segment */
+                if (smc_coherence(seg_ptr, entry->p_filesz))
+                        return EE_MEMORY;
+        }
+        return EE_OK;
+}
+/** Process section header.
+ *
+ * @param elf   Loader state.
+ * @param entry Segment header.
+ *
+ * @return EE_OK on success, error code otherwise.
+ */
+static int section_header(elf_ld_t *elf, elf_section_header_t *entry)
+{
+        switch (entry->sh_type) {
+        case SHT_PROGBITS:
+                if (entry->sh_flags & SHF_TLS) {
+                        /* .tdata */
+                }
+                break;
+        case SHT_NOBITS:
+                if (entry->sh_flags & SHF_TLS) {
+                        /* .tbss */
+                }
+                break;
+        case SHT_DYNAMIC:
+                /* Record pointer to dynamic section into info structure */
+                elf->info->dynamic =
+                    (void *)((uint8_t *)entry->sh_addr + elf->bias);
+                DPRINTF("Dynamic section found at %p.\n",
+                    (void *) elf->info->dynamic);
+                break;
+        default:
+                break;
+        }
+        return EE_OK;
+        pcb->entry = info->finfo.entry;
+        pcb->dynamic = info->finfo.dynamic;
+        pcb->rtld_runtime = info->env;
+}

Note: See TracChangeset for help on using the changeset viewer.

Context Navigation

Changeset 17341d4 in mainline for uspace/lib/c/generic/elf/elf_load.c

Legend:

uspace/lib/c/generic/elf/elf_load.c

Download in other formats: