zephyr/boards/native/nrf_bsim/nsi_if.c

130 lines
3.6 KiB
C

/*
* Copyright (c) 2023 Nordic Semiconductor ASA
*
* SPDX-License-Identifier: Apache-2.0
*/
#include <stdio.h>
#include <stdlib.h>
#include <soc.h>
#include <posix_native_task.h>
#include <nsi_cpu_if.h>
#include "bstests.h"
#include "bs_tracing.h"
#include "phy_sync_ctrl.h"
#include "nsi_hw_scheduler.h"
#include "nsi_cpu_ctrl.h"
#include "nsi_host_trampolines.h"
/*
* These hooks are to be named nsif_cpu<cpu_number>_<hook_name>, for example nsif_cpu0_boot
*/
#define nsif_cpun_pre_cmdline_hooks _CONCAT(_CONCAT(nsif_cpu, CONFIG_NATIVE_SIMULATOR_MCU_N),\
_pre_cmdline_hooks)
#define nsif_cpun_save_test_arg _CONCAT(_CONCAT(nsif_cpu, CONFIG_NATIVE_SIMULATOR_MCU_N),\
_save_test_arg)
#define nsif_cpun_pre_hw_init_hooks _CONCAT(_CONCAT(nsif_cpu, CONFIG_NATIVE_SIMULATOR_MCU_N),\
_pre_hw_init_hooks)
#define nsif_cpun_boot _CONCAT(_CONCAT(nsif_cpu, CONFIG_NATIVE_SIMULATOR_MCU_N),\
_boot)
#define nsif_cpun_cleanup _CONCAT(_CONCAT(nsif_cpu, CONFIG_NATIVE_SIMULATOR_MCU_N),\
_cleanup)
#define nsif_cpun_irq_raised _CONCAT(_CONCAT(nsif_cpu, CONFIG_NATIVE_SIMULATOR_MCU_N),\
_irq_raised)
#define nsif_cpun_test_hook _CONCAT(_CONCAT(nsif_cpu, CONFIG_NATIVE_SIMULATOR_MCU_N),\
_test_hook)
#define nsif_cpun_irq_raised_from_sw _CONCAT(_CONCAT(nsif_cpu, CONFIG_NATIVE_SIMULATOR_MCU_N),\
_irq_raised_from_sw)
NATIVE_SIMULATOR_IF void nsif_cpun_pre_cmdline_hooks(void)
{
run_native_tasks(_NATIVE_PRE_BOOT_1_LEVEL);
#if defined(CONFIG_NATIVE_SIMULATOR_AUTOSTART_MCU)
nsi_cpu_set_auto_start(CONFIG_NATIVE_SIMULATOR_MCU_N, true);
#endif
}
#define TESTCASAE_ARGV_ALLOCSIZE 128
static struct {
char **test_case_argv;
int test_case_argc;
int allocated_size;
} test_args;
NATIVE_SIMULATOR_IF void nsif_cpun_save_test_arg(char *argv)
{
if (test_args.test_case_argc >= test_args.allocated_size) {
test_args.allocated_size += TESTCASAE_ARGV_ALLOCSIZE;
test_args.test_case_argv = nsi_host_realloc(test_args.test_case_argv,
test_args.allocated_size * sizeof(char *));
if (test_args.test_case_argv == NULL) { /* LCOV_EXCL_BR_LINE */
bs_trace_error_line("Can't allocate memory\n"); /* LCOV_EXCL_LINE */
}
}
bs_trace_raw(9, "cmdarg: adding '%s' to testcase args[%i]\n",
argv, test_args.test_case_argc);
test_args.test_case_argv[test_args.test_case_argc++] = argv;
}
static void test_args_free(void)
{
if (test_args.test_case_argv) {
nsi_host_free(test_args.test_case_argv);
test_args.test_case_argv = NULL;
}
}
NATIVE_TASK(test_args_free, ON_EXIT_PRE, 100);
NATIVE_SIMULATOR_IF void nsif_cpun_pre_hw_init_hooks(void)
{
run_native_tasks(_NATIVE_PRE_BOOT_2_LEVEL);
phy_sync_ctrl_connect_to_2G4_phy();
/* We pass to a possible testcase its command line arguments */
bst_pass_args(test_args.test_case_argc, test_args.test_case_argv);
phy_sync_ctrl_pre_boot2();
}
NATIVE_SIMULATOR_IF void nsif_cpun_boot(void)
{
run_native_tasks(_NATIVE_PRE_BOOT_3_LEVEL);
bst_pre_init();
phy_sync_ctrl_pre_boot3();
posix_boot_cpu();
run_native_tasks(_NATIVE_FIRST_SLEEP_LEVEL);
bst_post_init();
}
NATIVE_SIMULATOR_IF int nsif_cpun_cleanup(void)
{
/*
* Note posix_soc_clean_up() may not return, but in that case,
* nsif_cpun_cleanup() will be called again
*/
posix_soc_clean_up();
uint8_t bst_result = bst_delete();
return bst_result;
}
NATIVE_SIMULATOR_IF void nsif_cpun_irq_raised(void)
{
posix_interrupt_raised();
}
NATIVE_SIMULATOR_IF int nsif_cpun_test_hook(void *p)
{
(void) p;
bst_tick(nsi_hws_get_time());
return 0;
}
NATIVE_SIMULATOR_IF void nsif_cpun_irq_raised_from_sw(void)
{
void posix_irq_handler_im_from_sw(void);
posix_irq_handler_im_from_sw();
}