Orocos Real-Time Toolkit  2.5.0
oro_system.h
00001 /***************************************************************************
00002   tag: FMTC  Tue Mar 11 21:49:19 CET 2008  oro_system.h
00003 
00004                         oro_system.h -  description
00005                            -------------------
00006     begin                : Tue March 11 2008
00007     copyright            : (C) 2008 FMTC
00008     email                : peter.soetens@fmtc.be
00009 
00010  ***************************************************************************
00011  *   This library is free software; you can redistribute it and/or         *
00012  *   modify it under the terms of the GNU General Public                   *
00013  *   License as published by the Free Software Foundation;                 *
00014  *   version 2 of the License.                                             *
00015  *                                                                         *
00016  *   As a special exception, you may use this file as part of a free       *
00017  *   software library without restriction.  Specifically, if other files   *
00018  *   instantiate templates or use macros or inline functions from this     *
00019  *   file, or you compile this file and link it with other files to        *
00020  *   produce an executable, this file does not by itself cause the         *
00021  *   resulting executable to be covered by the GNU General Public          *
00022  *   License.  This exception does not however invalidate any other        *
00023  *   reasons why the executable file might be covered by the GNU General   *
00024  *   Public License.                                                       *
00025  *                                                                         *
00026  *   This library is distributed in the hope that it will be useful,       *
00027  *   but WITHOUT ANY WARRANTY; without even the implied warranty of        *
00028  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU     *
00029  *   Lesser General Public License for more details.                       *
00030  *                                                                         *
00031  *   You should have received a copy of the GNU General Public             *
00032  *   License along with this library; if not, write to the Free Software   *
00033  *   Foundation, Inc., 59 Temple Place,                                    *
00034  *   Suite 330, Boston, MA  02111-1307  USA                                *
00035  *                                                                         *
00036  ***************************************************************************/
00037 
00038 
00039 #include "oro_atomic.h"
00040 
00041 #ifdef _cplusplus
00042 extern "C"
00043 {
00044 #endif // _cplusplus
00045 
00046 #define __HAVE_ARCH_CMPXCHG 1
00047 
00048 static __inline__ unsigned long
00049 __cmpxchg_u32(volatile unsigned int *p, unsigned long old, unsigned long newp)
00050 {
00051     unsigned int prev;
00052 
00053     __asm__ __volatile__ (
00054     LWSYNC_ON_SMP
00055 "1: lwarx   %0,0,%2     # __cmpxchg_u32\n\
00056     cmpw    0,%0,%3\n\
00057     bne-    2f\n"
00058     PPC405_ERR77(0,%2)
00059 "   stwcx.  %4,0,%2\n\
00060     bne-    1b"
00061     ISYNC_ON_SMP
00062     "\n\
00063 2:"
00064     : "=&r" (prev), "=m" (*p)
00065     : "r" (p), "r" (old), "r" (newp), "m" (*p)
00066     : "cc", "memory");
00067 
00068     return prev;
00069 }
00070 
00071   // KG did explicit cast to remove following error
00072   /*
00073   /kgad/orocos-port-branch/ports/ecos/arch/powerpc/boa5200/orecos-library/install/include/os/oro_powerpc/oro_system.h:
00074   In function `long unsigned int __oro_cmpxchg(volatile void*, long
00075   unsigned int, long unsigned int, unsigned int)':
00076   /kgad/orocos-port-branch/ports/ecos/arch/powerpc/boa5200/orecos-library/install/include/os/oro_powerpc/oro_system.h:52:
00077   error: invalid conversion from `volatile void*' to `volatile
00078   unsigned int*'
00079   /kgad/orocos-port-branch/ports/ecos/arch/powerpc/boa5200/orecos-library/install/include/os/oro_powerpc/oro_system.h:52:
00080   error:   initializing argument 1 of `long unsigned int
00081   __cmpxchg_u32(volatile unsigned int*, long unsigned int, long
00082   unsigned int)' */
00083 
00084 static __inline__ unsigned long
00085 __oro_cmpxchg(volatile void *ptr, unsigned long old, unsigned long newp, unsigned int size)
00086 {
00087     switch (size) {
00088     case 4:
00089         return __cmpxchg_u32((volatile unsigned int *) ptr, old, newp);
00090     }
00091     return old;
00092 }
00093 
00094 #define oro_cmpxchg(ptr,o,n)                         \
00095   ({                                     \
00096      __typeof__(*(ptr)) _o_ = (o);                   \
00097      __typeof__(*(ptr)) _n_ = (n);                   \
00098      (__typeof__(*(ptr))) __oro_cmpxchg((ptr), (unsigned long)_o_,       \
00099                     (unsigned long)_n_, sizeof(*(ptr))); \
00100   })
00101 
00102 #ifdef _cplusplus
00103 } // end extern "C"
00104 #endif // _cplusplus