Loading...
/* Machine-dependent pthreads configuration and inline functions.
*
* Copyright (C) 2005-2007 Atmel Corporation
*
* This file is subject to the terms and conditions of the GNU Lesser General
* Public License. See the file "COPYING.LIB" in the main directory of this
* archive for more details.
*/
#ifndef _PT_MACHINE_H
#define _PT_MACHINE_H 1
#include <features.h>
#ifndef PT_EI
# define PT_EI __extern_always_inline
#endif
static __inline__ int
_test_and_set (int *p, int v)
{
int result;
__asm__ __volatile__(
"/* Inline test and set */\n"
" xchg %[old], %[mem], %[new]"
: [old] "=&r"(result)
: [mem] "r"(p), [new] "r"(v)
: "memory");
return result;
}
extern long int testandset (int *spinlock);
extern int __compare_and_swap (long int *p, long int oldval, long int newval);
/* Spinlock implementation; required. */
PT_EI long int
testandset (int *spinlock)
{
return _test_and_set(spinlock, 1);
}
/* Get some notion of the current stack. Need not be exactly the top
of the stack, just something somewhere in the current frame. */
#define CURRENT_STACK_FRAME stack_pointer
register char * stack_pointer __asm__ ("sp");
/* Compare-and-swap for semaphores. */
#define HAS_COMPARE_AND_SWAP
PT_EI int
__compare_and_swap(long int *p, long int oldval, long int newval)
{
long int result;
__asm__ __volatile__(
"/* Inline compare and swap */\n"
"1: ssrf 5\n"
" ld.w %[result], %[mem]\n"
" eor %[result], %[old]\n"
" brne 2f\n"
" stcond %[mem], %[new]\n"
" brne 1b\n"
"2:"
: [result] "=&r"(result), [mem] "=m"(*p)
: "m"(*p), [new] "r"(newval), [old] "r"(oldval)
: "cc", "memory");
return result == 0;
}
#endif /* pt-machine.h */
|