forked from Imagelibrary/rtems
sparc: Add atomic support for SPARC V8
Use SWAP instruction with one lock for the system in the SMP case.
This commit is contained in:
@@ -12,6 +12,7 @@ include_rtems_score_HEADERS += rtems/score/cpusmplock.h
|
|||||||
|
|
||||||
noinst_LIBRARIES = libscorecpu.a
|
noinst_LIBRARIES = libscorecpu.a
|
||||||
libscorecpu_a_SOURCES = cpu.c cpu_asm.S
|
libscorecpu_a_SOURCES = cpu.c cpu_asm.S
|
||||||
|
libscorecpu_a_SOURCES += sparcv8-atomic.c
|
||||||
libscorecpu_a_CPPFLAGS = $(AM_CPPFLAGS)
|
libscorecpu_a_CPPFLAGS = $(AM_CPPFLAGS)
|
||||||
|
|
||||||
include $(srcdir)/preinstall.am
|
include $(srcdir)/preinstall.am
|
||||||
|
|||||||
202
cpukit/score/cpu/sparc/sparcv8-atomic.c
Normal file
202
cpukit/score/cpu/sparc/sparcv8-atomic.c
Normal file
@@ -0,0 +1,202 @@
|
|||||||
|
/*
|
||||||
|
* Copyright (c) 2014 embedded brains GmbH. All rights reserved.
|
||||||
|
*
|
||||||
|
* embedded brains GmbH
|
||||||
|
* Dornierstr. 4
|
||||||
|
* 82178 Puchheim
|
||||||
|
* Germany
|
||||||
|
* <rtems@embedded-brains.de>
|
||||||
|
*
|
||||||
|
* The license and distribution terms for this file may be
|
||||||
|
* found in the file LICENSE in this distribution or at
|
||||||
|
* http://www.rtems.com/license/LICENSE.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#if HAVE_CONFIG_H
|
||||||
|
#include "config.h"
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#include <rtems/score/cpuopts.h>
|
||||||
|
#include <rtems/score/isrlevel.h>
|
||||||
|
|
||||||
|
/*
|
||||||
|
* This file is a dirty hack. A proper solution would be to add RTEMS support
|
||||||
|
* for libatomic in GCC (see also libatomic/configure.tgt).
|
||||||
|
*/
|
||||||
|
|
||||||
|
#if defined(RTEMS_SMP)
|
||||||
|
static volatile uint32_t _SPARCV8_The_one_lock;
|
||||||
|
|
||||||
|
static inline uint32_t _SPARCV8_Atomic_swap(
|
||||||
|
volatile uint32_t *address,
|
||||||
|
uint32_t value
|
||||||
|
)
|
||||||
|
{
|
||||||
|
asm volatile (
|
||||||
|
"swap [%2], %0"
|
||||||
|
: "=r" (value)
|
||||||
|
: "0" (value), "r" (address)
|
||||||
|
: "memory"
|
||||||
|
);
|
||||||
|
|
||||||
|
return value;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
static ISR_Level _SPARCV8_Acquire_the_one_lock( void )
|
||||||
|
{
|
||||||
|
ISR_Level level;
|
||||||
|
|
||||||
|
_ISR_Disable_without_giant( level );
|
||||||
|
|
||||||
|
#if defined(RTEMS_SMP)
|
||||||
|
do {
|
||||||
|
while ( _SPARCV8_The_one_lock ) {
|
||||||
|
/* Wait */
|
||||||
|
}
|
||||||
|
} while ( _SPARCV8_Atomic_swap( &_SPARCV8_The_one_lock, 1 ) );
|
||||||
|
#endif
|
||||||
|
|
||||||
|
return level;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void _SPARCV8_Release_the_one_lock( ISR_Level level )
|
||||||
|
{
|
||||||
|
#if defined(RTEMS_SMP)
|
||||||
|
_SPARCV8_The_one_lock = 0;
|
||||||
|
#endif
|
||||||
|
_ISR_Enable_without_giant( level );
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t __atomic_exchange_1( uint8_t *mem, uint8_t val, int model )
|
||||||
|
{
|
||||||
|
uint8_t prev;
|
||||||
|
ISR_Level level;
|
||||||
|
|
||||||
|
level = _SPARCV8_Acquire_the_one_lock();
|
||||||
|
|
||||||
|
prev = *mem;
|
||||||
|
*mem = val;
|
||||||
|
|
||||||
|
_SPARCV8_Release_the_one_lock( level );
|
||||||
|
|
||||||
|
return prev;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint32_t __atomic_exchange_4( uint32_t *mem, uint32_t val, int model )
|
||||||
|
{
|
||||||
|
uint32_t prev;
|
||||||
|
ISR_Level level;
|
||||||
|
|
||||||
|
level = _SPARCV8_Acquire_the_one_lock();
|
||||||
|
|
||||||
|
prev = *mem;
|
||||||
|
*mem = val;
|
||||||
|
|
||||||
|
_SPARCV8_Release_the_one_lock( level );
|
||||||
|
|
||||||
|
return prev;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* You get probably a warning here which can be ignored: "warning: conflicting
|
||||||
|
* types for built-in function '__atomic_compare_exchange_4' [enabled by
|
||||||
|
* default]"
|
||||||
|
*/
|
||||||
|
bool __atomic_compare_exchange_4(
|
||||||
|
uint32_t *mem,
|
||||||
|
uint32_t *expected,
|
||||||
|
uint32_t desired,
|
||||||
|
int success,
|
||||||
|
int failure
|
||||||
|
)
|
||||||
|
{
|
||||||
|
bool equal;
|
||||||
|
ISR_Level level;
|
||||||
|
|
||||||
|
level = _SPARCV8_Acquire_the_one_lock();
|
||||||
|
|
||||||
|
equal = *mem == *expected;
|
||||||
|
if ( equal ) {
|
||||||
|
*mem = desired;
|
||||||
|
}
|
||||||
|
|
||||||
|
_SPARCV8_Release_the_one_lock( level );
|
||||||
|
|
||||||
|
return equal;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint32_t __atomic_fetch_add_4( uint32_t *mem, uint32_t val, int model )
|
||||||
|
{
|
||||||
|
uint32_t prev;
|
||||||
|
ISR_Level level;
|
||||||
|
|
||||||
|
level = _SPARCV8_Acquire_the_one_lock();
|
||||||
|
|
||||||
|
prev = *mem;
|
||||||
|
*mem = prev + val;
|
||||||
|
|
||||||
|
_SPARCV8_Release_the_one_lock( level );
|
||||||
|
|
||||||
|
return prev;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint32_t __atomic_fetch_sub_4( uint32_t *mem, uint32_t val, int model )
|
||||||
|
{
|
||||||
|
uint32_t prev;
|
||||||
|
ISR_Level level;
|
||||||
|
|
||||||
|
level = _SPARCV8_Acquire_the_one_lock();
|
||||||
|
|
||||||
|
prev = *mem;
|
||||||
|
*mem = prev - val;
|
||||||
|
|
||||||
|
_SPARCV8_Release_the_one_lock( level );
|
||||||
|
|
||||||
|
return prev;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint32_t __atomic_fetch_and_4( uint32_t *mem, uint32_t val, int model )
|
||||||
|
{
|
||||||
|
uint32_t prev;
|
||||||
|
ISR_Level level;
|
||||||
|
|
||||||
|
level = _SPARCV8_Acquire_the_one_lock();
|
||||||
|
|
||||||
|
prev = *mem;
|
||||||
|
*mem = prev & val;
|
||||||
|
|
||||||
|
_SPARCV8_Release_the_one_lock( level );
|
||||||
|
|
||||||
|
return prev;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint32_t __atomic_fetch_or_4( uint32_t *mem, uint32_t val, int model )
|
||||||
|
{
|
||||||
|
uint32_t prev;
|
||||||
|
ISR_Level level;
|
||||||
|
|
||||||
|
level = _SPARCV8_Acquire_the_one_lock();
|
||||||
|
|
||||||
|
prev = *mem;
|
||||||
|
*mem = prev | val;
|
||||||
|
|
||||||
|
_SPARCV8_Release_the_one_lock( level );
|
||||||
|
|
||||||
|
return prev;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint32_t __atomic_fetch_xor_4( uint32_t *mem, uint32_t val, int model )
|
||||||
|
{
|
||||||
|
uint32_t prev;
|
||||||
|
ISR_Level level;
|
||||||
|
|
||||||
|
level = _SPARCV8_Acquire_the_one_lock();
|
||||||
|
|
||||||
|
prev = *mem;
|
||||||
|
*mem = prev ^ val;
|
||||||
|
|
||||||
|
_SPARCV8_Release_the_one_lock( level );
|
||||||
|
|
||||||
|
return prev;
|
||||||
|
}
|
||||||
Reference in New Issue
Block a user