123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826 |
- /*
- * Copyright (c) 2006-2023, RT-Thread Development Team
- *
- * SPDX-License-Identifier: Apache-2.0
- *
- * Change Logs:
- * Date Author Notes
- * 2023-08-23 zhangsz first version
- */
- #include <rtthread.h>
- #ifdef RT_USING_LDSO
- #include <dfs_file.h>
- #include <unistd.h>
- #include <stdio.h>
- #include <fcntl.h>
- #include <lwp_elf.h>
- #include "lwp.h"
- #include "lwp_arch.h"
- #ifdef ARCH_MM_MMU
- #include <lwp_user_mm.h>
- #endif
- #ifdef RT_USING_VDSO
- #include <vdso.h>
- #endif
- #define DBG_TAG "load.elf"
- #ifdef ELF_DEBUG_ENABLE
- #define DBG_LVL DBG_LOG
- #else
- #define DBG_LVL DBG_INFO
- #endif
- #include <rtdbg.h>
- #define ELF_INVALID_FD -1
- #define ELF_PHDR_NUM_MAX 128
- #define FILE_LENGTH_MAX 0xC0000000
- #define MEM_SIZE_MAX 0xC0000000
- #define ELF_PATH_MAX 256
- #define FLF_PATH_MIN 1
- #define ELF_PAGESTART(_v) ((_v) & ~(rt_ubase_t)(ARCH_PAGE_SIZE - 1))
- #define ELF_PAGEOFFSET(_v) ((_v) & (ARCH_PAGE_SIZE - 1))
- #define ELF_PAGEALIGN(_v) (((_v) + ARCH_PAGE_SIZE - 1) & ~(ARCH_PAGE_SIZE - 1))
- #define ELF_EXEC_LOAD_ADDR USER_VADDR_START
- #define ELF_INTERP_LOAD_ADDR LDSO_LOAD_VADDR
- #define ELF_AUX_ENT(aux, id, val) \
- do \
- { \
- rt_base_t a = id; \
- lwp_data_put(lwp, aux++, &a, sizeof(rt_ubase_t)); \
- a = val; \
- lwp_data_put(lwp, aux++, &a, sizeof(rt_ubase_t)); \
- } while (0)
- typedef struct
- {
- int fd;
- char *filename;
- rt_size_t file_len;
- Elf_Ehdr ehdr;
- Elf_Phdr *phdr;
- rt_ubase_t map_size;
- } elf_info_t;
- typedef struct
- {
- struct rt_lwp *lwp;
- struct process_aux *aux;
- elf_info_t exec_info;
- elf_info_t interp_info;
- rt_ubase_t load_addr;
- rt_ubase_t e_entry;
- rt_ubase_t interp_base;
- } elf_load_info_t;
- static void elf_user_dump(struct rt_lwp *lwp, void *va, size_t len)
- {
- #ifdef ELF_DEBUG_DUMP
- uint8_t *k_va;
- int ret;
- if (len < 16)
- len = 16;
- rt_kprintf("\r\n");
- rt_kprintf("%s : user va : %p, len : 0x%x(%d)\n", __func__, va, len, len);
- k_va = rt_malloc(len);
- if (k_va == RT_NULL)
- {
- rt_kprintf("%s : malloc failed\n", __func__);
- return;
- }
- rt_memset(k_va, 0, len);
- ret = lwp_data_get(lwp, k_va, va, len);
- if (ret != len)
- {
- rt_kprintf("%s : lwp_get_from_user failed, ret = %d\n", __func__, ret);
- return;
- }
- rt_kprintf("%s : k_va : %p\n", __func__, k_va);
- for (size_t i = 0; i < len; i += 16)
- {
- rt_kprintf(" %02x %02x %02x %02x %02x %02x %02x %02x ", k_va[i], k_va[i+1], k_va[i+2], k_va[i+3],
- k_va[i+4], k_va[i+5], k_va[i+6], k_va[i+7]);
- rt_kprintf(" %02x %02x %02x %02x %02x %02x %02x %02x \n", k_va[i+8], k_va[i+9], k_va[i+10], k_va[i+11],
- k_va[i+12], k_va[i+13], k_va[i+14], k_va[i+15]);
- }
- rt_kprintf("\r\n");
- rt_free(k_va);
- #endif
- }
- rt_ubase_t elf_random_offset(void)
- {
- #ifdef ELF_LOAD_RANDOMIZE
- return (rt_tick_get() % 65535) * ARCH_PAGE_SIZE;
- #else
- return ELF_PAGEALIGN(0);
- #endif
- }
- static void *file_mmap(struct rt_lwp *lwp, int fd, rt_ubase_t load_addr,
- rt_ubase_t map_size, size_t prot, size_t flags, rt_ubase_t offset)
- {
- uint8_t *map_va;
- map_va = (uint8_t *)lwp_mmap2(lwp, (void *)load_addr, map_size, prot, flags, fd, offset >> ARCH_PAGE_SHIFT);
- if (!map_va || (map_va != (uint8_t *)load_addr))
- {
- LOG_E("%s : lwp map user failed!", __func__);
- return RT_NULL;
- }
- LOG_D(" %s : map va = %p load_addr : %p size : 0x%x", __func__, map_va, load_addr, map_size);
- return map_va;
- }
- static int elf_file_open(const char *filename)
- {
- int fd = -1;
- fd = open(filename, O_BINARY | O_RDONLY, 0);
- if (fd < 0)
- {
- LOG_E("%s : elf file [%s] open failed!", __func__, filename);
- }
- return fd;
- }
- static int elf_file_close(int fd)
- {
- return close(fd);
- }
- static int elf_file_length(char *filename, rt_size_t *file_len)
- {
- int ret;
- struct stat s = { 0 };
- ret = stat(filename, &s);
- if (ret != 0)
- {
- LOG_E("%s : error", __func__);
- return -RT_ERROR;
- }
- *file_len = (rt_size_t)s.st_size;
- return RT_EOK;
- }
- static int elf_file_read(rt_int32_t fd, rt_uint8_t *buffer, size_t size, off_t offset)
- {
- ssize_t read_len;
- off_t pos;
- if (size > 0)
- {
- pos = lseek(fd, offset, SEEK_SET);
- if (pos != offset)
- {
- LOG_E("%s : seek file offset: 0x%x failed", __func__, offset);
- return -RT_ERROR;
- }
- read_len = read(fd, buffer, size);
- if (read_len != size)
- {
- LOG_E("%s : read from offset: 0x%x error", __func__, offset);
- return -RT_ERROR;
- }
- }
- return RT_EOK;
- }
- static rt_int32_t elf_check_ehdr(const Elf_Ehdr *ehdr, rt_uint32_t file_len)
- {
- if (memcmp(ehdr->e_ident, ELFMAG, SELFMAG) != 0)
- {
- LOG_E("%s : e_ident error", __func__);
- return -RT_ERROR;
- }
- if ((ehdr->e_type != ET_EXEC) && (ehdr->e_type != ET_DYN))
- {
- LOG_E("%s : e_type error", __func__);
- return -RT_ERROR;
- }
- if (ehdr->e_machine == EM_NONE)
- {
- LOG_E("%s : e_machine is EM_NONE", __func__);
- return -RT_ERROR;
- }
- if (ehdr->e_phnum > ELF_PHDR_NUM_MAX)
- {
- LOG_E("%s : e_phnum error", __func__);
- return -RT_ERROR;
- }
- if (ehdr->e_phoff > file_len)
- {
- LOG_E("%s : e_phoff error", __func__);
- return -RT_ERROR;
- }
- LOG_D("%s : e_entry : 0x%x", __func__, ehdr->e_entry);
- return RT_EOK;
- }
- static int elf_check_phdr(const Elf_Phdr *phdr)
- {
- if (phdr->p_filesz > FILE_LENGTH_MAX)
- {
- LOG_E("%s : phdr p_filesz 0x%x error", __func__, phdr->p_filesz);
- return -RT_ERROR;
- }
- if (phdr->p_offset > FILE_LENGTH_MAX)
- {
- LOG_E("%s : phdr p_offset 0x%x error", __func__, phdr->p_offset);
- return -RT_ERROR;
- }
- if (phdr->p_memsz > MEM_SIZE_MAX)
- {
- LOG_E("%s[%d], phdr p_memsz 0x%x error", __func__, phdr->p_memsz);
- return -RT_ERROR;
- }
- LOG_D("%s : phdr p_vaddr : 0x%x", __func__, phdr->p_vaddr);
- return RT_EOK;
- }
- static int elf_load_ehdr(elf_info_t *elf_info)
- {
- int ret;
- ret = elf_file_open(elf_info->filename);
- if (ret < 0)
- {
- LOG_E("%s : elf_file_open %s failed", __func__, elf_info->filename);
- return ret;
- }
- elf_info->fd = ret;
- ret = elf_file_length(elf_info->filename, &elf_info->file_len);
- if (ret != RT_EOK)
- {
- return -RT_ERROR;
- }
- ret = elf_file_read(elf_info->fd, (rt_uint8_t *)&elf_info->ehdr, sizeof(Elf_Ehdr), 0);
- if (ret != RT_EOK)
- {
- LOG_E("%s : elf_file_read failed, ret : %d", __func__, ret);
- return -RT_ERROR;
- }
- ret = elf_check_ehdr(&elf_info->ehdr, elf_info->file_len);
- if (ret != RT_EOK)
- {
- LOG_E("%s : elf_check_ehdr failed, ret : %d", __func__, ret);
- return -RT_ERROR;
- }
- return RT_EOK;
- }
- static int elf_load_phdr(elf_info_t *elf_info)
- {
- Elf_Ehdr *ehdr = &elf_info->ehdr;
- uint32_t size;
- int ret;
- if (ehdr->e_phnum < 1)
- {
- return -RT_ERROR;
- }
- if (ehdr->e_phentsize != sizeof(Elf_Phdr))
- {
- return -RT_ERROR;
- }
- size = sizeof(Elf_Phdr) * ehdr->e_phnum;
- if ((ehdr->e_phoff + size) > elf_info->file_len)
- {
- return -RT_ERROR;
- }
- elf_info->phdr = rt_malloc(size);
- if (elf_info->phdr == RT_NULL)
- {
- LOG_E("%s : alloc phdr failed", __func__);
- return -RT_ENOMEM;
- }
- ret = elf_file_read(elf_info->fd, (rt_uint8_t *)elf_info->phdr, size, ehdr->e_phoff);
- if (ret != RT_EOK)
- {
- rt_free(elf_info->phdr);
- elf_info->phdr = RT_NULL;
- LOG_E("%s : elf_file_read failed, ret = %d", __func__, ret);
- return -RT_ERROR;
- }
- return RT_EOK;
- }
- static int elf_load_interp(elf_load_info_t *load_info)
- {
- Elf_Phdr *phdr = load_info->exec_info.phdr;
- int ret;
- int i;
- for (i = 0; i < load_info->exec_info.ehdr.e_phnum; ++i, ++phdr)
- {
- if (phdr->p_type != PT_INTERP)
- {
- continue;
- }
- if (elf_check_phdr(phdr) != RT_EOK)
- {
- return -RT_ERROR;
- }
- if ((phdr->p_filesz > ELF_PATH_MAX) || (phdr->p_filesz < FLF_PATH_MIN))
- {
- LOG_E("%s : phdr p_filesz error", __func__, phdr->p_filesz);
- return -RT_ERROR;
- }
- if (phdr->p_offset + phdr->p_filesz > load_info->exec_info.file_len)
- {
- LOG_E("%s : phdr p_offset error", __func__, phdr->p_offset);
- return -RT_ERROR;
- }
- load_info->interp_info.filename = rt_malloc(phdr->p_filesz);
- if (load_info->interp_info.filename == RT_NULL)
- {
- LOG_E("%s : alloc elf interpreter failed", __func__);
- return -RT_ENOMEM;
- }
- ret = elf_file_read(load_info->exec_info.fd, (rt_uint8_t *)load_info->interp_info.filename,
- phdr->p_filesz, phdr->p_offset);
- if (ret != RT_EOK)
- {
- LOG_E("%s : elf_file_read failed, ret = %d", __func__, ret);
- ret = -RT_ERROR;
- goto error_exit;
- }
- if (load_info->interp_info.filename[phdr->p_filesz - 1] != '\0')
- {
- LOG_E("%s : elf interpreter is invalid", __func__);
- ret = -RT_ERROR;
- goto error_exit;
- }
- LOG_D("%s : elf interpreter : %s", __func__, load_info->interp_info.filename);
- ret = elf_load_ehdr(&load_info->interp_info);
- if (ret != RT_EOK)
- {
- LOG_E("%s : elf_load_ehdr failed, ret = %d", __func__, ret);
- goto error_exit;
- }
- ret = elf_load_phdr(&load_info->interp_info);
- if (ret != RT_EOK)
- {
- LOG_E("%s : elf_load_phdr failed, ret = %d", __func__, ret);
- goto error_exit;
- }
- break;
- }
- return RT_EOK;
- error_exit:
- return ret;
- }
- static int total_mapping_size(elf_info_t *elf_info)
- {
- int i;
- int first_idx = -1;
- int last_idx = -1;
- for (i = 0; i < elf_info->ehdr.e_phnum; i++)
- {
- if (elf_info->phdr[i].p_type == PT_LOAD)
- {
- last_idx = i;
- if (first_idx == -1)
- first_idx = i;
- }
- }
- if (first_idx == -1)
- return -1;
- elf_info->map_size = elf_info->phdr[last_idx].p_vaddr + elf_info->phdr[last_idx].p_memsz -
- ELF_PAGESTART(elf_info->phdr[first_idx].p_vaddr);
- return 0;
- }
- static rt_ubase_t elf_map(struct rt_lwp *lwp, const Elf_Phdr *elf_phdr, int fd, rt_ubase_t addr, size_t prot, size_t flags, rt_ubase_t map_size)
- {
- rt_ubase_t map_va = 0;
- rt_ubase_t va_offset;
- addr = ELF_PAGESTART(addr);
- va_offset = elf_phdr->p_offset - ELF_PAGEOFFSET(elf_phdr->p_vaddr);
- rt_ubase_t size;
- if (map_size != 0)
- {
- size = map_size;
- }
- else
- {
- size = elf_phdr->p_memsz + ELF_PAGEOFFSET(elf_phdr->p_vaddr);
- if (size == 0)
- {
- return addr;
- }
- }
- map_va = (rt_ubase_t)file_mmap(lwp, fd, addr, size, prot, flags, va_offset);
- return map_va;
- }
- static int elf_zero_bss(struct rt_lwp *lwp, int fd, const Elf_Phdr *phdr, rt_ubase_t bss_start,
- rt_ubase_t bss_end)
- {
- lwp_data_set(lwp, (void *)bss_start, 0, bss_end - bss_start);
- return RT_EOK;
- }
- static int elf_file_mmap(elf_load_info_t *load_info, elf_info_t *elf_info, rt_ubase_t *elfload_addr,
- rt_uint32_t map_size, rt_ubase_t *load_base)
- {
- int ret, i;
- rt_ubase_t map_va, bss_start, bss_end;
- Elf_Ehdr *ehdr = &elf_info->ehdr;
- Elf_Phdr *phdr = elf_info->phdr;
- const Elf_Phdr *tmp_phdr = phdr;
- int fd = elf_info->fd;
- rt_ubase_t load_addr;
- size_t prot = PROT_READ | PROT_WRITE;
- size_t flags = MAP_FIXED | MAP_PRIVATE;
- for (i = 0; i < ehdr->e_phnum; ++i, ++tmp_phdr)
- {
- if (tmp_phdr->p_type != PT_LOAD)
- {
- continue;
- }
- if (ehdr->e_type == ET_EXEC)
- {
- if (elf_check_phdr(tmp_phdr) != RT_EOK)
- {
- LOG_E("%s : elf_check_phdr failed", __func__);
- return -RT_ERROR;
- }
- }
- load_addr = tmp_phdr->p_vaddr + *load_base;
- LOG_D("%s : p_vaddr : 0x%x, load_addr : 0x%x", __func__, tmp_phdr->p_vaddr, load_addr);
- if ((tmp_phdr->p_vaddr == 0) && (*load_base == 0))
- {
- flags &= ~MAP_FIXED;
- }
- map_va = elf_map(load_info->lwp, tmp_phdr, fd, load_addr, prot, flags, map_size);
- if (!map_va)
- {
- LOG_E("%s : elf_map failed", __func__);
- return -ENOMEM;
- }
- map_size = 0;
- elf_user_dump(load_info->lwp, (void *)load_addr, 64);
- if ((tmp_phdr->p_memsz > tmp_phdr->p_filesz) && (tmp_phdr->p_flags & PF_W))
- {
- bss_start = load_addr + tmp_phdr->p_filesz;
- bss_end = load_addr + tmp_phdr->p_memsz;
- ret = elf_zero_bss(load_info->lwp, fd, tmp_phdr, bss_start, bss_end);
- if (ret)
- {
- LOG_E("%s : elf_zero_bss error", __func__);
- return ret;
- }
- }
- if (*elfload_addr == 0)
- {
- *elfload_addr = map_va + ELF_PAGEOFFSET(tmp_phdr->p_vaddr);
- LOG_D("%s elf_load_addr : %p, vAddr : %p, load_base : %p, map_va : %p", __func__,
- *elfload_addr, tmp_phdr->p_vaddr, *load_base, map_va);
- }
- if ((*load_base == 0) && (ehdr->e_type == ET_DYN))
- {
- *load_base = map_va;
- }
- }
- return RT_EOK;
- }
- static int load_elf_interp(elf_load_info_t *load_info, rt_ubase_t *interp_base)
- {
- int ret;
- rt_ubase_t load_base = ELF_INTERP_LOAD_ADDR + elf_random_offset();
- ret = total_mapping_size(&load_info->interp_info);
- if (ret)
- {
- LOG_E("%s : total_mapping_size failed", __func__);
- return -RT_ERROR;
- }
- LOG_D("%s : total_mapping_size 0x%x", __func__, load_info->interp_info.map_size);
- return elf_file_mmap(load_info, &load_info->interp_info, interp_base,
- load_info->interp_info.map_size, &load_base);
- }
- static int elf_aux_fill(elf_load_info_t *load_info)
- {
- uint8_t *random;
- struct process_aux *aux = load_info->aux;
- elf_addr_t *aux_info;
- uint32_t random_value = rt_tick_get();
- size_t prot = PROT_READ | PROT_WRITE;
- size_t flags = MAP_PRIVATE;
- rt_lwp_t lwp = load_info->lwp;
- void *va;
- if (!aux)
- {
- LOG_E("%s : aux is null", __func__);
- return -1;
- }
- aux_info = (elf_addr_t *)aux->item;
- ELF_AUX_ENT(aux_info, AT_PAGESZ, ARCH_PAGE_SIZE);
- va = lwp_mmap2(lwp, (void *)(USER_VADDR_TOP - ARCH_PAGE_SIZE * 2), ARCH_PAGE_SIZE, prot, flags, -1, 0);
- if (!va)
- {
- LOG_E("lwp map user failed!");
- return -RT_ERROR;
- }
- random = (uint8_t *)(USER_VADDR_TOP - ARCH_PAGE_SIZE - sizeof(char[16]));
- lwp_data_put(load_info->lwp, random, &random_value, sizeof(random_value));
- ELF_AUX_ENT(aux_info, AT_RANDOM, (size_t)random);
- ELF_AUX_ENT(aux_info, AT_PHDR, (size_t)load_info->load_addr + load_info->exec_info.ehdr.e_phoff);
- ELF_AUX_ENT(aux_info, AT_PHNUM, (size_t)load_info->exec_info.ehdr.e_phnum);
- ELF_AUX_ENT(aux_info, AT_PHENT, sizeof(Elf_Phdr));
- ELF_AUX_ENT(aux_info, AT_BASE, load_info->interp_base);
- ELF_AUX_ENT(aux_info, AT_FLAGS, 0);
- ELF_AUX_ENT(aux_info, AT_ENTRY, load_info->exec_info.ehdr.e_entry);
- ELF_AUX_ENT(aux_info, AT_UID, 0);
- ELF_AUX_ENT(aux_info, AT_EUID, 0);
- ELF_AUX_ENT(aux_info, AT_GID, 0);
- ELF_AUX_ENT(aux_info, AT_EGID, 0);
- ELF_AUX_ENT(aux_info, AT_HWCAP, 0);
- ELF_AUX_ENT(aux_info, AT_CLKTCK, 0);
- ELF_AUX_ENT(aux_info, AT_SECURE, 0);
- #ifdef RT_USING_VDSO
- if(RT_EOK == arch_setup_additional_pages(load_info->lwp))
- {
- ELF_AUX_ENT(aux_info, AT_SYSINFO_EHDR, (size_t)load_info->lwp->vdso_vbase);
- }
- else
- {
- LOG_W("vdso map error,VDSO currently only supports aarch64 architecture!");
- }
- #endif
- return 0;
- }
- static int elf_load_segment(elf_load_info_t *load_info)
- {
- int ret;
- rt_ubase_t app_load_base = 0;
- load_info->load_addr = 0;
- load_info->interp_base = 0;
- load_info->exec_info.map_size = 0;
- if (load_info->exec_info.ehdr.e_type == ET_DYN)
- {
- ret = total_mapping_size(&load_info->exec_info);
- if (ret)
- {
- LOG_E("%s : total_mapping_size failed", __func__);
- return -RT_ERROR;
- }
- LOG_D("%s : map_size : 0x%x", __func__, load_info->exec_info.map_size);
- app_load_base = ELF_EXEC_LOAD_ADDR + elf_random_offset();
- }
- ret = elf_file_mmap(load_info, &load_info->exec_info, &load_info->load_addr,
- load_info->exec_info.map_size, &app_load_base);
- elf_file_close(load_info->exec_info.fd);
- if (ret != RT_EOK)
- {
- LOG_W("%s : elf_file_close exec failed", __func__);
- }
- load_info->exec_info.fd = ELF_INVALID_FD;
- if (load_info->interp_info.fd != ELF_INVALID_FD)
- {
- ret = load_elf_interp(load_info, &load_info->interp_base);
- if (ret)
- {
- LOG_E("%s : load_elf_interp failed, ret = %d", __func__, ret);
- return ret;
- }
- elf_file_close(load_info->interp_info.fd);
- if (ret != RT_EOK)
- {
- LOG_W("%s : elf_file_close interp failed, ret = %d", __func__, ret);
- }
- load_info->interp_info.fd = ELF_INVALID_FD;
- load_info->e_entry = load_info->interp_info.ehdr.e_entry + load_info->interp_base;
- load_info->exec_info.ehdr.e_entry = load_info->exec_info.ehdr.e_entry + app_load_base;
- }
- else
- {
- load_info->e_entry = load_info->exec_info.ehdr.e_entry;
- }
- load_info->lwp->text_entry = (void *)load_info->e_entry;
- LOG_D("%s : lwp->text_entry : %p loadaddr : %p", __func__, load_info->lwp->text_entry, app_load_base);
- elf_user_dump(load_info->lwp, load_info->lwp->text_entry, 64);
- ret = elf_aux_fill(load_info);
- if (ret)
- {
- LOG_E("%s : elf_aux_fill failed", __func__);
- return ret;
- }
- return RT_EOK;
- }
- static void elf_load_deinit(elf_load_info_t *load_info)
- {
- if (load_info->exec_info.fd != ELF_INVALID_FD)
- {
- elf_file_close(load_info->exec_info.fd);
- }
- if (load_info->interp_info.fd != ELF_INVALID_FD)
- {
- elf_file_close(load_info->interp_info.fd);
- }
- if (load_info->exec_info.phdr != RT_NULL)
- {
- rt_free(load_info->exec_info.phdr);
- }
- if (load_info->exec_info.filename != RT_NULL)
- {
- rt_free(load_info->exec_info.filename);
- }
- if (load_info->interp_info.phdr != RT_NULL)
- {
- rt_free(load_info->interp_info.phdr);
- }
- if (load_info->interp_info.filename != RT_NULL)
- {
- rt_free(load_info->interp_info.filename);
- }
- }
- static int elf_load_app(elf_info_t *exec_info)
- {
- int ret;
- ret = elf_load_ehdr(exec_info);
- if (ret != RT_EOK)
- {
- return ret;
- }
- ret = elf_load_phdr(exec_info);
- if (ret != RT_EOK)
- {
- return ret;
- }
- return ret;
- }
- static int elf_file_load(elf_load_info_t *load_info)
- {
- int ret;
- ret = elf_load_app(&load_info->exec_info);
- if (ret != RT_EOK)
- {
- goto OUT;
- }
- ret = elf_load_interp(load_info);
- if (ret != RT_EOK)
- {
- goto OUT;
- }
- ret = elf_load_segment(load_info);
- if (ret != RT_EOK)
- {
- goto OUT;
- }
- OUT:
- elf_load_deinit(load_info);
- return ret;
- }
- int lwp_load(const char *filename, struct rt_lwp *lwp, uint8_t *load_addr, size_t addr_size,
- struct process_aux *aux_ua)
- {
- elf_load_info_t load_info = { 0 };
- int len;
- int ret;
- if (filename == RT_NULL)
- {
- LOG_E("%s : file is NULL", __func__);
- return -RT_ERROR;
- }
- len = rt_strlen(filename);
- if (len < FLF_PATH_MIN || len > ELF_PATH_MAX)
- {
- LOG_E("%s : file length (%d) invalid", __func__, len);
- return -RT_ERROR;
- }
- load_info.exec_info.filename = rt_malloc(len + 1);
- if (!load_info.exec_info.filename)
- {
- LOG_E("%s : alloc filename failed", __func__, len);
- return -RT_ERROR;
- }
- else
- {
- rt_memset(load_info.exec_info.filename, 0, len + 1);
- rt_strncpy(load_info.exec_info.filename, filename, len);
- }
- load_info.lwp = lwp;
- load_info.aux = aux_ua;
- load_info.exec_info.fd = ELF_INVALID_FD;
- load_info.interp_info.fd = ELF_INVALID_FD;
- load_info.load_addr = (rt_ubase_t)load_addr;
- /* copy file name to process name */
- rt_strncpy(lwp->cmd, filename, RT_NAME_MAX);
- lwp->exe_file = dfs_normalize_path(NULL, filename); // malloc
- ret = elf_file_load(&load_info);
- if (ret != RT_EOK)
- {
- LOG_E("%s : elf_file_load error, ret : %d", __func__, ret);
- return ret;
- }
- return RT_EOK;
- }
- #endif
|