1 | n/a | /* ----------------------------------------------------------------------- |
---|
2 | n/a | ffi.c - Copyright (c) 2012 Alexandre K. I. de Mendonca <alexandre.keunecke@gmail.com>, |
---|
3 | n/a | Paulo Pizarro <paulo.pizarro@gmail.com> |
---|
4 | n/a | |
---|
5 | n/a | Blackfin 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 | #include <ffi.h> |
---|
28 | n/a | #include <ffi_common.h> |
---|
29 | n/a | |
---|
30 | n/a | #include <stdlib.h> |
---|
31 | n/a | #include <stdio.h> |
---|
32 | n/a | |
---|
33 | n/a | /* Maximum number of GPRs available for argument passing. */ |
---|
34 | n/a | #define MAX_GPRARGS 3 |
---|
35 | n/a | |
---|
36 | n/a | /* |
---|
37 | n/a | * Return types |
---|
38 | n/a | */ |
---|
39 | n/a | #define FFIBFIN_RET_VOID 0 |
---|
40 | n/a | #define FFIBFIN_RET_BYTE 1 |
---|
41 | n/a | #define FFIBFIN_RET_HALFWORD 2 |
---|
42 | n/a | #define FFIBFIN_RET_INT64 3 |
---|
43 | n/a | #define FFIBFIN_RET_INT32 4 |
---|
44 | n/a | |
---|
45 | n/a | /*====================================================================*/ |
---|
46 | n/a | /* PROTOTYPE * |
---|
47 | n/a | /*====================================================================*/ |
---|
48 | n/a | void ffi_prep_args(unsigned char *, extended_cif *); |
---|
49 | n/a | |
---|
50 | n/a | /*====================================================================*/ |
---|
51 | n/a | /* Externals */ |
---|
52 | n/a | /* (Assembly) */ |
---|
53 | n/a | /*====================================================================*/ |
---|
54 | n/a | |
---|
55 | n/a | extern void ffi_call_SYSV(unsigned, extended_cif *, void(*)(unsigned char *, extended_cif *), unsigned, void *, void(*fn)(void)); |
---|
56 | n/a | |
---|
57 | n/a | /*====================================================================*/ |
---|
58 | n/a | /* Implementation */ |
---|
59 | n/a | /* */ |
---|
60 | n/a | /*====================================================================*/ |
---|
61 | n/a | |
---|
62 | n/a | |
---|
63 | n/a | /* |
---|
64 | n/a | * This function calculates the return type (size) based on type. |
---|
65 | n/a | */ |
---|
66 | n/a | |
---|
67 | n/a | ffi_status ffi_prep_cif_machdep(ffi_cif *cif) |
---|
68 | n/a | { |
---|
69 | n/a | /* --------------------------------------* |
---|
70 | n/a | * Return handling * |
---|
71 | n/a | * --------------------------------------*/ |
---|
72 | n/a | switch (cif->rtype->type) { |
---|
73 | n/a | case FFI_TYPE_VOID: |
---|
74 | n/a | cif->flags = FFIBFIN_RET_VOID; |
---|
75 | n/a | break; |
---|
76 | n/a | case FFI_TYPE_UINT16: |
---|
77 | n/a | case FFI_TYPE_SINT16: |
---|
78 | n/a | cif->flags = FFIBFIN_RET_HALFWORD; |
---|
79 | n/a | break; |
---|
80 | n/a | case FFI_TYPE_UINT8: |
---|
81 | n/a | cif->flags = FFIBFIN_RET_BYTE; |
---|
82 | n/a | break; |
---|
83 | n/a | case FFI_TYPE_INT: |
---|
84 | n/a | case FFI_TYPE_UINT32: |
---|
85 | n/a | case FFI_TYPE_SINT32: |
---|
86 | n/a | case FFI_TYPE_FLOAT: |
---|
87 | n/a | case FFI_TYPE_POINTER: |
---|
88 | n/a | case FFI_TYPE_SINT8: |
---|
89 | n/a | cif->flags = FFIBFIN_RET_INT32; |
---|
90 | n/a | break; |
---|
91 | n/a | case FFI_TYPE_SINT64: |
---|
92 | n/a | case FFI_TYPE_UINT64: |
---|
93 | n/a | case FFI_TYPE_DOUBLE: |
---|
94 | n/a | cif->flags = FFIBFIN_RET_INT64; |
---|
95 | n/a | break; |
---|
96 | n/a | case FFI_TYPE_STRUCT: |
---|
97 | n/a | if (cif->rtype->size <= 4){ |
---|
98 | n/a | cif->flags = FFIBFIN_RET_INT32; |
---|
99 | n/a | }else if (cif->rtype->size == 8){ |
---|
100 | n/a | cif->flags = FFIBFIN_RET_INT64; |
---|
101 | n/a | }else{ |
---|
102 | n/a | //it will return via a hidden pointer in P0 |
---|
103 | n/a | cif->flags = FFIBFIN_RET_VOID; |
---|
104 | n/a | } |
---|
105 | n/a | break; |
---|
106 | n/a | default: |
---|
107 | n/a | FFI_ASSERT(0); |
---|
108 | n/a | break; |
---|
109 | n/a | } |
---|
110 | n/a | return FFI_OK; |
---|
111 | n/a | } |
---|
112 | n/a | |
---|
113 | n/a | /* |
---|
114 | n/a | * This will prepare the arguments and will call the assembly routine |
---|
115 | n/a | * cif = the call interface |
---|
116 | n/a | * fn = the function to be called |
---|
117 | n/a | * rvalue = the return value |
---|
118 | n/a | * avalue = the arguments |
---|
119 | n/a | */ |
---|
120 | n/a | void ffi_call(ffi_cif *cif, void(*fn)(void), void *rvalue, void **avalue) |
---|
121 | n/a | { |
---|
122 | n/a | int ret_type = cif->flags; |
---|
123 | n/a | extended_cif ecif; |
---|
124 | n/a | ecif.cif = cif; |
---|
125 | n/a | ecif.avalue = avalue; |
---|
126 | n/a | ecif.rvalue = rvalue; |
---|
127 | n/a | |
---|
128 | n/a | switch (cif->abi) { |
---|
129 | n/a | case FFI_SYSV: |
---|
130 | n/a | ffi_call_SYSV(cif->bytes, &ecif, ffi_prep_args, ret_type, ecif.rvalue, fn); |
---|
131 | n/a | break; |
---|
132 | n/a | default: |
---|
133 | n/a | FFI_ASSERT(0); |
---|
134 | n/a | break; |
---|
135 | n/a | } |
---|
136 | n/a | } |
---|
137 | n/a | |
---|
138 | n/a | |
---|
139 | n/a | /* |
---|
140 | n/a | * This function prepares the parameters (copies them from the ecif to the stack) |
---|
141 | n/a | * to call the function (ffi_prep_args is called by the assembly routine in file |
---|
142 | n/a | * sysv.S, which also calls the actual function) |
---|
143 | n/a | */ |
---|
144 | n/a | void ffi_prep_args(unsigned char *stack, extended_cif *ecif) |
---|
145 | n/a | { |
---|
146 | n/a | register unsigned int i = 0; |
---|
147 | n/a | void **p_argv; |
---|
148 | n/a | unsigned char *argp; |
---|
149 | n/a | ffi_type **p_arg; |
---|
150 | n/a | argp = stack; |
---|
151 | n/a | p_argv = ecif->avalue; |
---|
152 | n/a | for (i = ecif->cif->nargs, p_arg = ecif->cif->arg_types; |
---|
153 | n/a | (i != 0); |
---|
154 | n/a | i--, p_arg++) { |
---|
155 | n/a | size_t z; |
---|
156 | n/a | z = (*p_arg)->size; |
---|
157 | n/a | if (z < sizeof(int)) { |
---|
158 | n/a | z = sizeof(int); |
---|
159 | n/a | switch ((*p_arg)->type) { |
---|
160 | n/a | case FFI_TYPE_SINT8: { |
---|
161 | n/a | signed char v = *(SINT8 *)(* p_argv); |
---|
162 | n/a | signed int t = v; |
---|
163 | n/a | *(signed int *) argp = t; |
---|
164 | n/a | } |
---|
165 | n/a | break; |
---|
166 | n/a | case FFI_TYPE_UINT8: { |
---|
167 | n/a | unsigned char v = *(UINT8 *)(* p_argv); |
---|
168 | n/a | unsigned int t = v; |
---|
169 | n/a | *(unsigned int *) argp = t; |
---|
170 | n/a | } |
---|
171 | n/a | break; |
---|
172 | n/a | case FFI_TYPE_SINT16: |
---|
173 | n/a | *(signed int *) argp = (signed int) * (SINT16 *)(* p_argv); |
---|
174 | n/a | break; |
---|
175 | n/a | case FFI_TYPE_UINT16: |
---|
176 | n/a | *(unsigned int *) argp = (unsigned int) * (UINT16 *)(* p_argv); |
---|
177 | n/a | break; |
---|
178 | n/a | case FFI_TYPE_STRUCT: |
---|
179 | n/a | memcpy(argp, *p_argv, (*p_arg)->size); |
---|
180 | n/a | break; |
---|
181 | n/a | default: |
---|
182 | n/a | FFI_ASSERT(0); |
---|
183 | n/a | break; |
---|
184 | n/a | } |
---|
185 | n/a | } else if (z == sizeof(int)) { |
---|
186 | n/a | *(unsigned int *) argp = (unsigned int) * (UINT32 *)(* p_argv); |
---|
187 | n/a | } else { |
---|
188 | n/a | memcpy(argp, *p_argv, z); |
---|
189 | n/a | } |
---|
190 | n/a | p_argv++; |
---|
191 | n/a | argp += z; |
---|
192 | n/a | } |
---|
193 | n/a | } |
---|
194 | n/a | |
---|
195 | n/a | |
---|
196 | n/a | |
---|