player/Project/Src/MyApp/elf.c

#include <stdio.h>

/**
 * hello.c
 */

#include "rtthread.h"
#include <elf.h>
#include <errno.h>
#include <stdlib.h>
#include <string.h>

static appm_list_struct g_app_list = {0};

// <20>ҵ<EFBFBD>һ<EFBFBD><D2BB><EFBFBD>յ<EFBFBD>app<70>ṹ<EFBFBD><E1B9B9>
static app_struct *appm_new(void) {
  if (g_app_list.used < APPM_LIST_MAXLEN) {
    for (int i = 0; i < APPM_LIST_MAXLEN; i++) {
      app_struct *ptr = &g_app_list.app[i];
      if (ptr->exe_addr == 0) {
        g_app_list.used++;
        return ptr;
      }
    }
  }
  return 0;
}

static int appm_delete(app_struct *app) {
  if (app == 0)
    return -1;
  for (int i = 0; i < APPM_LIST_MAXLEN; i++) {
    app_struct *ptr = &g_app_list.app[i];
    if (ptr == app) {
      memset(ptr, 0, sizeof(app_struct));
      g_app_list.used--;
      return 0;
    }
  }
  return -1;
}

app_struct *appm_find(char *name) {
  for (int i = 0; i < APPM_LIST_MAXLEN; i++) {
    app_struct *ptr = &g_app_list.app[i];
    if (strcmp(ptr->app_info->name, name) == 0) {
      return ptr;
    }
  }
  return 0;
}

app_struct *appm_get(int index) {
  if (index >= 0 && index < APPM_LIST_MAXLEN) {
    if (g_app_list.app[index].exe_addr)
      return &g_app_list.app[index];
    else
      return 0;
  }
  return 0;
}

// <20><>ȡ<EFBFBD><C8A1>ǰ<EFBFBD><C7B0><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>е<EFBFBD>app<70><70>Ŀ
int appm_get_running_num(void) {
  int ret = 0;
  for (int i = 0; i < APPM_LIST_MAXLEN; i++) {
    app_struct *ptr = &g_app_list.app[i];
    if (ptr->run_state)
      ret++;
  }
  return ret;
}

/**elf <20>ļ<EFBFBD>ͷ<EFBFBD><CDB7>section<6F><6E><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ͼ<EFBFBD><CDBC><EFBFBD>***/
static int check_elf_head(app_struct *app) {
  if (app == 0)
    return -1;
  FILE *file_elf = app->file;
  if (file_elf == 0)
    return -1;
  int i = 0;
  int MagNum = 0;
  unsigned long file_size = 0;
  int sechnum = 0;
  uint32_t symsize = 0;
  uint32_t symoff = 0;
  uint32_t nSyms = 0, kk = 0;
  Elf32_Ehdr *Elf_header = malloc(sizeof(Elf32_Ehdr));

  /*<2A>ļ<EFBFBD><C4BC><EFBFBD>С*/
  fseek(file_elf, 0, SEEK_END);
  file_size = ftell(file_elf);
  fseek(file_elf, 0, SEEK_SET);
  rt_kprintf("file total size is:%ld bytes\r\n", file_size);
  fread(Elf_header, sizeof(Elf32_Ehdr), 1, file_elf);

  /**ȷ<><C8B7><EFBFBD>Ƿ<EFBFBD>Ϊelf<6C><66>ʽ**/
  if ((Elf_header->e_ident[EI_MAG0] == ELFMAG0) &&
      (Elf_header->e_ident[EI_MAG1] == ELFMAG1) &&
      (Elf_header->e_ident[EI_MAG2] == ELFMAG2) &&
      (Elf_header->e_ident[EI_MAG3] == ELFMAG3)) {
    rt_kprintf("This is ELF file!\r\n");
  } else {
    rt_kprintf("NOT ELF file!\r\n");
    free(Elf_header);
    return -1;
  }

  free(Elf_header);

  return 0;
}

// <20><><EFBFBD><EFBFBD>load<61>δ<EFBFBD>С
uint32_t calc_load_size(Elf32_Phdr *phdr, int phdr_num) {
  uint32_t start = 0;
  uint32_t stop = 0;
  for (int i = 0; i < phdr_num; i++) {
    if (phdr[i].p_type == PT_LOAD) {
      if (start > phdr[i].p_paddr) {
        start = phdr[i].p_paddr;
      }
      if (stop < phdr[i].p_paddr + phdr[i].p_memsz) {
        stop = phdr[i].p_paddr + phdr[i].p_memsz;
      }
    }
  }
  return stop - start;
}

