diff options
author | patacongo <patacongo@42af7a65-404d-4744-a932-0658087f49c3> | 2009-06-17 16:28:50 +0000 |
---|---|---|
committer | patacongo <patacongo@42af7a65-404d-4744-a932-0658087f49c3> | 2009-06-17 16:28:50 +0000 |
commit | 3680397303890ce121c9f05082ffb407ced8d073 (patch) | |
tree | 0b62294db4d0519ee41bae914524d253b157321c /nuttx/binfmt/nxflat.c | |
parent | 2a3f404d973bd45e16ed4def539458c905b6fbda (diff) | |
download | px4-nuttx-3680397303890ce121c9f05082ffb407ced8d073.tar.gz px4-nuttx-3680397303890ce121c9f05082ffb407ced8d073.tar.bz2 px4-nuttx-3680397303890ce121c9f05082ffb407ced8d073.zip |
Easing in binfmt support
git-svn-id: svn://svn.code.sf.net/p/nuttx/code/trunk@1892 42af7a65-404d-4744-a932-0658087f49c3
Diffstat (limited to 'nuttx/binfmt/nxflat.c')
-rw-r--r-- | nuttx/binfmt/nxflat.c | 236 |
1 files changed, 236 insertions, 0 deletions
diff --git a/nuttx/binfmt/nxflat.c b/nuttx/binfmt/nxflat.c new file mode 100644 index 000000000..d0456bebd --- /dev/null +++ b/nuttx/binfmt/nxflat.c @@ -0,0 +1,236 @@ +/**************************************************************************** + * binfmt/nxflat.c + * + * Copyright (C) 2009 Gregory Nutt. All rights reserved. + * Author: Gregory Nutt <spudmonkey@racsa.co.cr> + * + * 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 <nuttx/config.h> +#include <sys/types.h> + +#include <string.h> +#include <nxflat.h> +#include <debug.h> +#include <errno.h> + +#include <arpa/inet.h> +#include <nuttx/binfmt.h> +#include <nuttx/nxflat.h> + +/**************************************************************************** + * Pre-processor Definitions + ****************************************************************************/ + +/**************************************************************************** + * Private Function Prototypes + ****************************************************************************/ + +static int nxflat_loadbinary(struct binary_s *binp); +#if defined(CONFIG_DEBUG) && defined(CONFIG_DEBUG_BINFMT) +static void nxflat_dumpmemory(void *addr, int nbytes); +static void nxflat_dumploadinfo(struct nxflat_loadinfo_s *loadinfo); +#endif + +/**************************************************************************** + * Private Constant Data + ****************************************************************************/ + +static struct binfmt_s g_nxflatbinfmt = +{ + NULL, /* next */ + nxflat_loadbinary, /* load */ +}; + +/**************************************************************************** + * Private Functions + ****************************************************************************/ + +/**************************************************************************** + * Name: nnxflat_dumpmemory + ****************************************************************************/ + +#if defined(CONFIG_DEBUG) && defined(CONFIG_DEBUG_BINFMT) +static void nxflat_dumpmemory(void *addr, int nbytes) +{ + ubyte *ptr; + + bdbg(" ADDRESS VALUE\n"); + for (ptr = (ubyte*)addr; nbytes > 0; ptr += 4, nbytes -= 4) + { + bdbg(" %p: %02x %02x %02x %02x\n", ptr, ptr[0], ptr[1], ptr[2], ptr[3]); + } +} +#else /* CONFIG_XFLAT_DEBUG */ +# define nnxflat_dumpmemory(a,n) +#endif /* CONFIG_XFLAT_DEBUG */ + +/**************************************************************************** + * Name: nxflat_dumploadinfo + ****************************************************************************/ + +#if defined(CONFIG_DEBUG) && defined(CONFIG_DEBUG_BINFMT) +static void nxflat_dumploadinfo(struct nxflat_loadinfo_s *loadinfo) +{ + unsigned long dspace_size = + NXFLAT_DATA_OFFSET + + loadinfo->data_size + + loadinfo->bss_size + + loadinfo->stack_size; + + bdbg("LOAD_INFO:\n"); + bdbg(" ISPACE:\n"); + bdbg(" ispace: %08lx\n", loadinfo->ispace); + bdbg(" entry_offset: %08lx\n", loadinfo->entry_offset); + bdbg(" ispace_size: %08lx\n", loadinfo->ispace_size); + + bdbg(" DSPACE:\n"); + bdbg(" dspace: %08lx\n", loadinfo->dspace); + bdbg(" (ldso): %08x\n", NXFLAT_DATA_OFFSET); + bdbg(" data_size: %08lx\n", loadinfo->data_size); + bdbg(" bss_size: %08lx\n", loadinfo->bss_size); + bdbg(" (pad): %08lx\n", loadinfo->dspace_size - dspace_size); + bdbg(" stack_size: %08lx\n", loadinfo->stack_size); + bdbg(" dspace_size: %08lx\n", loadinfo->dspace_size); + + bdbg(" ARGUMENTS:\n"); + bdbg(" arg_start: %08lx\n", loadinfo->arg_start); + bdbg(" env_start: %08lx\n", loadinfo->env_start); + bdbg(" env_end: %08lx\n", loadinfo->env_end); + + bdbg(" RELOCS:\n"); + bdbg(" reloc_start: %08lx\n", loadinfo->reloc_start); + bdbg(" reloc_count: %08lx\n", loadinfo->reloc_count); + + bdbg(" HANDLES:\n"); + bdbg(" filfd: %d\n", loadinfo->filfd); + + bdbg(" NXFLT HEADER:"); + bdbg(" header: %p\n", loadinfo->header); + + bdbg(" ALLOCATIONS:\n"); + bdbg(" alloc_start: %08lx\n", loadinfo->alloc_start); + bdbg(" alloc_size: %08lx\n", loadinfo->alloc_size); +} +#else /* CONFIG_XFLAT_DEBUG */ +# define nxflat_dumploadinfo(i) +#endif /* CONFIG_XFLAT_DEBUG */ + +/**************************************************************************** + * Name: nxflat_loadbinary + * + * Description: + * Verify that the file is an NXFLAT binary and, if so, load the NXFLAT + * binary into memory + * + ****************************************************************************/ + +static int nxflat_loadbinary(struct binary_s *binp) +{ + struct nxflat_hdr_s header; /* Just allocated memory */ + struct nxflat_loadinfo_s loadinfo; /* Contains globals for libnxflat */ + int ret; + + bvdbg("Loading file: %s\n", binp->filename); + + /* Initialize the xflat library to load the program binary. */ + + ret = nxflat_init(binp->filename, &header, &loadinfo); + nxflat_dumploadinfo(&loadinfo); + if (ret != 0) + { + bdbg("Failed to initialize for load of NXFLT program: %d\n", ret); + return ret; + } + + /* Load the program binary */ + + ret = nxflat_load(&loadinfo); + nxflat_dumploadinfo(&loadinfo); + if (ret != 0) + { + bdbg("Failed to load NXFLT program binary: %d\n", ret); + nxflat_uninit(&loadinfo); + return ret; + } + + /* Return the load information */ + + binp->entrypt = (main_t)(loadinfo.ispace + loadinfo.entry_offset); + binp->picbase = (void*)loadinfo.dspace; + + bvdbg("ENTRY CODE:\n"); + nxflat_dumpmemory(binp->entrypt, 16*sizeof(unsigned long)); + nxflat_uninit(&loadinfo); + return OK; +} + +/*********************************************************************** + * Public Functions + ***********************************************************************/ + +/*********************************************************************** + * Name: nxflat_initialize + * + * Description: + * NXFLAT support is built unconditionally. However, it order to + * use this binary format, this function must be called during system + * format in order to register the NXFLAT binary format. + * + ***********************************************************************/ + +int nxflat_initialize(void) +{ + int ret; + + /* Register ourselves as a binfmt loader */ + + bvdbg("Registering NXFLAT\n"); + ret = register_binfmt(&g_nxflatbinfmt); + if (ret != 0) + { + bdbg("Failed to register binfmt: %d\n", ret); + } + return ret; +} + +/**************************************************************************** + * Name: nxflat_uninitialize + ****************************************************************************/ + +void nxflat_uninitialize(void) +{ + unregister_binfmt(&g_nxflatbinfmt); +} + |