324 lines
8.4 KiB
C
324 lines
8.4 KiB
C
/****************************************************************************
|
|
* binfmt/binfmt_execmodule.c
|
|
*
|
|
* Licensed to the Apache Software Foundation (ASF) under one or more
|
|
* contributor license agreements. See the NOTICE file distributed with
|
|
* this work for additional information regarding copyright ownership. The
|
|
* ASF licenses this file to you under the Apache License, Version 2.0 (the
|
|
* "License"); you may not use this file except in compliance with the
|
|
* License. You may obtain a copy of the License at
|
|
*
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
*
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
* distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
|
|
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
|
|
* License for the specific language governing permissions and limitations
|
|
* under the License.
|
|
*
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Included Files
|
|
****************************************************************************/
|
|
|
|
#include <nuttx/config.h>
|
|
|
|
#include <sys/types.h>
|
|
#include <stdint.h>
|
|
#include <stdlib.h>
|
|
#include <sched.h>
|
|
#include <debug.h>
|
|
#include <errno.h>
|
|
|
|
#include <nuttx/addrenv.h>
|
|
#include <nuttx/arch.h>
|
|
#include <nuttx/kmalloc.h>
|
|
#include <nuttx/sched.h>
|
|
#include <nuttx/spawn.h>
|
|
#include <nuttx/binfmt/binfmt.h>
|
|
|
|
#include "binfmt.h"
|
|
|
|
#ifndef CONFIG_BINFMT_DISABLE
|
|
|
|
/****************************************************************************
|
|
* Pre-processor Definitions
|
|
****************************************************************************/
|
|
|
|
/* If C++ constructors are used, then CONFIG_SCHED_STARTHOOK must also be
|
|
* selected be the start hook is used to schedule execution of the
|
|
* constructors.
|
|
*/
|
|
|
|
#if defined(CONFIG_BINFMT_CONSTRUCTORS) && !defined(CONFIG_SCHED_STARTHOOK)
|
|
# error "CONFIG_SCHED_STARTHOOK must be defined to use constructors"
|
|
#endif
|
|
|
|
/****************************************************************************
|
|
* Private Functions
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Name: exec_ctors
|
|
*
|
|
* Description:
|
|
* Execute C++ static constructors. This function is registered as a
|
|
* start hook and runs on the thread of the newly created task before
|
|
* the new task's main function is called.
|
|
*
|
|
* Input Parameters:
|
|
* arg - Argument is instance of load state info structure cast to void *.
|
|
*
|
|
* Returned Value:
|
|
* 0 (OK) is returned on success and a negated errno is returned on
|
|
* failure.
|
|
*
|
|
****************************************************************************/
|
|
|
|
#ifdef CONFIG_BINFMT_CONSTRUCTORS
|
|
static void exec_ctors(FAR void *arg)
|
|
{
|
|
FAR const struct binary_s *binp = (FAR const struct binary_s *)arg;
|
|
binfmt_ctor_t *ctor = binp->ctors;
|
|
int i;
|
|
|
|
/* Execute each constructor */
|
|
|
|
for (i = 0; i < binp->nctors; i++)
|
|
{
|
|
binfo("Calling ctor %d at %p\n", i, (FAR void *)ctor);
|
|
|
|
(*ctor)();
|
|
ctor++;
|
|
}
|
|
}
|
|
#endif
|
|
|
|
/****************************************************************************
|
|
* Public Functions
|
|
****************************************************************************/
|
|
|
|
/****************************************************************************
|
|
* Name: exec_module
|
|
*
|
|
* Description:
|
|
* Execute a module that has been loaded into memory by load_module().
|
|
*
|
|
* Returned Value:
|
|
* This is a NuttX internal function so it follows the convention that
|
|
* 0 (OK) is returned on success and a negated errno is returned on
|
|
* failure.
|
|
*
|
|
****************************************************************************/
|
|
|
|
int exec_module(FAR struct binary_s *binp,
|
|
FAR const char *filename, FAR char * const *argv,
|
|
FAR char * const *envp,
|
|
FAR const posix_spawn_file_actions_t *actions)
|
|
{
|
|
FAR struct task_tcb_s *tcb;
|
|
#if defined(CONFIG_ARCH_ADDRENV) && defined(CONFIG_BUILD_KERNEL)
|
|
FAR struct arch_addrenv_s *addrenv = &binp->addrenv->addrenv;
|
|
FAR void *vheap;
|
|
#endif
|
|
FAR void *stackaddr = NULL;
|
|
pid_t pid;
|
|
int ret;
|
|
|
|
/* Sanity checking */
|
|
|
|
#ifdef CONFIG_DEBUG_FEATURES
|
|
if (!binp || !binp->entrypt || binp->stacksize <= 0)
|
|
{
|
|
return -EINVAL;
|
|
}
|
|
#endif
|
|
|
|
binfo("Executing %s\n", filename);
|
|
|
|
/* Allocate a TCB for the new task. */
|
|
|
|
tcb = (FAR struct task_tcb_s *)kmm_zalloc(sizeof(struct task_tcb_s));
|
|
if (!tcb)
|
|
{
|
|
return -ENOMEM;
|
|
}
|
|
|
|
ret = binfmt_copyargv(&argv, argv);
|
|
if (ret < 0)
|
|
{
|
|
goto errout_with_tcb;
|
|
}
|
|
|
|
/* Make a copy of the environment here */
|
|
|
|
if (envp == NULL)
|
|
{
|
|
envp = environ;
|
|
}
|
|
|
|
ret = binfmt_copyenv(&envp, envp);
|
|
if (ret < 0)
|
|
{
|
|
goto errout_with_args;
|
|
}
|
|
|
|
#if defined(CONFIG_ARCH_ADDRENV) && defined(CONFIG_BUILD_KERNEL)
|
|
/* Instantiate the address environment containing the user heap */
|
|
|
|
ret = addrenv_select(binp->addrenv, &binp->oldenv);
|
|
if (ret < 0)
|
|
{
|
|
berr("ERROR: addrenv_select() failed: %d\n", ret);
|
|
goto errout_with_envp;
|
|
}
|
|
|
|
ret = up_addrenv_vheap(addrenv, &vheap);
|
|
if (ret < 0)
|
|
{
|
|
berr("ERROR: up_addrenv_vheap() failed: %d\n", ret);
|
|
goto errout_with_addrenv;
|
|
}
|
|
|
|
binfo("Initialize the user heap (heapsize=%zu)\n",
|
|
up_addrenv_heapsize(addrenv));
|
|
umm_initialize(vheap, up_addrenv_heapsize(addrenv));
|
|
#endif
|
|
|
|
#if defined(CONFIG_ARCH_ADDRENV) && defined(CONFIG_ARCH_KERNEL_STACK)
|
|
/* Allocate the kernel stack */
|
|
|
|
ret = up_addrenv_kstackalloc(&tcb->cmn);
|
|
if (ret < 0)
|
|
{
|
|
berr("ERROR: up_addrenv_kstackalloc() failed: %d\n", ret);
|
|
goto errout_with_addrenv;
|
|
}
|
|
#endif
|
|
|
|
/* Note that tcb->flags are not modified. 0=normal task */
|
|
|
|
/* tcb->flags |= TCB_FLAG_TTYPE_TASK; */
|
|
|
|
/* Initialize the task */
|
|
|
|
#ifndef CONFIG_BUILD_KERNEL
|
|
stackaddr = binp->stackaddr;
|
|
#endif
|
|
|
|
if (argv && argv[0])
|
|
{
|
|
ret = nxtask_init(tcb, argv[0], binp->priority, stackaddr,
|
|
binp->stacksize, binp->entrypt, &argv[1], envp);
|
|
}
|
|
else
|
|
{
|
|
ret = nxtask_init(tcb, filename, binp->priority, stackaddr,
|
|
binp->stacksize, binp->entrypt, argv, envp);
|
|
}
|
|
|
|
if (ret < 0)
|
|
{
|
|
berr("nxtask_init() failed: %d\n", ret);
|
|
goto errout_with_addrenv;
|
|
}
|
|
|
|
/* The copied argv and envp can now be released */
|
|
|
|
binfmt_freeargv(argv);
|
|
binfmt_freeenv(envp);
|
|
|
|
/* Perform file actions */
|
|
|
|
if (actions != NULL)
|
|
{
|
|
ret = spawn_file_actions(&tcb->cmn, actions);
|
|
if (ret < 0)
|
|
{
|
|
goto errout_with_tcbinit;
|
|
}
|
|
}
|
|
|
|
#ifdef CONFIG_PIC
|
|
/* Add the D-Space address as the PIC base address. By convention, this
|
|
* must be the first allocated address space.
|
|
*/
|
|
|
|
tcb->cmn.dspace = binp->alloc[0];
|
|
|
|
/* Re-initialize the task's initial state to account for the new PIC base */
|
|
|
|
up_initial_state(&tcb->cmn);
|
|
#endif
|
|
|
|
#ifdef CONFIG_ARCH_ADDRENV
|
|
/* Attach the address environment to the new task */
|
|
|
|
ret = addrenv_attach((FAR struct tcb_s *)tcb, binp->addrenv);
|
|
if (ret < 0)
|
|
{
|
|
berr("ERROR: addrenv_attach() failed: %d\n", ret);
|
|
goto errout_with_tcbinit;
|
|
}
|
|
#endif
|
|
|
|
#ifdef CONFIG_BINFMT_CONSTRUCTORS
|
|
/* Setup a start hook that will execute all of the C++ static constructors
|
|
* on the newly created thread. The struct binary_s must persist at least
|
|
* until the new task has been started.
|
|
*/
|
|
|
|
if (binp->nctors > 0)
|
|
{
|
|
nxtask_starthook(tcb, exec_ctors, (FAR void *)binp);
|
|
}
|
|
#endif
|
|
|
|
/* Get the assigned pid before we start the task */
|
|
|
|
pid = tcb->cmn.pid;
|
|
|
|
/* Then activate the task at the provided priority */
|
|
|
|
nxtask_activate((FAR struct tcb_s *)tcb);
|
|
|
|
#if defined(CONFIG_ARCH_ADDRENV) && defined(CONFIG_BUILD_KERNEL)
|
|
/* Restore the address environment of the caller */
|
|
|
|
ret = addrenv_restore(binp->oldenv);
|
|
if (ret < 0)
|
|
{
|
|
berr("ERROR: addrenv_restore() failed: %d\n", ret);
|
|
goto errout_with_tcbinit;
|
|
}
|
|
#endif
|
|
|
|
return pid;
|
|
|
|
errout_with_tcbinit:
|
|
#ifndef CONFIG_BUILD_KERNEL
|
|
if (binp->stackaddr != NULL)
|
|
{
|
|
tcb->cmn.stack_alloc_ptr = NULL;
|
|
}
|
|
#endif
|
|
|
|
nxtask_uninit(tcb);
|
|
return ret;
|
|
|
|
errout_with_addrenv:
|
|
#if defined(CONFIG_ARCH_ADDRENV) && defined(CONFIG_BUILD_KERNEL)
|
|
addrenv_restore(binp->oldenv);
|
|
errout_with_envp:
|
|
#endif
|
|
binfmt_freeenv(envp);
|
|
errout_with_args:
|
|
binfmt_freeargv(argv);
|
|
errout_with_tcb:
|
|
kmm_free(tcb);
|
|
return ret;
|
|
}
|
|
|
|
#endif /* CONFIG_BINFMT_DISABLE */
|