/* <20><><EFBFBD><EFBFBD>elf<6C>ļ<EFBFBD>segment <20><><EFBFBD>ڴ<EFBFBD><DAB4><EFBFBD> */
static int load_elf_2_mem(app_struct *app) {

  if (app == 0)
    return -1;

  Elf32_Phdr *phdr_head = NULL;
  Elf32_Ehdr *Elf_header = NULL;
  FILE *file1 = app->file;
  uint32_t rb;

  Elf_header = (Elf32_Ehdr *)malloc(sizeof(Elf32_Ehdr));
  memset(Elf_header, 0, sizeof(Elf32_Ehdr));

  fseek(file1, 0, SEEK_SET);
  rb = fread(Elf_header, sizeof(Elf32_Ehdr), 1, file1);

  /* <20><><EFBFBD><EFBFBD> Elf_header->e_phentsize Ӧ<><D3A6><EFBFBD><EFBFBD>== sizeof(Elf32_Phdr)*/
  phdr_head = malloc(Elf_header->e_phentsize * Elf_header->e_phnum);
  fseek(file1, Elf_header->e_phoff, SEEK_SET);
  fread(phdr_head, Elf_header->e_phentsize, Elf_header->e_phnum, file1);

  // Elf_header->e_phnumһ<6D><D2BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD>1
  uint32_t load_size = calc_load_size(phdr_head, Elf_header->e_phnum);
  rt_kprintf("Elf_header->e_phnum=%d, load_size=%d\n", Elf_header->e_phnum,
             load_size);
  if (app->exe_addr == 0) {
    app->exe_addr = malloc(load_size);
    memset(app->exe_addr, 0, load_size);
  }
  for (int i = 0; i < Elf_header->e_phnum; i++) {
    // <20>dz<EFBFBD><C7B3><EFBFBD><EFBFBD><EFBFBD>
    // Keil<69><6C><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ʱ<EFBFBD><CAB1><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ΪRO<52><4F>RW<52><57>ZI<5A><49>3<EFBFBD><33><EFBFBD>ڣ<EFBFBD><DAA3><EFBFBD><EFBFBD>Ǵ<EFBFBD><C7B4><EFBFBD><EFBFBD><EFBFBD>ʱ<EFBFBD>Ƕȿ<C7B6><C8BF><EFBFBD><EFBFBD><EFBFBD>3<EFBFBD><33><EFBFBD>ںϲ<DABA>Ϊһ<CEAA><D2BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
    if (phdr_head[i].p_type == PT_LOAD) {
      // <20>ڴ<EFBFBD>
      {
        fseek(file1, phdr_head[i].p_offset, SEEK_SET);
        if ((rb = fread(app->exe_addr + phdr_head[i].p_paddr, 1,
                        phdr_head[i].p_filesz, file1)) !=
            phdr_head[i].p_filesz) {
          rt_kprintf("function:%s,line:%d, read p_vaddr err!\r\n", __FUNCTION__,
                     __LINE__);
          rt_kprintf("read <20><><EFBFBD><EFBFBD>ֵ%d\r\n", rb);
          rt_kprintf("read(file,ProHead->p_vaddr,ProHead->p_filesz) != "
                     "ProHead->p_filesz %x  p_filesz %d\r\n",
                     phdr_head[i].p_vaddr, phdr_head[i].p_filesz);
        }

        rt_kprintf("%s:load=0X%08X,size=%d\r\n", __func__,
                   (uint32_t)phdr_head[i].p_paddr, phdr_head[i].p_memsz);
      }
    }
  }
  // <20>ҵ<EFBFBD><D2B5><EFBFBD><EFBFBD>ں<EFBFBD><DABA><EFBFBD><EFBFBD><EFBFBD>ַ
  app->main = (int (*)(void *))((int)app->exe_addr + Elf_header->e_entry);
  // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ϣ<EFBFBD><CFA2>ַ
  app->app_info = (app_info_struct *)app->exe_addr;
  rt_kprintf("%s:exe_addr=0X%08X,size=%d\r\n", __func__,
             (uint32_t)app->exe_addr, load_size);
  rt_kprintf("%s:main()=0X%08X\r\n", __func__, (uint32_t)app->main);
  rt_kprintf("%s:name=%s\r\n", __func__, app->app_info->name);

  // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>RW<52><57><EFBFBD>ڳ<EFBFBD><DAB3><EFBFBD>ӳ<EFBFBD><D3B3><EFBFBD>е<EFBFBD>ƫ<EFBFBD><C6AB>
  Elf32_Shdr *sher_head = NULL;
  sher_head = malloc(Elf_header->e_shentsize * Elf_header->e_shnum);
  fseek(file1, Elf_header->e_shoff, SEEK_SET);
  fread(sher_head, Elf_header->e_shentsize, Elf_header->e_shnum, file1);

  for (int i = 0; i < Elf_header->e_shnum; i++) {
    if ((sher_head[i].sh_type == SHT_PROGBITS) &&
        (sher_head[i].sh_flags == (SHF_ALLOC | SHF_EXECINSTR))) {
      app->ro_size = sher_head[i].sh_size;
      break;
    }
  }
  free(sher_head);

  free(Elf_header);
  free(phdr_head);

  return 0;
}

