1 | n/a | /* ----------------------------------------------------------------------- |
---|
2 | n/a | ffi.c - Copyright (c) 2011 Anthony Green |
---|
3 | n/a | Copyright (c) 2009 Bradley Smith <brad@brad-smith.co.uk> |
---|
4 | n/a | |
---|
5 | n/a | AVR32 Foreign Function Interface |
---|
6 | n/a | |
---|
7 | n/a | Permission is hereby granted, free of charge, to any person obtaining |
---|
8 | n/a | a copy of this software and associated documentation files (the |
---|
9 | n/a | ``Software''), to deal in the Software without restriction, including |
---|
10 | n/a | without limitation the rights to use, copy, modify, merge, publish, |
---|
11 | n/a | distribute, sublicense, and/or sell copies of the Software, and to |
---|
12 | n/a | permit persons to whom the Software is furnished to do so, subject to |
---|
13 | n/a | the following conditions: |
---|
14 | n/a | |
---|
15 | n/a | The above copyright notice and this permission notice shall be included |
---|
16 | n/a | in all copies or substantial portions of the Software. |
---|
17 | n/a | |
---|
18 | n/a | THE SOFTWARE IS PROVIDED ``AS IS'', WITHOUT WARRANTY OF ANY KIND, |
---|
19 | n/a | EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF |
---|
20 | n/a | MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND |
---|
21 | n/a | NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT |
---|
22 | n/a | HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, |
---|
23 | n/a | WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
---|
24 | n/a | OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER |
---|
25 | n/a | DEALINGS IN THE SOFTWARE. |
---|
26 | n/a | ----------------------------------------------------------------------- */ |
---|
27 | n/a | |
---|
28 | n/a | #include <ffi.h> |
---|
29 | n/a | #include <ffi_common.h> |
---|
30 | n/a | |
---|
31 | n/a | #include <stdlib.h> |
---|
32 | n/a | #include <stdio.h> |
---|
33 | n/a | #include <unistd.h> |
---|
34 | n/a | #include <asm/unistd.h> |
---|
35 | n/a | |
---|
36 | n/a | /* #define DEBUG */ |
---|
37 | n/a | |
---|
38 | n/a | extern void ffi_call_SYSV(void (*)(char *, extended_cif *), extended_cif *, |
---|
39 | n/a | unsigned int, unsigned int, unsigned int*, unsigned int, |
---|
40 | n/a | void (*fn)(void)); |
---|
41 | n/a | extern void ffi_closure_SYSV (ffi_closure *); |
---|
42 | n/a | |
---|
43 | n/a | unsigned int pass_struct_on_stack(ffi_type *type) |
---|
44 | n/a | { |
---|
45 | n/a | if(type->type != FFI_TYPE_STRUCT) |
---|
46 | n/a | return 0; |
---|
47 | n/a | |
---|
48 | n/a | if(type->alignment < type->size && |
---|
49 | n/a | !(type->size == 4 || type->size == 8) && |
---|
50 | n/a | !(type->size == 8 && type->alignment >= 4)) |
---|
51 | n/a | return 1; |
---|
52 | n/a | |
---|
53 | n/a | if(type->size == 3 || type->size == 5 || type->size == 6 || |
---|
54 | n/a | type->size == 7) |
---|
55 | n/a | return 1; |
---|
56 | n/a | |
---|
57 | n/a | return 0; |
---|
58 | n/a | } |
---|
59 | n/a | |
---|
60 | n/a | /* ffi_prep_args is called by the assembly routine once stack space |
---|
61 | n/a | * has been allocated for the function's arguments |
---|
62 | n/a | * |
---|
63 | n/a | * This is annoyingly complex since we need to keep track of used |
---|
64 | n/a | * registers. |
---|
65 | n/a | */ |
---|
66 | n/a | |
---|
67 | n/a | void ffi_prep_args(char *stack, extended_cif *ecif) |
---|
68 | n/a | { |
---|
69 | n/a | unsigned int i; |
---|
70 | n/a | void **p_argv; |
---|
71 | n/a | ffi_type **p_arg; |
---|
72 | n/a | char *reg_base = stack; |
---|
73 | n/a | char *stack_base = stack + 20; |
---|
74 | n/a | unsigned int stack_offset = 0; |
---|
75 | n/a | unsigned int reg_mask = 0; |
---|
76 | n/a | |
---|
77 | n/a | p_argv = ecif->avalue; |
---|
78 | n/a | |
---|
79 | n/a | /* If cif->flags is struct then we know it's not passed in registers */ |
---|
80 | n/a | if(ecif->cif->flags == FFI_TYPE_STRUCT) |
---|
81 | n/a | { |
---|
82 | n/a | *(void**)reg_base = ecif->rvalue; |
---|
83 | n/a | reg_mask |= 1; |
---|
84 | n/a | } |
---|
85 | n/a | |
---|
86 | n/a | for(i = 0, p_arg = ecif->cif->arg_types; i < ecif->cif->nargs; |
---|
87 | n/a | i++, p_arg++) |
---|
88 | n/a | { |
---|
89 | n/a | size_t z = (*p_arg)->size; |
---|
90 | n/a | int alignment = (*p_arg)->alignment; |
---|
91 | n/a | int type = (*p_arg)->type; |
---|
92 | n/a | char *addr = 0; |
---|
93 | n/a | |
---|
94 | n/a | if(z % 4 != 0) |
---|
95 | n/a | z += (4 - z % 4); |
---|
96 | n/a | |
---|
97 | n/a | if(reg_mask != 0x1f) |
---|
98 | n/a | { |
---|
99 | n/a | if(pass_struct_on_stack(*p_arg)) |
---|
100 | n/a | { |
---|
101 | n/a | addr = stack_base + stack_offset; |
---|
102 | n/a | stack_offset += z; |
---|
103 | n/a | } |
---|
104 | n/a | else if(z == sizeof(int)) |
---|
105 | n/a | { |
---|
106 | n/a | char index = 0; |
---|
107 | n/a | |
---|
108 | n/a | while((reg_mask >> index) & 1) |
---|
109 | n/a | index++; |
---|
110 | n/a | |
---|
111 | n/a | addr = reg_base + (index * 4); |
---|
112 | n/a | reg_mask |= (1 << index); |
---|
113 | n/a | } |
---|
114 | n/a | else if(z == 2 * sizeof(int)) |
---|
115 | n/a | { |
---|
116 | n/a | if(!((reg_mask >> 1) & 1)) |
---|
117 | n/a | { |
---|
118 | n/a | addr = reg_base + 4; |
---|
119 | n/a | reg_mask |= (3 << 1); |
---|
120 | n/a | } |
---|
121 | n/a | else if(!((reg_mask >> 3) & 1)) |
---|
122 | n/a | { |
---|
123 | n/a | addr = reg_base + 12; |
---|
124 | n/a | reg_mask |= (3 << 3); |
---|
125 | n/a | } |
---|
126 | n/a | } |
---|
127 | n/a | } |
---|
128 | n/a | |
---|
129 | n/a | if(!addr) |
---|
130 | n/a | { |
---|
131 | n/a | addr = stack_base + stack_offset; |
---|
132 | n/a | stack_offset += z; |
---|
133 | n/a | } |
---|
134 | n/a | |
---|
135 | n/a | if(type == FFI_TYPE_STRUCT && (*p_arg)->elements[1] == NULL) |
---|
136 | n/a | type = (*p_arg)->elements[0]->type; |
---|
137 | n/a | |
---|
138 | n/a | switch(type) |
---|
139 | n/a | { |
---|
140 | n/a | case FFI_TYPE_UINT8: |
---|
141 | n/a | *(unsigned int *)addr = (unsigned int)*(UINT8 *)(*p_argv); |
---|
142 | n/a | break; |
---|
143 | n/a | case FFI_TYPE_SINT8: |
---|
144 | n/a | *(signed int *)addr = (signed int)*(SINT8 *)(*p_argv); |
---|
145 | n/a | break; |
---|
146 | n/a | case FFI_TYPE_UINT16: |
---|
147 | n/a | *(unsigned int *)addr = (unsigned int)*(UINT16 *)(*p_argv); |
---|
148 | n/a | break; |
---|
149 | n/a | case FFI_TYPE_SINT16: |
---|
150 | n/a | *(signed int *)addr = (signed int)*(SINT16 *)(*p_argv); |
---|
151 | n/a | break; |
---|
152 | n/a | default: |
---|
153 | n/a | memcpy(addr, *p_argv, z); |
---|
154 | n/a | } |
---|
155 | n/a | |
---|
156 | n/a | p_argv++; |
---|
157 | n/a | } |
---|
158 | n/a | |
---|
159 | n/a | #ifdef DEBUG |
---|
160 | n/a | /* Debugging */ |
---|
161 | n/a | for(i = 0; i < 5; i++) |
---|
162 | n/a | { |
---|
163 | n/a | if((reg_mask & (1 << i)) == 0) |
---|
164 | n/a | printf("r%d: (unused)\n", 12 - i); |
---|
165 | n/a | else |
---|
166 | n/a | printf("r%d: 0x%08x\n", 12 - i, ((unsigned int*)reg_base)[i]); |
---|
167 | n/a | } |
---|
168 | n/a | |
---|
169 | n/a | for(i = 0; i < stack_offset / 4; i++) |
---|
170 | n/a | { |
---|
171 | n/a | printf("sp+%d: 0x%08x\n", i*4, ((unsigned int*)stack_base)[i]); |
---|
172 | n/a | } |
---|
173 | n/a | #endif |
---|
174 | n/a | } |
---|
175 | n/a | |
---|
176 | n/a | /* Perform machine dependent cif processing */ |
---|
177 | n/a | ffi_status ffi_prep_cif_machdep(ffi_cif *cif) |
---|
178 | n/a | { |
---|
179 | n/a | /* Round the stack up to a multiple of 8 bytes. This isn't needed |
---|
180 | n/a | * everywhere, but it is on some platforms, and it doesn't harm |
---|
181 | n/a | * anything when it isn't needed. */ |
---|
182 | n/a | cif->bytes = (cif->bytes + 7) & ~7; |
---|
183 | n/a | |
---|
184 | n/a | /* Flag to indicate that he return value is in fact a struct */ |
---|
185 | n/a | cif->rstruct_flag = 0; |
---|
186 | n/a | |
---|
187 | n/a | /* Set the return type flag */ |
---|
188 | n/a | switch(cif->rtype->type) |
---|
189 | n/a | { |
---|
190 | n/a | case FFI_TYPE_SINT8: |
---|
191 | n/a | case FFI_TYPE_UINT8: |
---|
192 | n/a | cif->flags = (unsigned)FFI_TYPE_UINT8; |
---|
193 | n/a | break; |
---|
194 | n/a | case FFI_TYPE_SINT16: |
---|
195 | n/a | case FFI_TYPE_UINT16: |
---|
196 | n/a | cif->flags = (unsigned)FFI_TYPE_UINT16; |
---|
197 | n/a | break; |
---|
198 | n/a | case FFI_TYPE_FLOAT: |
---|
199 | n/a | case FFI_TYPE_SINT32: |
---|
200 | n/a | case FFI_TYPE_UINT32: |
---|
201 | n/a | case FFI_TYPE_POINTER: |
---|
202 | n/a | cif->flags = (unsigned)FFI_TYPE_UINT32; |
---|
203 | n/a | break; |
---|
204 | n/a | case FFI_TYPE_DOUBLE: |
---|
205 | n/a | case FFI_TYPE_SINT64: |
---|
206 | n/a | case FFI_TYPE_UINT64: |
---|
207 | n/a | cif->flags = (unsigned)FFI_TYPE_UINT64; |
---|
208 | n/a | break; |
---|
209 | n/a | case FFI_TYPE_STRUCT: |
---|
210 | n/a | cif->rstruct_flag = 1; |
---|
211 | n/a | if(!pass_struct_on_stack(cif->rtype)) |
---|
212 | n/a | { |
---|
213 | n/a | if(cif->rtype->size <= 1) |
---|
214 | n/a | cif->flags = (unsigned)FFI_TYPE_UINT8; |
---|
215 | n/a | else if(cif->rtype->size <= 2) |
---|
216 | n/a | cif->flags = (unsigned)FFI_TYPE_UINT16; |
---|
217 | n/a | else if(cif->rtype->size <= 4) |
---|
218 | n/a | cif->flags = (unsigned)FFI_TYPE_UINT32; |
---|
219 | n/a | else if(cif->rtype->size <= 8) |
---|
220 | n/a | cif->flags = (unsigned)FFI_TYPE_UINT64; |
---|
221 | n/a | else |
---|
222 | n/a | cif->flags = (unsigned)cif->rtype->type; |
---|
223 | n/a | } |
---|
224 | n/a | else |
---|
225 | n/a | cif->flags = (unsigned)cif->rtype->type; |
---|
226 | n/a | break; |
---|
227 | n/a | default: |
---|
228 | n/a | cif->flags = (unsigned)cif->rtype->type; |
---|
229 | n/a | break; |
---|
230 | n/a | } |
---|
231 | n/a | |
---|
232 | n/a | return FFI_OK; |
---|
233 | n/a | } |
---|
234 | n/a | |
---|
235 | n/a | void ffi_call(ffi_cif *cif, void (*fn)(void), void *rvalue, void **avalue) |
---|
236 | n/a | { |
---|
237 | n/a | extended_cif ecif; |
---|
238 | n/a | |
---|
239 | n/a | unsigned int size = 0, i = 0; |
---|
240 | n/a | ffi_type **p_arg; |
---|
241 | n/a | |
---|
242 | n/a | ecif.cif = cif; |
---|
243 | n/a | ecif.avalue = avalue; |
---|
244 | n/a | |
---|
245 | n/a | for(i = 0, p_arg = cif->arg_types; i < cif->nargs; i++, p_arg++) |
---|
246 | n/a | size += (*p_arg)->size + (4 - (*p_arg)->size % 4); |
---|
247 | n/a | |
---|
248 | n/a | /* If the return value is a struct and we don't have a return value |
---|
249 | n/a | * address then we need to make one */ |
---|
250 | n/a | |
---|
251 | n/a | /* If cif->flags is struct then it's not suitable for registers */ |
---|
252 | n/a | if((rvalue == NULL) && (cif->flags == FFI_TYPE_STRUCT)) |
---|
253 | n/a | ecif.rvalue = alloca(cif->rtype->size); |
---|
254 | n/a | else |
---|
255 | n/a | ecif.rvalue = rvalue; |
---|
256 | n/a | |
---|
257 | n/a | switch(cif->abi) |
---|
258 | n/a | { |
---|
259 | n/a | case FFI_SYSV: |
---|
260 | n/a | ffi_call_SYSV(ffi_prep_args, &ecif, size, cif->flags, |
---|
261 | n/a | ecif.rvalue, cif->rstruct_flag, fn); |
---|
262 | n/a | break; |
---|
263 | n/a | default: |
---|
264 | n/a | FFI_ASSERT(0); |
---|
265 | n/a | break; |
---|
266 | n/a | } |
---|
267 | n/a | } |
---|
268 | n/a | |
---|
269 | n/a | static void ffi_prep_incoming_args_SYSV(char *stack, void **rvalue, |
---|
270 | n/a | void **avalue, ffi_cif *cif) |
---|
271 | n/a | { |
---|
272 | n/a | register unsigned int i, reg_mask = 0; |
---|
273 | n/a | register void **p_argv; |
---|
274 | n/a | register ffi_type **p_arg; |
---|
275 | n/a | register char *reg_base = stack; |
---|
276 | n/a | register char *stack_base = stack + 20; |
---|
277 | n/a | register unsigned int stack_offset = 0; |
---|
278 | n/a | |
---|
279 | n/a | #ifdef DEBUG |
---|
280 | n/a | /* Debugging */ |
---|
281 | n/a | for(i = 0; i < cif->nargs + 7; i++) |
---|
282 | n/a | { |
---|
283 | n/a | printf("sp+%d: 0x%08x\n", i*4, ((unsigned int*)stack)[i]); |
---|
284 | n/a | } |
---|
285 | n/a | #endif |
---|
286 | n/a | |
---|
287 | n/a | /* If cif->flags is struct then we know it's not passed in registers */ |
---|
288 | n/a | if(cif->flags == FFI_TYPE_STRUCT) |
---|
289 | n/a | { |
---|
290 | n/a | *rvalue = *(void **)reg_base; |
---|
291 | n/a | reg_mask |= 1; |
---|
292 | n/a | } |
---|
293 | n/a | |
---|
294 | n/a | p_argv = avalue; |
---|
295 | n/a | |
---|
296 | n/a | for(i = 0, p_arg = cif->arg_types; i < cif->nargs; i++, p_arg++) |
---|
297 | n/a | { |
---|
298 | n/a | size_t z = (*p_arg)->size; |
---|
299 | n/a | int alignment = (*p_arg)->alignment; |
---|
300 | n/a | |
---|
301 | n/a | *p_argv = 0; |
---|
302 | n/a | |
---|
303 | n/a | if(z % 4 != 0) |
---|
304 | n/a | z += (4 - z % 4); |
---|
305 | n/a | |
---|
306 | n/a | if(reg_mask != 0x1f) |
---|
307 | n/a | { |
---|
308 | n/a | if(pass_struct_on_stack(*p_arg)) |
---|
309 | n/a | { |
---|
310 | n/a | *p_argv = (void*)stack_base + stack_offset; |
---|
311 | n/a | stack_offset += z; |
---|
312 | n/a | } |
---|
313 | n/a | else if(z <= sizeof(int)) |
---|
314 | n/a | { |
---|
315 | n/a | char index = 0; |
---|
316 | n/a | |
---|
317 | n/a | while((reg_mask >> index) & 1) |
---|
318 | n/a | index++; |
---|
319 | n/a | |
---|
320 | n/a | *p_argv = (void*)reg_base + (index * 4); |
---|
321 | n/a | reg_mask |= (1 << index); |
---|
322 | n/a | } |
---|
323 | n/a | else if(z == 2 * sizeof(int)) |
---|
324 | n/a | { |
---|
325 | n/a | if(!((reg_mask >> 1) & 1)) |
---|
326 | n/a | { |
---|
327 | n/a | *p_argv = (void*)reg_base + 4; |
---|
328 | n/a | reg_mask |= (3 << 1); |
---|
329 | n/a | } |
---|
330 | n/a | else if(!((reg_mask >> 3) & 1)) |
---|
331 | n/a | { |
---|
332 | n/a | *p_argv = (void*)reg_base + 12; |
---|
333 | n/a | reg_mask |= (3 << 3); |
---|
334 | n/a | } |
---|
335 | n/a | } |
---|
336 | n/a | } |
---|
337 | n/a | |
---|
338 | n/a | if(!*p_argv) |
---|
339 | n/a | { |
---|
340 | n/a | *p_argv = (void*)stack_base + stack_offset; |
---|
341 | n/a | stack_offset += z; |
---|
342 | n/a | } |
---|
343 | n/a | |
---|
344 | n/a | if((*p_arg)->type != FFI_TYPE_STRUCT || |
---|
345 | n/a | (*p_arg)->elements[1] == NULL) |
---|
346 | n/a | { |
---|
347 | n/a | if(alignment == 1) |
---|
348 | n/a | **(unsigned int**)p_argv <<= 24; |
---|
349 | n/a | else if(alignment == 2) |
---|
350 | n/a | **(unsigned int**)p_argv <<= 16; |
---|
351 | n/a | } |
---|
352 | n/a | |
---|
353 | n/a | p_argv++; |
---|
354 | n/a | } |
---|
355 | n/a | |
---|
356 | n/a | #ifdef DEBUG |
---|
357 | n/a | /* Debugging */ |
---|
358 | n/a | for(i = 0; i < cif->nargs; i++) |
---|
359 | n/a | { |
---|
360 | n/a | printf("sp+%d: 0x%08x\n", i*4, *(((unsigned int**)avalue)[i])); |
---|
361 | n/a | } |
---|
362 | n/a | #endif |
---|
363 | n/a | } |
---|
364 | n/a | |
---|
365 | n/a | /* This function is jumped to by the trampoline */ |
---|
366 | n/a | |
---|
367 | n/a | unsigned int ffi_closure_SYSV_inner(ffi_closure *closure, void **respp, |
---|
368 | n/a | void *args) |
---|
369 | n/a | { |
---|
370 | n/a | ffi_cif *cif; |
---|
371 | n/a | void **arg_area; |
---|
372 | n/a | unsigned int i, size = 0; |
---|
373 | n/a | ffi_type **p_arg; |
---|
374 | n/a | |
---|
375 | n/a | cif = closure->cif; |
---|
376 | n/a | |
---|
377 | n/a | for(i = 0, p_arg = cif->arg_types; i < cif->nargs; i++, p_arg++) |
---|
378 | n/a | size += (*p_arg)->size + (4 - (*p_arg)->size % 4); |
---|
379 | n/a | |
---|
380 | n/a | arg_area = (void **)alloca(size); |
---|
381 | n/a | |
---|
382 | n/a | /* this call will initialize ARG_AREA, such that each element in that |
---|
383 | n/a | * array points to the corresponding value on the stack; and if the |
---|
384 | n/a | * function returns a structure, it will re-set RESP to point to the |
---|
385 | n/a | * structure return address. */ |
---|
386 | n/a | |
---|
387 | n/a | ffi_prep_incoming_args_SYSV(args, respp, arg_area, cif); |
---|
388 | n/a | |
---|
389 | n/a | (closure->fun)(cif, *respp, arg_area, closure->user_data); |
---|
390 | n/a | |
---|
391 | n/a | return cif->flags; |
---|
392 | n/a | } |
---|
393 | n/a | |
---|
394 | n/a | ffi_status ffi_prep_closure_loc(ffi_closure* closure, ffi_cif* cif, |
---|
395 | n/a | void (*fun)(ffi_cif*, void*, void**, void*), void *user_data, |
---|
396 | n/a | void *codeloc) |
---|
397 | n/a | { |
---|
398 | n/a | if (cif->abi != FFI_SYSV) |
---|
399 | n/a | return FFI_BAD_ABI; |
---|
400 | n/a | |
---|
401 | n/a | unsigned char *__tramp = (unsigned char*)(&closure->tramp[0]); |
---|
402 | n/a | unsigned int __fun = (unsigned int)(&ffi_closure_SYSV); |
---|
403 | n/a | unsigned int __ctx = (unsigned int)(codeloc); |
---|
404 | n/a | unsigned int __rstruct_flag = (unsigned int)(cif->rstruct_flag); |
---|
405 | n/a | unsigned int __inner = (unsigned int)(&ffi_closure_SYSV_inner); |
---|
406 | n/a | *(unsigned int*) &__tramp[0] = 0xebcd1f00; /* pushm r8-r12 */ |
---|
407 | n/a | *(unsigned int*) &__tramp[4] = 0xfefc0010; /* ld.w r12, pc[16] */ |
---|
408 | n/a | *(unsigned int*) &__tramp[8] = 0xfefb0010; /* ld.w r11, pc[16] */ |
---|
409 | n/a | *(unsigned int*) &__tramp[12] = 0xfefa0010; /* ld.w r10, pc[16] */ |
---|
410 | n/a | *(unsigned int*) &__tramp[16] = 0xfeff0010; /* ld.w pc, pc[16] */ |
---|
411 | n/a | *(unsigned int*) &__tramp[20] = __ctx; |
---|
412 | n/a | *(unsigned int*) &__tramp[24] = __rstruct_flag; |
---|
413 | n/a | *(unsigned int*) &__tramp[28] = __inner; |
---|
414 | n/a | *(unsigned int*) &__tramp[32] = __fun; |
---|
415 | n/a | syscall(__NR_cacheflush, 0, (&__tramp[0]), 36); |
---|
416 | n/a | |
---|
417 | n/a | closure->cif = cif; |
---|
418 | n/a | closure->user_data = user_data; |
---|
419 | n/a | closure->fun = fun; |
---|
420 | n/a | |
---|
421 | n/a | return FFI_OK; |
---|
422 | n/a | } |
---|
423 | n/a | |
---|