1 /* ----------------------------------------------------------------------- 2 sysv.S - Copyright (c) 2013 Imagination Technologies Ltd. 3 4 Meta Foreign Function Interface 5 6 Permission is hereby granted, free of charge, to any person obtaining 7 a copy of this software and associated documentation files (the 8 ``Software''), to deal in the Software without restriction, including 9 without limitation the rights to use, copy, modify, merge, publish, 10 distribute, sublicense, and/or sell copies of the Software, and to 11 permit persons to whom the Software is furnished to do so, subject to 12 the following conditions: 13 14 The above copyright notice and this permission notice shall be included 15 in all copies or substantial portions of the Software. 16 17 18 THE SOFTWARE IS PROVIDED ``AS IS'', WITHOUT WARRANTY OF ANY KIND, 19 EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF 20 MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND 21 NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT 22 HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, 23 WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, 24 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER 25 DEALINGS IN THE SOFTWARE. 26 ----------------------------------------------------------------------- */ 27 28 #define LIBFFI_ASM 29 #include <fficonfig.h> 30 #include <ffi.h> 31 #ifdef HAVE_MACHINE_ASM_H 32 #include <machine/asm.h> 33 #else 34 #ifdef __USER_LABEL_PREFIX__ 35 #define CONCAT1(a, b) CONCAT2(a, b) 36 #define CONCAT2(a, b) a ## b 37 38 /* Use the right prefix for global labels. */ 39 #define CNAME(x) CONCAT1 (__USER_LABEL_PREFIX__, x) 40 #else 41 #define CNAME(x) x 42 #endif 43 #define ENTRY(x) .globl CNAME(x); .type CNAME(x), %function; CNAME(x): 44 #endif 45 46 #ifdef __ELF__ 47 #define LSYM(x) .x 48 #else 49 #define LSYM(x) x 50 #endif 51 52 .macro call_reg x= 53 .text 54 .balign 4 55 mov D1RtP, \x 56 swap D1RtP, PC 57 .endm 58 59 ! Save register arguments 60 .macro SAVE_ARGS 61 .text 62 .balign 4 63 setl [A0StP++], D0Ar6, D1Ar5 64 setl [A0StP++], D0Ar4, D1Ar3 65 setl [A0StP++], D0Ar2, D1Ar1 66 .endm 67 68 ! Save retrun, frame pointer and other regs 69 .macro SAVE_REGS regs= 70 .text 71 .balign 4 72 setl [A0StP++], D0FrT, D1RtP 73 ! Needs to be a pair of regs 74 .ifnc "\regs","" 75 setl [A0StP++], \regs 76 .endif 77 .endm 78 79 ! Declare a global function 80 .macro METAG_FUNC_START name 81 .text 82 .balign 4 83 ENTRY(\name) 84 .endm 85 86 ! Return registers from the stack. Reverse SAVE_REGS operation 87 .macro RET_REGS regs=, cond= 88 .ifnc "\regs", "" 89 getl \regs, [--A0StP] 90 .endif 91 getl D0FrT, D1RtP, [--A0StP] 92 .endm 93 94 ! Return arguments 95 .macro RET_ARGS 96 getl D0Ar2, D1Ar1, [--A0StP] 97 getl D0Ar4, D1Ar3, [--A0StP] 98 getl D0Ar6, D1Ar5, [--A0StP] 99 .endm 100 101 102 ! D1Ar1: fn 103 ! D0Ar2: &ecif 104 ! D1Ar3: cif->bytes 105 ! D0Ar4: fig->flags 106 ! D1Ar5: ecif.rvalue 107 108 ! This assumes we are using GNU as 109 METAG_FUNC_START ffi_call_SYSV 110 ! Save argument registers 111 112 SAVE_ARGS 113 114 ! new frame 115 mov D0FrT, A0FrP 116 add A0FrP, A0StP, #0 117 118 ! Preserve the old frame pointer 119 SAVE_REGS "D1.5, D0.5" 120 121 ! Make room for new args. cifs->bytes is the total space for input 122 ! and return arguments 123 124 add A0StP, A0StP, D1Ar3 125 126 ! Preserve cifs->bytes & fn 127 mov D0.5, D1Ar3 128 mov D1.5, D1Ar1 129 130 ! Place all of the ffi_prep_args in position 131 mov D1Ar1, A0StP 132 133 ! Call ffi_prep_args(stack, &ecif) 134 #ifdef __PIC__ 135 callr D1RtP, CNAME(ffi_prep_args@PLT) 136 #else 137 callr D1RtP, CNAME(ffi_prep_args) 138 #endif 139 140 ! Restore fn pointer 141 142 ! The foreign stack should look like this 143 ! XXXXX XXXXXX <--- stack pointer 144 ! FnArgN rvalue 145 ! FnArgN+2 FnArgN+1 146 ! FnArgN+4 FnArgN+3 147 ! .... 148 ! 149 150 ! A0StP now points to the first (or return) argument + 4 151 152 ! Preserve cif->bytes 153 getl D0Ar2, D1Ar1, [--A0StP] 154 getl D0Ar4, D1Ar3, [--A0StP] 155 getl D0Ar6, D1Ar5, [--A0StP] 156 157 ! Place A0StP to the first argument again 158 add A0StP, A0StP, #24 ! That's because we loaded 6 regs x 4 byte each 159 160 ! A0FrP points to the initial stack without the reserved space for the 161 ! cifs->bytes, whilst A0StP points to the stack after the space allocation 162 163 ! fn was the first argument of ffi_call_SYSV. 164 ! The stack at this point looks like this: 165 ! 166 ! A0StP(on entry to _SYSV) -> Arg6 Arg5 | low 167 ! Arg4 Arg3 | 168 ! Arg2 Arg1 | 169 ! A0FrP ----> D0FrtP D1RtP | 170 ! D1.5 D0.5 | 171 ! A0StP(bf prep_args) -> FnArgn FnArgn-1 | 172 ! FnArgn-2FnArgn-3 | 173 ! ................ | <= cifs->bytes 174 ! FnArg4 FnArg3 | 175 ! A0StP (prv_A0StP+cifs->bytes) FnArg2 FnArg1 | high 176 ! 177 ! fn was in Arg1 so it's located in in A0FrP+#-0xC 178 ! 179 180 ! D0Re0 contains the size of arguments stored in registers 181 sub A0StP, A0StP, D0Re0 182 183 ! Arg1 is the function pointer for the foreign call. This has been 184 ! preserved in D1.5 185 186 ! Time to call (fn). Arguments should be like this: 187 ! Arg1-Arg6 are loaded to regs 188 ! The rest of the arguments are stored in stack pointed by A0StP 189 190 call_reg D1.5 191 192 ! Reset stack. 193 194 mov A0StP, A0FrP 195 196 ! Load Arg1 with the pointer to storage for the return type 197 ! This was stored in Arg5 198 199 getd D1Ar1, [A0FrP+#-20] 200 201 ! Load D0Ar2 with the return type code. This was stored in Arg4 (flags) 202 203 getd D0Ar2, [A0FrP+#-16] 204 205 ! We are ready to start processing the return value 206 ! D0Re0 (and D1Re0) hold the return value 207 208 ! If the return value is NULL, assume no return value 209 cmp D1Ar1, #0 210 beq LSYM(Lepilogue) 211 212 ! return INT 213 cmp D0Ar2, #FFI_TYPE_INT 214 ! Sadly, there is no setd{cc} instruction so we need to workaround that 215 bne .INT64 216 setd [D1Ar1], D0Re0 217 b LSYM(Lepilogue) 218 219 ! return INT64 220 .INT64: 221 cmp D0Ar2, #FFI_TYPE_SINT64 222 setleq [D1Ar1], D0Re0, D1Re0 223 224 ! return DOUBLE 225 cmp D0Ar2, #FFI_TYPE_DOUBLE 226 setl [D1AR1++], D0Re0, D1Re0 227 228 LSYM(Lepilogue): 229 ! At this point, the stack pointer points right after the argument 230 ! saved area. We need to restore 4 regs, therefore we need to move 231 ! 16 bytes ahead. 232 add A0StP, A0StP, #16 233 RET_REGS "D1.5, D0.5" 234 RET_ARGS 235 getd D0Re0, [A0StP] 236 mov A0FrP, D0FrT 237 swap D1RtP, PC 238 239 .ffi_call_SYSV_end: 240 .size CNAME(ffi_call_SYSV),.ffi_call_SYSV_end-CNAME(ffi_call_SYSV) 241 242 243 /* 244 (called by ffi_metag_trampoline) 245 void ffi_closure_SYSV (ffi_closure*) 246 247 (called by ffi_closure_SYSV) 248 unsigned int FFI_HIDDEN 249 ffi_closure_SYSV_inner (closure,respp, args) 250 ffi_closure *closure; 251 void **respp; 252 void *args; 253 */ 254 255 METAG_FUNC_START ffi_closure_SYSV 256 ! We assume that D1Ar1 holds the address of the 257 ! ffi_closure struct. We will use that to fetch the 258 ! arguments. The stack pointer points to an empty space 259 ! and it is ready to store more data. 260 261 ! D1Ar1 is ready 262 ! Allocate stack space for return value 263 add A0StP, A0StP, #8 264 ! Store it to D0Ar2 265 sub D0Ar2, A0StP, #8 266 267 sub D1Ar3, A0FrP, #4 268 269 ! D1Ar3 contains the address of the original D1Ar1 argument 270 ! We need to subtract #4 later on 271 272 ! Preverve D0Ar2 273 mov D0.5, D0Ar2 274 275 #ifdef __PIC__ 276 callr D1RtP, CNAME(ffi_closure_SYSV_inner@PLT) 277 #else 278 callr D1RtP, CNAME(ffi_closure_SYSV_inner) 279 #endif 280 281 ! Check the return value and store it to D0.5 282 cmp D0Re0, #FFI_TYPE_INT 283 beq .Lretint 284 cmp D0Re0, #FFI_TYPE_DOUBLE 285 beq .Lretdouble 286 .Lclosure_epilogue: 287 sub A0StP, A0StP, #8 288 RET_REGS "D1.5, D0.5" 289 RET_ARGS 290 swap D1RtP, PC 291 292 .Lretint: 293 setd [D0.5], D0Re0 294 b .Lclosure_epilogue 295 .Lretdouble: 296 setl [D0.5++], D0Re0, D1Re0 297 b .Lclosure_epilogue 298 .ffi_closure_SYSV_end: 299 .size CNAME(ffi_closure_SYSV),.ffi_closure_SYSV_end-CNAME(ffi_closure_SYSV) 300 301 302 ENTRY(ffi_metag_trampoline) 303 SAVE_ARGS 304 ! New frame 305 mov A0FrP, A0StP 306 SAVE_REGS "D1.5, D0.5" 307 mov D0.5, PC 308 ! Load D1Ar1 the value of ffi_metag_trampoline 309 getd D1Ar1, [D0.5 + #8] 310 ! Jump to ffi_closure_SYSV 311 getd PC, [D0.5 + #12] 312
