Xenomai  3.0-rc6
syscall.h
1 /*
2  * Copyright (C) 2009 Philippe Gerum <rpm@xenomai.org>.
3  *
4  * This library is free software; you can redistribute it and/or
5  * modify it under the terms of the GNU Lesser General Public
6  * License as published by the Free Software Foundation; either
7  * version 2 of the License, or (at your option) any later version.
8  *
9  * This library is distributed in the hope that it will be useful,
10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
12  * Lesser General Public License for more details.
13  *
14  * You should have received a copy of the GNU Lesser General Public
15  * License along with this library; if not, write to the Free Software
16  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
17  */
18 #ifndef _LIB_COBALT_NIOS2_SYSCALL_H
19 #define _LIB_COBALT_NIOS2_SYSCALL_H
20 
21 #include <cobalt/uapi/syscall.h>
22 #include <errno.h>
23 
24 #define __emit_syscall0(syscode) \
25  ({ \
26  long __ret; \
27  \
28  __asm__ __volatile__ ( \
29  "mov r2, %1\n\t" \
30  "trap\n\t" \
31  "mov %0, r2\n\t" \
32  : "=r"(__ret) \
33  : "r"(syscode) \
34  : "r2", "memory" \
35  ); \
36  __ret; \
37  })
38 
39 #define __emit_syscall1(syscode, a1) \
40  ({ \
41  long __ret; \
42  \
43  __asm__ __volatile__ ( \
44  "mov r2, %1\n\t" \
45  "mov r4, %2\n\t" \
46  "trap\n\t" \
47  "mov %0, r2\n\t" \
48  : "=r"(__ret) \
49  : "r"(syscode), \
50  "r" ((long)a1) \
51  : "r2", "r4", "memory" \
52  ); \
53  __ret; \
54  })
55 
56 #define __emit_syscall2(syscode, a1, a2) \
57  ({ \
58  long __ret; \
59  \
60  __asm__ __volatile__ ( \
61  "mov r2, %1\n\t" \
62  "mov r4, %2\n\t" \
63  "mov r5, %3\n\t" \
64  "trap\n\t" \
65  "mov %0, r2\n\t" \
66  : "=r"(__ret) \
67  : "r"(syscode), \
68  "r" ((long)a1), \
69  "r" ((long)a2) \
70  : "r2", "r4", "r5", "memory" \
71  ); \
72  __ret; \
73  })
74 
75 #define __emit_syscall3(syscode, a1, a2, a3) \
76  ({ \
77  long __ret; \
78  \
79  __asm__ __volatile__ ( \
80  "mov r2, %1\n\t" \
81  "mov r4, %2\n\t" \
82  "mov r5, %3\n\t" \
83  "mov r6, %4\n\t" \
84  "trap\n\t" \
85  "mov %0, r2\n\t" \
86  : "=r"(__ret) \
87  : "r"(syscode), \
88  "r" ((long)a1), \
89  "r" ((long)a2), \
90  "r" ((long)a3) \
91  : "r2", "r4", "r5", "r6", "memory" \
92  ); \
93  __ret; \
94  })
95 
96 #define __emit_syscall4(syscode, a1, a2, a3, a4) \
97  ({ \
98  long __ret; \
99  \
100  __asm__ __volatile__ ( \
101  "mov r2, %1\n\t" \
102  "mov r4, %2\n\t" \
103  "mov r5, %3\n\t" \
104  "mov r6, %4\n\t" \
105  "mov r7, %5\n\t" \
106  "trap\n\t" \
107  "mov %0, r2\n\t" \
108  : "=r"(__ret) \
109  : "r"(syscode), \
110  "r" ((long)a1), \
111  "r" ((long)a2), \
112  "r" ((long)a3), \
113  "r" ((long)a4) \
114  : "r2", "r4", "r5", "r6", "r7", "memory" \
115  ); \
116  __ret; \
117  })
118 
119 #define __emit_syscall5(syscode, a1, a2, a3, a4, a5) \
120  ({ \
121  long __ret; \
122  \
123  __asm__ __volatile__ ( \
124  "mov r2, %1\n\t" \
125  "mov r4, %2\n\t" \
126  "mov r5, %3\n\t" \
127  "mov r6, %4\n\t" \
128  "mov r7, %5\n\t" \
129  "mov r8, %6\n\t" \
130  "trap\n\t" \
131  "mov %0, r2\n\t" \
132  : "=r"(__ret) \
133  : "r"(syscode), \
134  "r" ((long)a1), \
135  "r" ((long)a2), \
136  "r" ((long)a3), \
137  "r" ((long)a4), \
138  "r" ((long)a5) \
139  : "r2", "r4", "r5", "r6", "r7", "r8", "memory" \
140  ); \
141  __ret; \
142  })
143 
144 #define XENOMAI_DO_SYSCALL(nr, op, args...) \
145  __emit_syscall##nr(__xn_syscode(op), ##args)
146 
147 #define XENOMAI_SYSCALL0(op) XENOMAI_DO_SYSCALL(0,op)
148 #define XENOMAI_SYSCALL1(op,a1) XENOMAI_DO_SYSCALL(1,op,a1)
149 #define XENOMAI_SYSCALL2(op,a1,a2) XENOMAI_DO_SYSCALL(2,op,a1,a2)
150 #define XENOMAI_SYSCALL3(op,a1,a2,a3) XENOMAI_DO_SYSCALL(3,op,a1,a2,a3)
151 #define XENOMAI_SYSCALL4(op,a1,a2,a3,a4) XENOMAI_DO_SYSCALL(4,op,a1,a2,a3,a4)
152 #define XENOMAI_SYSCALL5(op,a1,a2,a3,a4,a5) XENOMAI_DO_SYSCALL(5,op,a1,a2,a3,a4,a5)
153 #define XENOMAI_SYSBIND(breq) XENOMAI_DO_SYSCALL(1,sc_cobalt_bind,breq)
154 
155 #endif /* !_LIB_COBALT_NIOS2_SYSCALL_H */