forked from Imagelibrary/rtems
@@ -361,6 +361,7 @@ libscore_a_SOURCES += src/sched.c
|
|||||||
libscore_a_SOURCES += src/semaphore.c
|
libscore_a_SOURCES += src/semaphore.c
|
||||||
libscore_a_SOURCES += src/smpbarrierwait.c
|
libscore_a_SOURCES += src/smpbarrierwait.c
|
||||||
libscore_a_SOURCES += src/kern_tc.c
|
libscore_a_SOURCES += src/kern_tc.c
|
||||||
|
libscore_a_SOURCES += src/libatomic.c
|
||||||
|
|
||||||
EXTRA_DIST = src/Unlimited.txt
|
EXTRA_DIST = src/Unlimited.txt
|
||||||
|
|
||||||
|
|||||||
@@ -14,7 +14,6 @@ libscorecpu_a_SOURCES = cpu.c cpu_asm.S
|
|||||||
libscorecpu_a_SOURCES += sparc-context-volatile-clobber.S
|
libscorecpu_a_SOURCES += sparc-context-volatile-clobber.S
|
||||||
libscorecpu_a_SOURCES += sparc-context-validate.S
|
libscorecpu_a_SOURCES += sparc-context-validate.S
|
||||||
libscorecpu_a_SOURCES += sparc-counter.c
|
libscorecpu_a_SOURCES += sparc-counter.c
|
||||||
libscorecpu_a_SOURCES += sparcv8-atomic.c
|
|
||||||
libscorecpu_a_CPPFLAGS = $(AM_CPPFLAGS)
|
libscorecpu_a_CPPFLAGS = $(AM_CPPFLAGS)
|
||||||
|
|
||||||
include $(srcdir)/preinstall.am
|
include $(srcdir)/preinstall.am
|
||||||
|
|||||||
@@ -1,211 +0,0 @@
|
|||||||
/*
|
|
||||||
* Copyright (c) 2014-2015 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.org/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_Local_disable( 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_Local_enable( 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;
|
|
||||||
}
|
|
||||||
|
|
||||||
/*
|
|
||||||
* In order to get rid of the warning "conflicting types for built-in function
|
|
||||||
* '__atomic_compare_exchange_4' [enabled by default]", you must port libatomic
|
|
||||||
* to SPARC/RTEMS. The libatomic is provided by GCC.
|
|
||||||
*/
|
|
||||||
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;
|
|
||||||
uint32_t actual;
|
|
||||||
|
|
||||||
level = _SPARCV8_Acquire_the_one_lock();
|
|
||||||
|
|
||||||
actual = *mem;
|
|
||||||
equal = ( actual == *expected );
|
|
||||||
if ( equal ) {
|
|
||||||
*mem = desired;
|
|
||||||
} else {
|
|
||||||
*expected = actual;
|
|
||||||
}
|
|
||||||
|
|
||||||
_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;
|
|
||||||
}
|
|
||||||
79
cpukit/score/src/libatomic.c
Normal file
79
cpukit/score/src/libatomic.c
Normal file
@@ -0,0 +1,79 @@
|
|||||||
|
/*
|
||||||
|
* Copyright (c) 2016 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.org/license/LICENSE.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#if HAVE_CONFIG_H
|
||||||
|
#include "config.h"
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#include <machine/_libatomic.h>
|
||||||
|
|
||||||
|
#include <rtems/score/apimutex.h>
|
||||||
|
#include <rtems/score/atomic.h>
|
||||||
|
#include <rtems/score/isrlevel.h>
|
||||||
|
|
||||||
|
#if defined(RTEMS_SMP)
|
||||||
|
/*
|
||||||
|
* For real SMP targets this is not useful. The main purpose is support for
|
||||||
|
* testing on simulators like SIS.
|
||||||
|
*/
|
||||||
|
static Atomic_Flag _Libatomic_The_one_lock = ATOMIC_INITIALIZER_FLAG;
|
||||||
|
#endif
|
||||||
|
|
||||||
|
__uint32_t _Libatomic_Protect_start( void *ptr )
|
||||||
|
{
|
||||||
|
ISR_Level isr_level;
|
||||||
|
|
||||||
|
(void) ptr;
|
||||||
|
_ISR_Local_disable( isr_level );
|
||||||
|
|
||||||
|
#if defined(RTEMS_SMP)
|
||||||
|
while (
|
||||||
|
_Atomic_Flag_test_and_set( &_Libatomic_The_one_lock, ATOMIC_ORDER_SEQ_CST )
|
||||||
|
) {
|
||||||
|
/* Next try. Yes, a TAS spin lock implementation is stupid. */
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
return isr_level;
|
||||||
|
}
|
||||||
|
|
||||||
|
void _Libatomic_Protect_end( void *ptr, __uint32_t isr_level )
|
||||||
|
{
|
||||||
|
(void) ptr;
|
||||||
|
|
||||||
|
#if defined(RTEMS_SMP)
|
||||||
|
_Atomic_Flag_clear( &_Libatomic_The_one_lock, ATOMIC_ORDER_SEQ_CST );
|
||||||
|
#endif
|
||||||
|
|
||||||
|
_ISR_Local_enable( isr_level );
|
||||||
|
}
|
||||||
|
|
||||||
|
/*
|
||||||
|
* FIXME: The once lock should be only a temporary solution. We need a
|
||||||
|
* dedicated internal mutex for this.
|
||||||
|
*/
|
||||||
|
|
||||||
|
void _Libatomic_Lock_n( void *ptr, __size_t n )
|
||||||
|
{
|
||||||
|
(void) ptr;
|
||||||
|
(void) n;
|
||||||
|
_Once_Lock();
|
||||||
|
}
|
||||||
|
|
||||||
|
void _Libatomic_Unlock_n( void *ptr, __size_t n )
|
||||||
|
{
|
||||||
|
(void) ptr;
|
||||||
|
(void) n;
|
||||||
|
_Once_Unlock();
|
||||||
|
}
|
||||||
Reference in New Issue
Block a user