123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249 |
- /****************************************************************************
- * binfmt/libnxflat/libnxflat_addrenv.c
- *
- * Copyright (C) 2012 Gregory Nutt. All rights reserved.
- * Author: Gregory Nutt <gnutt@nuttx.org>
- *
- * 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 <string.h>
- #include <errno.h>
- #include <debug.h>
- #include <nuttx/arch.h>
- #include <nuttx/kmalloc.h>
- #include "libnxflat.h"
- /****************************************************************************
- * Pre-processor Definitions
- ****************************************************************************/
- #ifndef MIN
- # define MIN(x,y) ((x) < (y) ? (x) : (y))
- #endif
- /****************************************************************************
- * Private Constant Data
- ****************************************************************************/
- /****************************************************************************
- * Private Functions
- ****************************************************************************/
- /****************************************************************************
- * Public Functions
- ****************************************************************************/
- /****************************************************************************
- * Name: nxflat_addrenv_alloc
- *
- * Description:
- * Allocate data memory for the NXFLAT image. If CONFIG_ARCH_ADDRENV=n,
- * memory will be allocated using kmm_zalloc(). If CONFIG_ARCH_ADDRENV-y,
- * then memory will be allocated using up_addrenv_create().
- *
- * Input Parameters:
- * loadinfo - Load state information
- * envsize - The size (in bytes) of the address environment needed for the
- * ELF image.
- *
- * Returned Value:
- * Zero (OK) on success; a negated errno value on failure.
- *
- ****************************************************************************/
- int nxflat_addrenv_alloc(FAR struct nxflat_loadinfo_s *loadinfo, size_t envsize)
- {
- FAR struct dspace_s *dspace;
- #ifdef CONFIG_ARCH_ADDRENV
- FAR void *vdata;
- save_addrenv_t oldenv;
- size_t heapsize;
- int ret;
- #endif
- DEBUGASSERT(!loadinfo->dspace);
- /* Allocate the struct dspace_s container for the D-Space allocation */
- dspace = (FAR struct dspace_s *)kmm_malloc(sizeof(struct dspace_s));
- if (dspace == 0)
- {
- berr("ERROR: Failed to allocate DSpace\n");
- return -ENOMEM;
- }
- #ifdef CONFIG_ARCH_ADDRENV
- /* Determine the heapsize to allocate. If there is no dynamic stack then
- * heapsize must at least as big as the fixed stack size since the stack
- * will be allocated from the heap in that case.
- */
- #ifdef CONFIG_ARCH_STACK_DYNAMIC
- heapsize = ARCH_HEAP_SIZE;
- #else
- heapsize = MIN(loadinfo->stacksize, ARCH_HEAP_SIZE);
- #endif
- /* Create a D-Space address environment for the new NXFLAT task */
- ret = up_addrenv_create(0, envsize, heapsize, &loadinfo->addrenv);
- if (ret < 0)
- {
- berr("ERROR: up_addrenv_create failed: %d\n", ret);
- goto errout_with_dspace;
- }
- /* Get the virtual address associated with the start of the address
- * environment. This is the base address that we will need to use to
- * access the D-Space region (but only if the address environment has been
- * selected.
- */
- ret = up_addrenv_vdata(&loadinfo->addrenv, 0, &vdata);
- if (ret < 0)
- {
- berr("ERROR: up_addrenv_vdata failed: %d\n", ret);
- goto errout_with_addrenv;
- }
- /* Clear all of the allocated D-Space memory. We have to temporarily
- * selected the D-Space address environment to do this.
- */
- ret = up_addrenv_select(loadinfo->addrenv, &oldenv);
- if (ret < 0)
- {
- berr("ERROR: up_addrenv_select failed: %d\n", ret);
- goto errout_with_addrenv;
- }
- memset(vdata, 0, envsize);
- ret = up_addrenv_restore(oldenv);
- if (ret < 0)
- {
- berr("ERROR: up_addrenv_restore failed: %d\n", ret);
- goto errout_with_addrenv;
- }
- /* Success... save the fruits of our labor */
- loadinfo->dspace = dspace;
- dspace->crefs = 1;
- dspace->region = (FAR uint8_t *)vdata;
- return OK;
- errout_with_addrenv:
- up_addrenv_destroy(&loadinfo->addrenv);
- loadinfo->addrenv = 0;
- errout_with_dspace:
- kmm_free(dspace);
- return ret;
- #else
- /* Allocate (and zero) memory to hold the ELF image */
- dspace->region = (FAR uint8_t *)kumm_zalloc(envsize);
- if (!dspace->region)
- {
- kmm_free(dspace);
- return -ENOMEM;
- }
- loadinfo->dspace = dspace;
- dspace->crefs = 1;
- return OK;
- #endif
- }
- /****************************************************************************
- * Name: nxflat_addrenv_free
- *
- * Description:
- * Release the address environment previously created by
- * nxflat_addrenv_create(). This function is called only under certain
- * error conditions after the module has been loaded but not yet
- * started. After the module has been started, the address environment
- * will automatically be freed when the module exits.
- *
- * Input Parameters:
- * loadinfo - Load state information
- *
- * Returned Value:
- * None.
- *
- ****************************************************************************/
- void nxflat_addrenv_free(FAR struct nxflat_loadinfo_s *loadinfo)
- {
- FAR struct dspace_s *dspace;
- #ifdef CONFIG_ARCH_ADDRENV
- int ret;
- #endif
- DEBUGASSERT(loadinfo);
- dspace = loadinfo->dspace;
- if (dspace)
- {
- #ifdef CONFIG_ARCH_ADDRENV
- /* Destroy the address environment */
- ret = up_addrenv_destroy(loadinfo->addrenv);
- if (ret < 0)
- {
- berr("ERROR: up_addrenv_destroy failed: %d\n", ret);
- }
- loadinfo->addrenv = 0;
- #else
- /* Free the allocated D-Space region */
- if (dspace->region)
- {
- kumm_free(dspace->region);
- }
- #endif
- /* Now destroy the D-Space container */
- DEBUGASSERT(dspace->crefs == 1);
- kmm_free(dspace);
- loadinfo->dspace = NULL;
- }
- }
|