1 /* -----------------------------------------------------------------------
2 ffi.c - Copyright (c) 2003, 2004, 2006, 2007, 2012 Kaz Kojima
3 Copyright (c) 2008 Anthony Green
4
5 SuperH SHmedia Foreign Function Interface
6
7 Permission is hereby granted, free of charge, to any person obtaining
8 a copy of this software and associated documentation files (the
9 ``Software''), to deal in the Software without restriction, including
10 without limitation the rights to use, copy, modify, merge, publish,
11 distribute, sublicense, and/or sell copies of the Software, and to
12 permit persons to whom the Software is furnished to do so, subject to
13 the following conditions:
14
15 The above copyright notice and this permission notice shall be included
16 in all copies or substantial portions of the Software.
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 #include <ffi.h>
29 #include <ffi_common.h>
30
31 #include <stdlib.h>
32
33 #define NGREGARG 8
34 #define NFREGARG 12
35
36 static int
37 return_type (ffi_type *arg)
38 {
39
40 if (arg->type != FFI_TYPE_STRUCT)
41 return arg->type;
42
43 /* gcc uses r2 if the result can be packed in on register. */
44 if (arg->size <= sizeof (UINT8))
45 return FFI_TYPE_UINT8;
46 else if (arg->size <= sizeof (UINT16))
47 return FFI_TYPE_UINT16;
48 else if (arg->size <= sizeof (UINT32))
49 return FFI_TYPE_UINT32;
50 else if (arg->size <= sizeof (UINT64))
51 return FFI_TYPE_UINT64;
52
53 return FFI_TYPE_STRUCT;
54 }
55
56 /* ffi_prep_args is called by the assembly routine once stack space
57 has been allocated for the function's arguments */
58
59 void ffi_prep_args(char *stack, extended_cif *ecif)
60 {
61 register unsigned int i;
62 register unsigned int avn;
63 register void **p_argv;
64 register char *argp;
65 register ffi_type **p_arg;
66
67 argp = stack;
68
69 if (return_type (ecif->cif->rtype) == FFI_TYPE_STRUCT)
70 {
71 *(void **) argp = ecif->rvalue;
72 argp += sizeof (UINT64);
73 }
74
75 avn = ecif->cif->nargs;
76 p_argv = ecif->avalue;
77
78 for (i = 0, p_arg = ecif->cif->arg_types; i < avn; i++, p_arg++, p_argv++)
79 {
80 size_t z;
81 int align;
82
83 z = (*p_arg)->size;
84 align = (*p_arg)->alignment;
85 if (z < sizeof (UINT32))
86 {
87 switch ((*p_arg)->type)
88 {
89 case FFI_TYPE_SINT8:
90 *(SINT64 *) argp = (SINT64) *(SINT8 *)(*p_argv);
91 break;
92
93 case FFI_TYPE_UINT8:
94 *(UINT64 *) argp = (UINT64) *(UINT8 *)(*p_argv);
95 break;
96
97 case FFI_TYPE_SINT16:
98 *(SINT64 *) argp = (SINT64) *(SINT16 *)(*p_argv);
99 break;
100
101 case FFI_TYPE_UINT16:
102 *(UINT64 *) argp = (UINT64) *(UINT16 *)(*p_argv);
103 break;
104
105 case FFI_TYPE_STRUCT:
106 memcpy (argp, *p_argv, z);
107 break;
108
109 default:
110 FFI_ASSERT(0);
111 }
112 argp += sizeof (UINT64);
113 }
114 else if (z == sizeof (UINT32) && align == sizeof (UINT32))
115 {
116 switch ((*p_arg)->type)
117 {
118 case FFI_TYPE_INT:
119 case FFI_TYPE_SINT32:
120 *(SINT64 *) argp = (SINT64) *(SINT32 *) (*p_argv);
121 break;
122
123 case FFI_TYPE_FLOAT:
124 case FFI_TYPE_POINTER:
125 case FFI_TYPE_UINT32:
126 case FFI_TYPE_STRUCT:
127 *(UINT64 *) argp = (UINT64) *(UINT32 *) (*p_argv);
128 break;
129
130 default:
131 FFI_ASSERT(0);
132 break;
133 }
134 argp += sizeof (UINT64);
135 }
136 else if (z == sizeof (UINT64)
137 && align == sizeof (UINT64)
138 && ((int) *p_argv & (sizeof (UINT64) - 1)) == 0)
139 {
140 *(UINT64 *) argp = *(UINT64 *) (*p_argv);
141 argp += sizeof (UINT64);
142 }
143 else
144 {
145 int n = (z + sizeof (UINT64) - 1) / sizeof (UINT64);
146
147 memcpy (argp, *p_argv, z);
148 argp += n * sizeof (UINT64);
149 }
150 }
151
152 return;
153 }
154
155 /* Perform machine dependent cif processing */
156 ffi_status ffi_prep_cif_machdep(ffi_cif *cif)
157 {
158 int i, j;
159 int size, type;
160 int n, m;
161 int greg;
162 int freg;
163 int fpair = -1;
164
165 greg = (return_type (cif->rtype) == FFI_TYPE_STRUCT ? 1 : 0);
166 freg = 0;
167 cif->flags2 = 0;
168
169 for (i = j = 0; i < cif->nargs; i++)
170 {
171 type = (cif->arg_types)[i]->type;
172 switch (type)
173 {
174 case FFI_TYPE_FLOAT:
175 greg++;
176 cif->bytes += sizeof (UINT64) - sizeof (float);
177 if (freg >= NFREGARG - 1)
178 continue;
179 if (fpair < 0)
180 {
181 fpair = freg;
182 freg += 2;
183 }
184 else
185 fpair = -1;
186 cif->flags2 += ((cif->arg_types)[i]->type) << (2 * j++);
187 break;
188
189 case FFI_TYPE_DOUBLE:
190 if (greg++ >= NGREGARG && (freg + 1) >= NFREGARG)
191 continue;
192 if ((freg + 1) < NFREGARG)
193 {
194 freg += 2;
195 cif->flags2 += ((cif->arg_types)[i]->type) << (2 * j++);
196 }
197 else
198 cif->flags2 += FFI_TYPE_INT << (2 * j++);
199 break;
200
201 default:
202 size = (cif->arg_types)[i]->size;
203 if (size < sizeof (UINT64))
204 cif->bytes += sizeof (UINT64) - size;
205 n = (size + sizeof (UINT64) - 1) / sizeof (UINT64);
206 if (greg >= NGREGARG)
207 continue;
208 else if (greg + n - 1 >= NGREGARG)
209 greg = NGREGARG;
210 else
211 greg += n;
212 for (m = 0; m < n; m++)
213 cif->flags2 += FFI_TYPE_INT << (2 * j++);
214 break;
215 }
216 }
217
218 /* Set the return type flag */
219 switch (cif->rtype->type)
220 {
221 case FFI_TYPE_STRUCT:
222 cif->flags = return_type (cif->rtype);
223 break;
224
225 case FFI_TYPE_VOID:
226 case FFI_TYPE_FLOAT:
227 case FFI_TYPE_DOUBLE:
228 case FFI_TYPE_SINT64:
229 case FFI_TYPE_UINT64:
230 cif->flags = cif->rtype->type;
231 break;
232
233 default:
234 cif->flags = FFI_TYPE_INT;
235 break;
236 }
237
238 return FFI_OK;
239 }
240
241 /*@-declundef@*/
242 /*@-exportheader@*/
243 extern void ffi_call_SYSV(void (*)(char *, extended_cif *),
244 /*@out@*/ extended_cif *,
245 unsigned, unsigned, long long,
246 /*@out@*/ unsigned *,
247 void (*fn)(void));
248 /*@=declundef@*/
249 /*@=exportheader@*/
250
251 void ffi_call(/*@dependent@*/ ffi_cif *cif,
252 void (*fn)(void),
253 /*@out@*/ void *rvalue,
254 /*@dependent@*/ void **avalue)
255 {
256 extended_cif ecif;
257 UINT64 trvalue;
258
259 ecif.cif = cif;
260 ecif.avalue = avalue;
261
262 /* If the return value is a struct and we don't have a return */
263 /* value address then we need to make one */
264
265 if (cif->rtype->type == FFI_TYPE_STRUCT
266 && return_type (cif->rtype) != FFI_TYPE_STRUCT)
267 ecif.rvalue = &trvalue;
268 else if ((rvalue == NULL) &&
269 (cif->rtype->type == FFI_TYPE_STRUCT))
270 {
271 ecif.rvalue = alloca(cif->rtype->size);
272 }
273 else
274 ecif.rvalue = rvalue;
275
276 switch (cif->abi)
277 {
278 case FFI_SYSV:
279 ffi_call_SYSV(ffi_prep_args, &ecif, cif->bytes, cif->flags, cif->flags2,
280 ecif.rvalue, fn);
281 break;
282 default:
283 FFI_ASSERT(0);
284 break;
285 }
286
287 if (rvalue
288 && cif->rtype->type == FFI_TYPE_STRUCT
289 && return_type (cif->rtype) != FFI_TYPE_STRUCT)
290 memcpy (rvalue, &trvalue, cif->rtype->size);
291 }
292
293 extern void ffi_closure_SYSV (void);
294 extern void __ic_invalidate (void *line);
295
296 ffi_status
297 ffi_prep_closure_loc (ffi_closure *closure,
298 ffi_cif *cif,
299 void (*fun)(ffi_cif*, void*, void**, void*),
300 void *user_data,
301 void *codeloc)
302 {
303 unsigned int *tramp;
304
305 if (cif->abi != FFI_SYSV)
306 return FFI_BAD_ABI;
307
308 tramp = (unsigned int *) &closure->tramp[0];
309 /* Since ffi_closure is an aligned object, the ffi trampoline is
310 called as an SHcompact code. Sigh.
311 SHcompact part:
312 mova @(1,pc),r0; add #1,r0; jmp @r0; nop;
313 SHmedia part:
314 movi fnaddr >> 16,r1; shori fnaddr,r1; ptabs/l r1,tr0
315 movi cxt >> 16,r1; shori cxt,r1; blink tr0,r63 */
316 #ifdef __LITTLE_ENDIAN__
317 tramp[0] = 0x7001c701;
318 tramp[1] = 0x0009402b;
319 #else
320 tramp[0] = 0xc7017001;
321 tramp[1] = 0x402b0009;
322 #endif
323 tramp[2] = 0xcc000010 | (((UINT32) ffi_closure_SYSV) >> 16) << 10;
324 tramp[3] = 0xc8000010 | (((UINT32) ffi_closure_SYSV) & 0xffff) << 10;
325 tramp[4] = 0x6bf10600;
326 tramp[5] = 0xcc000010 | (((UINT32) codeloc) >> 16) << 10;
327 tramp[6] = 0xc8000010 | (((UINT32) codeloc) & 0xffff) << 10;
328 tramp[7] = 0x4401fff0;
329
330 closure->cif = cif;
331 closure->fun = fun;
332 closure->user_data = user_data;
333
334 /* Flush the icache. */
335 asm volatile ("ocbwb %0,0; synco; icbi %1,0; synci" : : "r" (tramp),
336 "r"(codeloc));
337
338 return FFI_OK;
339 }
340
341 /* Basically the trampoline invokes ffi_closure_SYSV, and on
342 * entry, r3 holds the address of the closure.
343 * After storing the registers that could possibly contain
344 * parameters to be passed into the stack frame and setting
345 * up space for a return value, ffi_closure_SYSV invokes the
346 * following helper function to do most of the work.
347 */
348
349 int
350 ffi_closure_helper_SYSV (ffi_closure *closure, UINT64 *rvalue,
351 UINT64 *pgr, UINT64 *pfr, UINT64 *pst)
352 {
353 void **avalue;
354 ffi_type **p_arg;
355 int i, avn;
356 int greg, freg;
357 ffi_cif *cif;
358 int fpair = -1;
359
360 cif = closure->cif;
361 avalue = alloca (cif->nargs * sizeof (void *));
362
363 /* Copy the caller's structure return value address so that the closure
364 returns the data directly to the caller. */
365 if (return_type (cif->rtype) == FFI_TYPE_STRUCT)
366 {
367 rvalue = (UINT64 *) *pgr;
368 greg = 1;
369 }
370 else
371 greg = 0;
372
373 freg = 0;
374 cif = closure->cif;
375 avn = cif->nargs;
376
377 /* Grab the addresses of the arguments from the stack frame. */
378 for (i = 0, p_arg = cif->arg_types; i < avn; i++, p_arg++)
379 {
380 size_t z;
381 void *p;
382
383 z = (*p_arg)->size;
384 if (z < sizeof (UINT32))
385 {
386 p = pgr + greg++;
387
388 switch ((*p_arg)->type)
389 {
390 case FFI_TYPE_SINT8:
391 case FFI_TYPE_UINT8:
392 case FFI_TYPE_SINT16:
393 case FFI_TYPE_UINT16:
394 case FFI_TYPE_STRUCT:
395 #ifdef __LITTLE_ENDIAN__
396 avalue[i] = p;
397 #else
398 avalue[i] = ((char *) p) + sizeof (UINT32) - z;
399 #endif
400 break;
401
402 default:
403 FFI_ASSERT(0);
404 }
405 }
406 else if (z == sizeof (UINT32))
407 {
408 if ((*p_arg)->type == FFI_TYPE_FLOAT)
409 {
410 if (freg < NFREGARG - 1)
411 {
412 if (fpair >= 0)
413 {
414 avalue[i] = (UINT32 *) pfr + fpair;
415 fpair = -1;
416 }
417 else
418 {
419 #ifdef __LITTLE_ENDIAN__
420 fpair = freg;
421 avalue[i] = (UINT32 *) pfr + (1 ^ freg);
422 #else
423 fpair = 1 ^ freg;
424 avalue[i] = (UINT32 *) pfr + freg;
425 #endif
426 freg += 2;
427 }
428 }
429 else
430 #ifdef __LITTLE_ENDIAN__
431 avalue[i] = pgr + greg;
432 #else
433 avalue[i] = (UINT32 *) (pgr + greg) + 1;
434 #endif
435 }
436 else
437 #ifdef __LITTLE_ENDIAN__
438 avalue[i] = pgr + greg;
439 #else
440 avalue[i] = (UINT32 *) (pgr + greg) + 1;
441 #endif
442 greg++;
443 }
444 else if ((*p_arg)->type == FFI_TYPE_DOUBLE)
445 {
446 if (freg + 1 >= NFREGARG)
447 avalue[i] = pgr + greg;
448 else
449 {
450 avalue[i] = pfr + (freg >> 1);
451 freg += 2;
452 }
453 greg++;
454 }
455 else
456 {
457 int n = (z + sizeof (UINT64) - 1) / sizeof (UINT64);
458
459 avalue[i] = pgr + greg;
460 greg += n;
461 }
462 }
463
464 (closure->fun) (cif, rvalue, avalue, closure->user_data);
465
466 /* Tell ffi_closure_SYSV how to perform return type promotions. */
467 return return_type (cif->rtype);
468 }
469