diff options
author | Sebastian Huber <sebastian.huber@embedded-brains.de> | 2017-09-22 13:48:40 +0200 |
---|---|---|
committer | Sebastian Huber <sebastian.huber@embedded-brains.de> | 2017-09-22 14:15:51 +0200 |
commit | 29919242dbc260fff2e82df9477003868aac7a71 (patch) | |
tree | f0293bf714a0f5e8b26661b6f04f99438d06e1c8 /c/src/lib/libbsp/arm/imx/startup/bspsmp.c | |
parent | bsp/imx: Add register headers (diff) | |
download | rtems-29919242dbc260fff2e82df9477003868aac7a71.tar.bz2 |
bsp/imx: Add SMP support
Update #3090.
Diffstat (limited to 'c/src/lib/libbsp/arm/imx/startup/bspsmp.c')
-rw-r--r-- | c/src/lib/libbsp/arm/imx/startup/bspsmp.c | 38 |
1 files changed, 22 insertions, 16 deletions
diff --git a/c/src/lib/libbsp/arm/imx/startup/bspsmp.c b/c/src/lib/libbsp/arm/imx/startup/bspsmp.c index ac9561db05..51c7aef12a 100644 --- a/c/src/lib/libbsp/arm/imx/startup/bspsmp.c +++ b/c/src/lib/libbsp/arm/imx/startup/bspsmp.c @@ -14,28 +14,34 @@ #include <rtems/score/smpimpl.h> -uint32_t _CPU_SMP_Initialize(void) -{ - return 1; -} +#include <arm/freescale/imx/imx_srcreg.h> +#include <arm/freescale/imx/imx_gpcreg.h> + +#include <bsp/start.h> bool _CPU_SMP_Start_processor(uint32_t cpu_index) { - (void) cpu_index; + bool started; - /* Nothing to do */ + if (cpu_index == 1) { + volatile imx_src *src = (volatile imx_src *) 0x30390000; + volatile imx_gpc *gpc = (volatile imx_gpc *) 0x303a0000; - return true; -} + src->gpr3 = (uint32_t) _start; + gpc->pgc_a7core0_ctrl |= IMX_GPC_PGC_CTRL_PCR; + gpc->cpu_pgc_sw_pup_req |= IMX_GPC_CPU_PGC_CORE1_A7; -void _CPU_SMP_Finalize_initialization(uint32_t cpu_count) -{ -} + while ((gpc->cpu_pgc_pup_status1 & IMX_GPC_CPU_PGC_CORE1_A7) != 0) { + /* Wait */ + } -void _CPU_SMP_Prepare_start_multitasking(void) -{ -} + gpc->pgc_a7core0_ctrl &= ~IMX_GPC_PGC_CTRL_PCR; + src->a7rcr1 |= IMX_SRC_A7RCR1_A7_CORE1_ENABLE; -void _CPU_SMP_Send_interrupt(uint32_t target_processor_index) -{ + started = true; + } else { + started = false; + } + + return started; } |