# rtai_srq.h

    00001 /*
    00002 COPYRIGHT (C) 2000  Paolo Mantegazza (mantegazza@aero.polimi.it)
    00003
    00004 This library is free software; you can redistribute it and/or
    00005 modify it under the terms of the GNU Lesser General Public
    00006 License as published by the Free Software Foundation; either
    00007 version 2 of the License, or (at your option) any later version.
    00008
    00009 This library is distributed in the hope that it will be useful,
    00010 but WITHOUT ANY WARRANTY; without even the implied warranty of
    00011 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
    00012 Lesser General Public License for more details.
    00013
    00014 You should have received a copy of the GNU Lesser General Public
    00015 License along with this library; if not, write to the Free Software
    00016 Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA.
    00017 */
    00018
    00019
    00020 #ifndef _RTAI_SRQ_H_
    00021 #define _RTAI_SRQ_H_
    00022
    00023 // the following function is adapted from Linux PPC unistd.h
    00024 static inline long long rtai_srq(unsigned long srq, unsigned long whatever)
    00025 {
    00026         long long retval;
    00027         register unsigned long __sc_0 __asm__ ("r0");
    00028         register unsigned long __sc_3 __asm__ ("r3");
    00029         register unsigned long __sc_4 __asm__ ("r4");
    00030
    00031         __sc_0 = (__sc_3 = srq) + (__sc_4 = whatever);
    00032         __asm__ __volatile__
    00033                 ("trap         \n\t"
    00034                 : "=&r" (__sc_3), "=&r" (__sc_4)
    00035                 : "0"   (__sc_3), "1"   (__sc_4),
    00036                   "r"   (__sc_0)
    00037                 : "r0", "r3", "r4" );
    00038         ((unsigned long *)&retval)[0] = __sc_3;
    00039         ((unsigned long *)&retval)[1] = __sc_4;
    00040         return retval;
    00041 }
    00042
    00043 static inline int rtai_open_srq(unsigned int label)
    00044 {
    00045         return (int)rtai_srq(0, label);
    00046 }
    00047 #endif