| 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 | |
|---|