136 lines
3.2 KiB
C
136 lines
3.2 KiB
C
/*
|
|
* Copyright (c) 2014 Wind River Systems, Inc.
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
/**
|
|
* @file
|
|
* @brief Full C support initialization
|
|
*
|
|
*
|
|
* Initialization of full C support: zero the .bss, copy the .data if XIP,
|
|
* call z_cstart().
|
|
*
|
|
* Stack is available in this module, but not the global data/bss until their
|
|
* initialization is performed.
|
|
*/
|
|
|
|
#include <zephyr/types.h>
|
|
#include <zephyr/toolchain.h>
|
|
#include <zephyr/linker/linker-defs.h>
|
|
#include <zephyr/arch/arc/v2/aux_regs.h>
|
|
#include <zephyr/arch/arc/cluster.h>
|
|
#include <zephyr/kernel_structs.h>
|
|
#include <kernel_internal.h>
|
|
|
|
/* XXX - keep for future use in full-featured cache APIs */
|
|
#if 0
|
|
/**
|
|
* @brief Disable the i-cache if present
|
|
*
|
|
* For those ARC CPUs that have a i-cache present,
|
|
* invalidate the i-cache and then disable it.
|
|
*/
|
|
|
|
static void disable_icache(void)
|
|
{
|
|
unsigned int val;
|
|
|
|
val = z_arc_v2_aux_reg_read(_ARC_V2_I_CACHE_BUILD);
|
|
val &= 0xff; /* version field */
|
|
if (val == 0) {
|
|
return; /* skip if i-cache is not present */
|
|
}
|
|
z_arc_v2_aux_reg_write(_ARC_V2_IC_IVIC, 0);
|
|
__builtin_arc_nop();
|
|
z_arc_v2_aux_reg_write(_ARC_V2_IC_CTRL, 1);
|
|
}
|
|
|
|
/**
|
|
* @brief Invalidate the data cache if present
|
|
*
|
|
* For those ARC CPUs that have a data cache present,
|
|
* invalidate the data cache.
|
|
*/
|
|
|
|
static void invalidate_dcache(void)
|
|
{
|
|
unsigned int val;
|
|
|
|
val = z_arc_v2_aux_reg_read(_ARC_V2_D_CACHE_BUILD);
|
|
val &= 0xff; /* version field */
|
|
if (val == 0) {
|
|
return; /* skip if d-cache is not present */
|
|
}
|
|
z_arc_v2_aux_reg_write(_ARC_V2_DC_IVDC, 1);
|
|
}
|
|
#endif
|
|
|
|
#ifdef CONFIG_ISA_ARCV3
|
|
/* NOTE: it will be called from early C code - we must NOT use global / static variables in it! */
|
|
static void arc_cluster_scm_enable(void)
|
|
{
|
|
unsigned int cluster_version;
|
|
|
|
/* Check that we have cluster and its version is supported */
|
|
cluster_version = z_arc_v2_aux_reg_read(_ARC_REG_CLN_BCR) & _ARC_CLN_BCR_VER_MAJOR_MASK;
|
|
if (cluster_version < _ARC_REG_CLN_BCR_VER_MAJOR_ARCV3_MIN) {
|
|
return;
|
|
}
|
|
|
|
/* Check that we have shared cache in cluster */
|
|
if (!(z_arc_v2_aux_reg_read(_ARC_CLNR_BCR_0) & _ARC_CLNR_BCR_0_HAS_SCM)) {
|
|
return;
|
|
}
|
|
|
|
/* Disable SCM, just in case. */
|
|
arc_cln_write_reg_nolock(ARC_CLN_CACHE_STATUS, 0);
|
|
|
|
/* Invalidate SCM before enabling. */
|
|
arc_cln_write_reg_nolock(ARC_CLN_CACHE_CMD,
|
|
ARC_CLN_CACHE_CMD_OP_REG_INV | ARC_CLN_CACHE_CMD_INCR);
|
|
while (arc_cln_read_reg_nolock(ARC_CLN_CACHE_STATUS) & ARC_CLN_CACHE_STATUS_BUSY)
|
|
;
|
|
|
|
arc_cln_write_reg_nolock(ARC_CLN_CACHE_STATUS, ARC_CLN_CACHE_STATUS_EN);
|
|
}
|
|
#endif /* CONFIG_ISA_ARCV3 */
|
|
|
|
#ifdef __CCAC__
|
|
extern char __device_states_start[];
|
|
extern char __device_states_end[];
|
|
/**
|
|
* @brief Clear device_states section
|
|
*
|
|
* This routine clears the device_states section,
|
|
* as MW compiler marks the section with NOLOAD flag.
|
|
*/
|
|
static void dev_state_zero(void)
|
|
{
|
|
z_early_memset(__device_states_start, 0, __device_states_end - __device_states_start);
|
|
}
|
|
#endif
|
|
|
|
extern FUNC_NORETURN void z_cstart(void);
|
|
/**
|
|
* @brief Prepare to and run C code
|
|
*
|
|
* This routine prepares for the execution of and runs C code.
|
|
*/
|
|
|
|
void z_prep_c(void)
|
|
{
|
|
#ifdef CONFIG_ISA_ARCV3
|
|
arc_cluster_scm_enable();
|
|
#endif
|
|
|
|
z_bss_zero();
|
|
#ifdef __CCAC__
|
|
dev_state_zero();
|
|
#endif
|
|
z_data_copy();
|
|
z_cstart();
|
|
CODE_UNREACHABLE;
|
|
}
|