// <20>ر<EFBFBD>app<70>ļ<EFBFBD>
static void app_close(app_struct *app) {
  if (app == 0)
    return;
  if (app->file)
    fclose(app->file);
}

// <20><><EFBFBD><EFBFBD>app<70>ļ<EFBFBD>
static int app_open(app_struct *app, char *path) {
  if (app == 0)
    return -1;
  app->file = fopen(path, "rb");
  if (app->file) {
    return 0;
  } else
    return -1;
}

// <20><><EFBFBD>ļ<EFBFBD><C4BC>л<EFBFBD>ȡapp<70><70><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
// name,<2C><><EFBFBD>ڱ<EFBFBD><DAB1><EFBFBD><EFBFBD>ļ<EFBFBD><C4BC><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>飬<EFBFBD><E9A3AC><EFBFBD>ȱ<EFBFBD><C8B1>벻С<EBB2BB><D0A1>APP_INFO_NAME_MAXLEN
// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ɹ<EFBFBD><C9B9><EFBFBD>0ʧ<30>ܣ<EFBFBD><DCA3><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
int app_get_name_from_file(char *path, char *name) {

  if (path == 0)
    return 0;
  if (name == 0)
    return 0;

  Elf32_Phdr *phdr_head = NULL;
  Elf32_Ehdr *Elf_header = NULL;
  FILE *file1 = fopen(path, "rb");
  uint32_t rb;
  if (file1 == 0)
    return 0;

  Elf_header = (Elf32_Ehdr *)malloc(sizeof(Elf32_Ehdr));
  memset(Elf_header, 0, sizeof(Elf32_Ehdr));

  fseek(file1, 0, SEEK_SET);
  rb = fread(Elf_header, sizeof(Elf32_Ehdr), 1, file1);

  /* <20><><EFBFBD><EFBFBD> Elf_header->e_phentsize Ӧ<><D3A6><EFBFBD><EFBFBD>== sizeof(Elf32_Phdr)*/
  phdr_head = malloc(Elf_header->e_phentsize * Elf_header->e_phnum);
  fseek(file1, Elf_header->e_phoff, SEEK_SET);
  fread(phdr_head, Elf_header->e_phentsize, Elf_header->e_phnum, file1);

  // Elf_header->e_phnumһ<6D><D2BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD>1
  for (int i = 0; i < Elf_header->e_phnum; i++) {
    // <20>dz<EFBFBD><C7B3><EFBFBD><EFBFBD><EFBFBD>
    // Keil<69><6C><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ʱ<EFBFBD><CAB1><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ΪRO<52><4F>RW<52><57>ZI<5A><49>3<EFBFBD><33><EFBFBD>ڣ<EFBFBD><DAA3><EFBFBD><EFBFBD>Ǵ<EFBFBD><C7B4><EFBFBD><EFBFBD><EFBFBD>ʱ<EFBFBD>Ƕȿ<C7B6><C8BF><EFBFBD><EFBFBD><EFBFBD>3<EFBFBD><33><EFBFBD>ںϲ<DABA>Ϊһ<CEAA><D2BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
    if (phdr_head[i].p_type == PT_LOAD) {
      fseek(file1, phdr_head[i].p_offset, SEEK_SET);
      if ((rb = fread(name, 1, APP_INFO_NAME_MAXLEN, file1)) ==
          APP_INFO_NAME_MAXLEN) {
        int app_type = 0;
        fread(&app_type, 1, sizeof(int), file1);
        fclose(file1);
        free(Elf_header);
        free(phdr_head);
        return app_type;
      }
    }
  }

  fclose(file1);
  free(Elf_header);
  free(phdr_head);
  return 0;
}

