2018-09-05 16:43:34 +00:00
|
|
|
#include "libc.h"
|
|
|
|
|
2016-12-19 00:38:53 +00:00
|
|
|
#if __ARM_ARCH_4__ || __ARM_ARCH_4T__ || __ARM_ARCH == 4
|
|
|
|
#define BLX "mov lr,pc\n\tbx"
|
|
|
|
#else
|
|
|
|
#define BLX "blx"
|
|
|
|
#endif
|
|
|
|
|
2018-09-05 16:43:34 +00:00
|
|
|
extern hidden uintptr_t __a_cas_ptr, __a_barrier_ptr;
|
2014-04-15 03:41:49 +00:00
|
|
|
|
2018-04-19 01:51:43 +00:00
|
|
|
#if ((__ARM_ARCH_6__ || __ARM_ARCH_6K__ || __ARM_ARCH_6KZ__ || __ARM_ARCH_6ZK__) && !__thumb__) \
|
2018-04-19 01:51:44 +00:00
|
|
|
|| __ARM_ARCH_6T2__ || __ARM_ARCH_7A__ || __ARM_ARCH_7R__ || __ARM_ARCH >= 7
|
2014-11-19 05:40:32 +00:00
|
|
|
|
2016-01-21 23:30:30 +00:00
|
|
|
#define a_ll a_ll
|
|
|
|
static inline int a_ll(volatile int *p)
|
2014-11-19 05:40:32 +00:00
|
|
|
{
|
2016-01-21 23:30:30 +00:00
|
|
|
int v;
|
|
|
|
__asm__ __volatile__ ("ldrex %0, %1" : "=r"(v) : "Q"(*p));
|
|
|
|
return v;
|
2014-11-19 05:40:32 +00:00
|
|
|
}
|
|
|
|
|
2016-01-21 23:30:30 +00:00
|
|
|
#define a_sc a_sc
|
|
|
|
static inline int a_sc(volatile int *p, int v)
|
2014-11-19 05:40:32 +00:00
|
|
|
{
|
2016-01-21 23:30:30 +00:00
|
|
|
int r;
|
2016-01-31 15:33:44 +00:00
|
|
|
__asm__ __volatile__ ("strex %0,%2,%1" : "=&r"(r), "=Q"(*p) : "r"(v) : "memory");
|
2016-01-21 23:30:30 +00:00
|
|
|
return !r;
|
2014-11-19 05:40:32 +00:00
|
|
|
}
|
|
|
|
|
2016-01-21 23:30:30 +00:00
|
|
|
#if __ARM_ARCH_7A__ || __ARM_ARCH_7R__ || __ARM_ARCH >= 7
|
2014-11-19 05:40:32 +00:00
|
|
|
|
2016-01-21 23:30:30 +00:00
|
|
|
#define a_barrier a_barrier
|
|
|
|
static inline void a_barrier()
|
2014-11-19 05:40:32 +00:00
|
|
|
{
|
2016-01-21 23:30:30 +00:00
|
|
|
__asm__ __volatile__ ("dmb ish" : : : "memory");
|
2014-11-19 05:40:32 +00:00
|
|
|
}
|
|
|
|
|
2016-01-21 23:30:30 +00:00
|
|
|
#endif
|
2014-11-19 05:40:32 +00:00
|
|
|
|
2016-01-21 23:30:30 +00:00
|
|
|
#define a_pre_llsc a_barrier
|
|
|
|
#define a_post_llsc a_barrier
|
2014-11-19 05:40:32 +00:00
|
|
|
|
2016-01-21 23:30:30 +00:00
|
|
|
#else
|
2014-11-19 05:40:32 +00:00
|
|
|
|
2016-01-21 23:30:30 +00:00
|
|
|
#define a_cas a_cas
|
|
|
|
static inline int a_cas(volatile int *p, int t, int s)
|
2014-11-19 05:40:32 +00:00
|
|
|
{
|
2016-01-21 23:30:30 +00:00
|
|
|
for (;;) {
|
|
|
|
register int r0 __asm__("r0") = t;
|
|
|
|
register int r1 __asm__("r1") = s;
|
|
|
|
register volatile int *r2 __asm__("r2") = p;
|
2016-12-19 00:38:53 +00:00
|
|
|
register uintptr_t r3 __asm__("r3") = __a_cas_ptr;
|
2016-01-21 23:30:30 +00:00
|
|
|
int old;
|
|
|
|
__asm__ __volatile__ (
|
2016-12-19 00:38:53 +00:00
|
|
|
BLX " r3"
|
|
|
|
: "+r"(r0), "+r"(r3) : "r"(r1), "r"(r2)
|
|
|
|
: "memory", "lr", "ip", "cc" );
|
2016-01-21 23:30:30 +00:00
|
|
|
if (!r0) return t;
|
|
|
|
if ((old=*p)!=t) return old;
|
|
|
|
}
|
2014-04-07 08:03:18 +00:00
|
|
|
}
|
2014-11-19 05:40:32 +00:00
|
|
|
|
2016-01-21 23:30:30 +00:00
|
|
|
#endif
|
2014-11-19 05:40:32 +00:00
|
|
|
|
2016-01-21 23:30:30 +00:00
|
|
|
#ifndef a_barrier
|
2016-01-21 19:08:54 +00:00
|
|
|
#define a_barrier a_barrier
|
2014-11-19 05:40:32 +00:00
|
|
|
static inline void a_barrier()
|
|
|
|
{
|
2016-12-19 00:38:53 +00:00
|
|
|
register uintptr_t ip __asm__("ip") = __a_barrier_ptr;
|
|
|
|
__asm__ __volatile__( BLX " ip" : "+r"(ip) : : "memory", "cc", "lr" );
|
2014-11-19 05:40:32 +00:00
|
|
|
}
|
2011-09-18 20:44:54 +00:00
|
|
|
#endif
|
2016-01-25 02:40:55 +00:00
|
|
|
|
|
|
|
#define a_crash a_crash
|
|
|
|
static inline void a_crash()
|
|
|
|
{
|
2016-01-25 21:59:55 +00:00
|
|
|
__asm__ __volatile__(
|
2016-01-25 02:40:55 +00:00
|
|
|
#ifndef __thumb__
|
2016-01-25 21:59:55 +00:00
|
|
|
".word 0xe7f000f0"
|
|
|
|
#else
|
|
|
|
".short 0xdeff"
|
2016-01-25 02:40:55 +00:00
|
|
|
#endif
|
|
|
|
: : : "memory");
|
|
|
|
}
|
2017-04-18 22:20:54 +00:00
|
|
|
|
2019-07-15 19:33:12 +00:00
|
|
|
#if __ARM_ARCH >= 5 && (!__thumb__ || __thumb2__)
|
2017-10-25 15:54:16 +00:00
|
|
|
|
2017-04-18 22:20:54 +00:00
|
|
|
#define a_clz_32 a_clz_32
|
|
|
|
static inline int a_clz_32(uint32_t x)
|
|
|
|
{
|
|
|
|
__asm__ ("clz %0, %1" : "=r"(x) : "r"(x));
|
|
|
|
return x;
|
|
|
|
}
|
2017-10-25 15:54:16 +00:00
|
|
|
|
2018-04-19 00:41:00 +00:00
|
|
|
#if __ARM_ARCH_6T2__ || __ARM_ARCH_7A__ || __ARM_ARCH_7R__ || __ARM_ARCH >= 7
|
|
|
|
|
|
|
|
#define a_ctz_32 a_ctz_32
|
|
|
|
static inline int a_ctz_32(uint32_t x)
|
|
|
|
{
|
|
|
|
uint32_t xr;
|
|
|
|
__asm__ ("rbit %0, %1" : "=r"(xr) : "r"(x));
|
|
|
|
return a_clz_32(xr);
|
|
|
|
}
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
2017-10-25 15:54:16 +00:00
|
|
|
#endif
|