diff options
Diffstat (limited to 'tinyusb/hw/mcu/sony/cxd56/mkspk/mkspk.c')
-rwxr-xr-x | tinyusb/hw/mcu/sony/cxd56/mkspk/mkspk.c | 383 |
1 files changed, 0 insertions, 383 deletions
diff --git a/tinyusb/hw/mcu/sony/cxd56/mkspk/mkspk.c b/tinyusb/hw/mcu/sony/cxd56/mkspk/mkspk.c deleted file mode 100755 index c447ad7d..00000000 --- a/tinyusb/hw/mcu/sony/cxd56/mkspk/mkspk.c +++ /dev/null @@ -1,383 +0,0 @@ -/**************************************************************************** - * tools/cxd56/mkspk.c - * - * Copyright (C) 2007, 2008 Sony Corporation - * - * Redistribution and use in source and binary forms, with or without - * modification, are permitted provided that the following conditions - * are met: - * - * 1. Redistributions of source code must retain the above copyright - * notice, this list of conditions and the following disclaimer. - * 2. Redistributions in binary form must reproduce the above copyright - * notice, this list of conditions and the following disclaimer in - * the documentation and/or other materials provided with the - * distribution. - * 3. Neither the name NuttX nor the names of its contributors may be - * used to endorse or promote products derived from this software - * without specific prior written permission. - * - * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS - * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT - * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS - * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE - * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, - * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, - * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS - * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED - * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT - * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN - * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE - * POSSIBILITY OF SUCH DAMAGE. - *****************************************************************************/ - -/**************************************************************************** - * Included Files - ****************************************************************************/ - -#include <sys/types.h> -#include <sys/stat.h> -#include <stdio.h> -#include <stdlib.h> -#include <string.h> -#include <unistd.h> -#include <stdint.h> -#include <stdbool.h> -#include <assert.h> - -#include "mkspk.h" - -/**************************************************************************** - * Private Types - ****************************************************************************/ - -struct args -{ - int core; - char *elffile; - char *savename; - char *outputfile; -}; - -/**************************************************************************** - * Private Data - ****************************************************************************/ - -static uint8_t vmk[16] = - "\x27\xc0\xaf\x1b\x5d\xcb\xc6\xc5\x58\x22\x1c\xdd\xaf\xf3\x20\x21"; - -static struct args g_options = -{ - 0 -}; - -/**************************************************************************** - * Private Functions - ****************************************************************************/ - -static struct args *parse_args(int argc, char **argv) -{ - int opt; - int show_help; - struct args *args = &g_options; - char *endp; - - show_help = 0; - - if (argc < 2) - { - show_help = 1; - } - - memset(args, 0, sizeof(*args)); - args->core = -1; - - while ((opt = getopt(argc, argv, "h:c:")) != -1) - { - switch (opt) - { - case 'c': - args->core = strtol(optarg, &endp, 0); - if (*endp) - { - fprintf(stderr, "Invalid core number \"%s\"\n", optarg); - show_help = 1; - } - break; - - case 'h': - default: - show_help = 1; - } - } - - argc -= optind; - argv += optind; - - args->elffile = argv[0]; - args->savename = argv[1]; - argc -= 2; - argv += 2; - - if (argc > 0) - { - args->outputfile = strdup(argv[0]); - } - else - { - show_help = 1; - } - - /* Sanity checks for options */ - - if (show_help == 1) - { - fprintf(stderr, - "mkspk [-c <number>] <filename> <save name> [<output file>]\n"); - exit(EXIT_FAILURE); - } - - if (args->core < 0) - { - fprintf(stderr, "Core number is not set. Please use -c option.\n"); - exit(EXIT_FAILURE); - } - - if (strlen(args->savename) > 63) - { - fprintf(stderr, "savename too long.\n"); - exit(EXIT_FAILURE); - } - - return args; -} - -static struct elf_file *load_elf(const char *filename) -{ - size_t fsize; - int pos; - char *buf; - FILE *fp; - struct elf_file *ef; - Elf32_Shdr *sh; - uint16_t i; - int ret; - - fp = fopen(filename, "rb"); - if (!fp) - { - return NULL; - } - - ef = (struct elf_file *)malloc(sizeof(*ef)); - if (!ef) - { - return NULL; - } - - pos = fseek(fp, 0, SEEK_END); - fsize = (size_t) ftell(fp); - fseek(fp, pos, SEEK_SET); - - buf = (char *)malloc(fsize); - if (!buf) - { - return NULL; - } - - ret = fread(buf, fsize, 1, fp); - fclose(fp); - if (ret != 1) - { - return NULL; - } - - ef->data = buf; - - ef->ehdr = (Elf32_Ehdr *) buf; - - Elf32_Ehdr *h = (Elf32_Ehdr *) buf; - - if (!(h->e_ident[EI_MAG0] == 0x7f && - h->e_ident[EI_MAG1] == 'E' && - h->e_ident[EI_MAG2] == 'L' && h->e_ident[EI_MAG3] == 'F')) - { - free(ef); - free(buf); - return NULL; - } - - ef->phdr = (Elf32_Phdr *) (buf + ef->ehdr->e_phoff); - ef->shdr = (Elf32_Shdr *) (buf + ef->ehdr->e_shoff); - ef->shstring = buf + ef->shdr[ef->ehdr->e_shstrndx].sh_offset; - - for (i = 0, sh = ef->shdr; i < ef->ehdr->e_shnum; i++, sh++) - { - if (sh->sh_type == SHT_SYMTAB) - { - ef->symtab = (Elf32_Sym *) (buf + sh->sh_offset); - ef->nsyms = sh->sh_size / sh->sh_entsize; - continue; - } - - if (sh->sh_type == SHT_STRTAB) - { - if (!strcmp(".strtab", ef->shstring + sh->sh_name)) - { - ef->string = buf + sh->sh_offset; - } - } - } - - return ef; -} - -static void *create_image(struct elf_file *elf, int core, char *savename, - int *image_size) -{ - char *img; - struct spk_header *header; - struct spk_prog_info *pi; - Elf32_Phdr *ph; - Elf32_Sym *sym; - char *name; - int snlen; - int nphs, psize, imgsize; - int i; - int j; - uint32_t offset; - uint32_t sp; - - snlen = alignup(strlen(savename) + 1, 16); - - nphs = 0; - psize = 0; - for (i = 0, ph = elf->phdr; i < elf->ehdr->e_phnum; i++, ph++) - { - if (ph->p_type != PT_LOAD || ph->p_filesz == 0) - { - continue; - } - - nphs++; - psize += alignup(ph->p_filesz, 16); - } - - imgsize = sizeof(*header) + snlen + (nphs * 16) + psize; - - img = (char *)malloc(imgsize + 32); - if (!img) - { - return NULL; - } - - *image_size = imgsize; - sym = elf->symtab; - name = elf->string; - sp = 0; - - for (j = 0; j < elf->nsyms; j++, sym++) - { - if (!strcmp("__stack", name + sym->st_name)) - { - sp = sym->st_value; - } - } - - memset(img, 0, imgsize); - - header = (struct spk_header *)img; - header->magic[0] = 0xef; - header->magic[1] = 'M'; - header->magic[2] = 'O'; - header->magic[3] = 'D'; - header->cpu = core; - - header->entry = elf->ehdr->e_entry; - header->stack = sp; - header->core = core; - - header->binaries = nphs; - header->phoffs = sizeof(*header) + snlen; - header->mode = 0777; - - strncpy(img + sizeof(*header), savename, 63); - - ph = elf->phdr; - pi = (struct spk_prog_info *)(img + header->phoffs); - offset = ((char *)pi - img) + (nphs * sizeof(*pi)); - for (i = 0; i < elf->ehdr->e_phnum; i++, ph++) - { - if (ph->p_type != PT_LOAD || ph->p_filesz == 0) - continue; - pi->load_address = ph->p_paddr; - pi->offset = offset; - pi->size = alignup(ph->p_filesz, 16); /* need 16 bytes align for - * decryption */ - pi->memsize = ph->p_memsz; - - memcpy(img + pi->offset, elf->data + ph->p_offset, ph->p_filesz); - - offset += alignup(ph->p_filesz, 16); - pi++; - } - - return img; -} - -/**************************************************************************** - * Public Functions - ****************************************************************************/ - -int main(int argc, char **argv) -{ - struct args *args; - struct elf_file *elf; - struct cipher *c; - uint8_t *spkimage; - int size = 0; - FILE *fp; - char footer[16]; - - args = parse_args(argc, argv); - - elf = load_elf(args->elffile); - if (!elf) - { - fprintf(stderr, "Loading ELF %s failure.\n", args->elffile); - exit(EXIT_FAILURE); - } - - spkimage = create_image(elf, args->core, args->savename, &size); - free(elf); - - c = cipher_init(vmk, NULL); - cipher_calc_cmac(c, spkimage, size, (uint8_t *) spkimage + size); - cipher_deinit(c); - - size += 16; /* Extend CMAC size */ - - snprintf(footer, 16, "MKSPK_BN_HOOTER"); - footer[15] = '\0'; - - fp = fopen(args->outputfile, "wb"); - if (!fp) - { - fprintf(stderr, "Output file open error.\n"); - free(spkimage); - exit(EXIT_FAILURE); - } - - fwrite(spkimage, size, 1, fp); - fwrite(footer, 16, 1, fp); - - fclose(fp); - - printf("File %s is successfully created.\n", args->outputfile); - free(args->outputfile); - - memset(spkimage, 0, size); - free(spkimage); - - exit(EXIT_SUCCESS); -} |