From be3d697450f88426467fc01d9fffefe0832a8567 Mon Sep 17 00:00:00 2001 From: Sebastian Huber Date: Tue, 1 Oct 2019 08:54:20 +0200 Subject: bsp/erc32: Improve pseudo-SMP support Add support for _SMP_Send_message() to the own processor. This is required by the smpmulticast01 test program. --- bsps/sparc/erc32/start/bspsmp.c | 84 ++++++++++++++++++++++++++++++++ c/src/lib/libbsp/sparc/erc32/Makefile.am | 3 +- 2 files changed, 85 insertions(+), 2 deletions(-) create mode 100644 bsps/sparc/erc32/start/bspsmp.c diff --git a/bsps/sparc/erc32/start/bspsmp.c b/bsps/sparc/erc32/start/bspsmp.c new file mode 100644 index 0000000000..a275d36fd0 --- /dev/null +++ b/bsps/sparc/erc32/start/bspsmp.c @@ -0,0 +1,84 @@ +/* + * SPDX-License-Identifier: BSD-2-Clause + * + * Copyright (C) 2019 embedded brains GmbH + * + * 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. + * + * 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. + */ + +#include +#include +#include +#include + +#define IPI_VECTOR SPARC_SYNCHRONOUS_TRAP( 0x91 ) + +uint32_t _CPU_SMP_Get_current_processor( void ) +{ + return 0; +} + +uint32_t _CPU_SMP_Initialize( void ) +{ + return 1; +} + +bool _CPU_SMP_Start_processor( uint32_t cpu_index ) +{ + (void) cpu_index; + return true; +} + +void _CPU_SMP_Finalize_initialization( uint32_t cpu_count ) +{ + _Assert( cpu_count == 1 ); + (void) cpu_count; +} + +void _CPU_SMP_Prepare_start_multitasking( void ) +{ +} + +void _CPU_SMP_Send_interrupt( uint32_t target_processor_index ) +{ + _Assert( target_processor_index == 0 ); + (void) target_processor_index; + __asm__ volatile( "ta 0x11; nop " ); +} + +static rtems_isr bsp_inter_processor_interrupt( + rtems_vector_number vector +) +{ + _SMP_Inter_processor_interrupt_handler( _Per_CPU_Get() ); +} + +static void erc32_install_inter_processor_interrupt( void ) +{ + set_vector( bsp_inter_processor_interrupt, IPI_VECTOR, 1 ); +} + +RTEMS_SYSINIT_ITEM( + erc32_install_inter_processor_interrupt, + RTEMS_SYSINIT_BSP_PRE_DRIVERS, + RTEMS_SYSINIT_ORDER_LAST +); diff --git a/c/src/lib/libbsp/sparc/erc32/Makefile.am b/c/src/lib/libbsp/sparc/erc32/Makefile.am index 994e55cc40..8cdd4581bf 100644 --- a/c/src/lib/libbsp/sparc/erc32/Makefile.am +++ b/c/src/lib/libbsp/sparc/erc32/Makefile.am @@ -55,8 +55,7 @@ librtemsbsp_a_SOURCES += ../../../../../../bsps/sparc/shared/irq/bsp_isr_handler librtemsbsp_a_SOURCES += ../../../../../../bsps/shared/irq/irq-default-handler.c if HAS_SMP -librtemsbsp_a_SOURCES += ../../../../../../bsps/shared/start/bspsmp-dummy.c -librtemsbsp_a_SOURCES += ../../../../../../bsps/shared/start/getcurrentprocessor-zero.c +librtemsbsp_a_SOURCES += ../../../../../../bsps/sparc/erc32/start/bspsmp.c endif if HAS_NETWORKING -- cgit v1.2.3