// app<70>˳<EFBFBD><CBB3><EFBFBD><EFBFBD><EFBFBD> 0,<2C>ɹ<EFBFBD><C9B9><EFBFBD><EFBFBD><EFBFBD>0<EFBFBD><30>ʧ<EFBFBD><CAA7>
int app_exit(app_struct *app) {
  if (app == 0)
    return -1;

  // <20><><EFBFBD><EFBFBD>app<70><70><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>У<EFBFBD><D0A3><EFBFBD>Ҫ<EFBFBD><D2AA><EFBFBD>˳<EFBFBD>app
  if (app->run_state && app->exit) {
    app->exit(0);
  }
  if (app->run_state == 0) {
    // <20><>appû<70><C3BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ʱ<EFBFBD>ſ<EFBFBD><C5BF><EFBFBD>ɾ<EFBFBD><C9BE>
    if (app->exe_addr)
      free(app->exe_addr);
    appm_delete(app);
    return 0;
  } else {
    return -1;
  }
}

// <20><>ռʽ<D5BC><CABD><EFBFBD><EFBFBD>app<70><70><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>߳<EFBFBD><DFB3><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>app
static int app_run_seize(app_struct *app) {
  int ret = 0;
  if (app->main)
    app->main(app);
  app_exit(app);
  return ret;
}

// <20><><EFBFBD><EFBFBD>app<70><70><EFBFBD><EFBFBD><EFBFBD><EFBFBD>app<70><70><EFBFBD><EFBFBD>
static int app_run_hold(app_struct *app) {
  int ret = 0;
  if (app == 0)
    return -1;
  if (app->main)
    app->main(app);
  return ret;
}

static void run_thread_entry(void *t) {
  app_struct *app = t;
  int ret = 0;
  if (app->main)
    app->main(app);
  app_exit(app);
}

// <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>߳<EFBFBD><DFB3><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>app
static int app_run_thread(app_struct *app) {
  int ret = 0;
  rt_thread_t rt =
      rt_thread_create(app->app_info->name, run_thread_entry, app,
                       app->app_info->stack_size, app->app_info->priority, 20);
  rt_thread_startup(rt);
  return ret;
}

// <20><><EFBFBD><EFBFBD>app
int app_run(app_struct *app) {
  int ret = 0;
  if (app->app_info->exe_type == APP_TYPE_SEIZE) {
    ret = app_run_seize(app);
  } else if (app->app_info->exe_type == APP_TYPE_THREAD) {
    ret = app_run_thread(app);
  } else if (app->app_info->exe_type == APP_TYPE_HOLD) {
    ret = app_run_hold(app);
  }
  return ret;
}

int app_run_path(char *path) {
  int ret = 0;

  // <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ѿ<EFBFBD><D1BE><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ڴ<EFBFBD><DAB4>У<EFBFBD><D0A3><EFBFBD>ֱ<EFBFBD>ӵ<EFBFBD><D3B5><EFBFBD>
  char name[APP_INFO_NAME_MAXLEN] = {0};
  if (app_get_name_from_file(path, name) != 0) {
    app_struct *app = appm_find(name);
    if (app) {
      if (app->app_info->exe_type == APP_TYPE_HOLD) {
        ret = app_run_hold(app);
      }
      return ret;
    }
  }

  app_struct *app = appm_new();

  if ((app_open(app, path) == 0) && (check_elf_head(app) == 0) &&
      (load_elf_2_mem(app) == 0)) {
    app_close(app);
    app_run(app);
  } else {
    appm_delete(app);
    ret = -1;
  }

  return ret;
}