thunk.c 9.07 KB
Newer Older
1 2
/*
 *  Generic thunking code to convert data between host and target CPU
3
 *
4 5
 *  Copyright (c) 2003 Fabrice Bellard
 *
bellard's avatar
bellard committed
6 7 8 9
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2 of the License, or (at your option) any later version.
10
 *
bellard's avatar
bellard committed
11 12 13 14
 * This library is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
15
 *
bellard's avatar
bellard committed
16
 * You should have received a copy of the GNU Lesser General Public
17
 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
18
 */
Peter Maydell's avatar
Peter Maydell committed
19
#include "qemu/osdep.h"
20

bellard's avatar
bellard committed
21
#include "qemu.h"
22
#include "exec/user/thunk.h"
23 24 25

//#define DEBUG

26 27
static unsigned int max_struct_entries;
StructEntry *struct_entries;
28

29 30
static const argtype *thunk_type_next_ptr(const argtype *type_ptr);

31 32 33 34 35 36 37 38 39 40 41 42 43 44
static inline const argtype *thunk_type_next(const argtype *type_ptr)
{
    int type;

    type = *type_ptr++;
    switch(type) {
    case TYPE_CHAR:
    case TYPE_SHORT:
    case TYPE_INT:
    case TYPE_LONGLONG:
    case TYPE_ULONGLONG:
    case TYPE_LONG:
    case TYPE_ULONG:
    case TYPE_PTRVOID:
45
    case TYPE_OLDDEVT:
46 47
        return type_ptr;
    case TYPE_PTR:
48
        return thunk_type_next_ptr(type_ptr);
49
    case TYPE_ARRAY:
50
        return thunk_type_next_ptr(type_ptr + 1);
51 52 53 54 55 56 57
    case TYPE_STRUCT:
        return type_ptr + 1;
    default:
        return NULL;
    }
}

58 59 60 61 62
static const argtype *thunk_type_next_ptr(const argtype *type_ptr)
{
    return thunk_type_next(type_ptr);
}

63 64 65 66 67 68
void thunk_register_struct(int id, const char *name, const argtype *types)
{
    const argtype *type_ptr;
    StructEntry *se;
    int nb_fields, offset, max_align, align, size, i, j;

69
    assert(id < max_struct_entries);
70

71 72 73 74 75 76 77
    /* first we count the number of fields */
    type_ptr = types;
    nb_fields = 0;
    while (*type_ptr != TYPE_NULL) {
        type_ptr = thunk_type_next(type_ptr);
        nb_fields++;
    }
78 79
    assert(nb_fields > 0);
    se = struct_entries + id;
80 81 82 83
    se->field_types = types;
    se->nb_fields = nb_fields;
    se->name = name;
#ifdef DEBUG
84
    printf("struct %s: id=%d nb_fields=%d\n",
85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101
           se->name, id, se->nb_fields);
#endif
    /* now we can alloc the data */

    for(i = 0;i < 2; i++) {
        offset = 0;
        max_align = 1;
        se->field_offsets[i] = malloc(nb_fields * sizeof(int));
        type_ptr = se->field_types;
        for(j = 0;j < nb_fields; j++) {
            size = thunk_type_size(type_ptr, i);
            align = thunk_type_align(type_ptr, i);
            offset = (offset + align - 1) & ~(align - 1);
            se->field_offsets[i][j] = offset;
            offset += size;
            if (align > max_align)
                max_align = align;
102
            type_ptr = thunk_type_next(type_ptr);
103 104 105 106 107
        }
        offset = (offset + max_align - 1) & ~(max_align - 1);
        se->size[i] = offset;
        se->align[i] = max_align;
#ifdef DEBUG
108
        printf("%s: size=%d align=%d\n",
109 110 111 112 113
               i == THUNK_HOST ? "host" : "target", offset, max_align);
#endif
    }
}

114 115
void thunk_register_struct_direct(int id, const char *name,
                                  const StructEntry *se1)
116 117
{
    StructEntry *se;
118 119

    assert(id < max_struct_entries);
120 121 122 123 124 125 126
    se = struct_entries + id;
    *se = *se1;
    se->name = name;
}


/* now we can define the main conversion functions */
127
const argtype *thunk_convert(void *dst, const void *src,
128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146
                             const argtype *type_ptr, int to_host)
{
    int type;

    type = *type_ptr++;
    switch(type) {
    case TYPE_CHAR:
        *(uint8_t *)dst = *(uint8_t *)src;
        break;
    case TYPE_SHORT:
        *(uint16_t *)dst = tswap16(*(uint16_t *)src);
        break;
    case TYPE_INT:
        *(uint32_t *)dst = tswap32(*(uint32_t *)src);
        break;
    case TYPE_LONGLONG:
    case TYPE_ULONGLONG:
        *(uint64_t *)dst = tswap64(*(uint64_t *)src);
        break;
147
#if HOST_LONG_BITS == 32 && TARGET_ABI_BITS == 32
148 149 150 151 152
    case TYPE_LONG:
    case TYPE_ULONG:
    case TYPE_PTRVOID:
        *(uint32_t *)dst = tswap32(*(uint32_t *)src);
        break;
153
#elif HOST_LONG_BITS == 64 && TARGET_ABI_BITS == 32
154 155 156
    case TYPE_LONG:
    case TYPE_ULONG:
    case TYPE_PTRVOID:
bellard's avatar
bellard committed
157
        if (to_host) {
158 159 160 161 162 163
            if (type == TYPE_LONG) {
                /* sign extension */
                *(uint64_t *)dst = (int32_t)tswap32(*(uint32_t *)src);
            } else {
                *(uint64_t *)dst = tswap32(*(uint32_t *)src);
            }
164 165 166 167
        } else {
            *(uint32_t *)dst = tswap32(*(uint64_t *)src & 0xffffffff);
        }
        break;
168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188
#elif HOST_LONG_BITS == 64 && TARGET_ABI_BITS == 64
    case TYPE_LONG:
    case TYPE_ULONG:
    case TYPE_PTRVOID:
        *(uint64_t *)dst = tswap64(*(uint64_t *)src);
        break;
#elif HOST_LONG_BITS == 32 && TARGET_ABI_BITS == 64
    case TYPE_LONG:
    case TYPE_ULONG:
    case TYPE_PTRVOID:
        if (to_host) {
            *(uint32_t *)dst = tswap64(*(uint64_t *)src);
        } else {
            if (type == TYPE_LONG) {
                /* sign extension */
                *(uint64_t *)dst = tswap64(*(int32_t *)src);
            } else {
                *(uint64_t *)dst = tswap64(*(uint32_t *)src);
            }
        }
        break;
189
#else
bellard's avatar
bellard committed
190
#warning unsupported conversion
191
#endif
192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218
    case TYPE_OLDDEVT:
    {
        uint64_t val = 0;
        switch (thunk_type_size(type_ptr - 1, !to_host)) {
        case 2:
            val = *(uint16_t *)src;
            break;
        case 4:
            val = *(uint32_t *)src;
            break;
        case 8:
            val = *(uint64_t *)src;
            break;
        }
        switch (thunk_type_size(type_ptr - 1, to_host)) {
        case 2:
            *(uint16_t *)dst = tswap16(val);
            break;
        case 4:
            *(uint32_t *)dst = tswap32(val);
            break;
        case 8:
            *(uint64_t *)dst = tswap64(val);
            break;
        }
        break;
    }
219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245
    case TYPE_ARRAY:
        {
            int array_length, i, dst_size, src_size;
            const uint8_t *s;
            uint8_t  *d;

            array_length = *type_ptr++;
            dst_size = thunk_type_size(type_ptr, to_host);
            src_size = thunk_type_size(type_ptr, 1 - to_host);
            d = dst;
            s = src;
            for(i = 0;i < array_length; i++) {
                thunk_convert(d, s, type_ptr, to_host);
                d += dst_size;
                s += src_size;
            }
            type_ptr = thunk_type_next(type_ptr);
        }
        break;
    case TYPE_STRUCT:
        {
            int i;
            const StructEntry *se;
            const uint8_t *s;
            uint8_t  *d;
            const argtype *field_types;
            const int *dst_offsets, *src_offsets;
246

247
            assert(*type_ptr < max_struct_entries);
248 249 250 251 252 253 254 255 256 257 258 259
            se = struct_entries + *type_ptr++;
            if (se->convert[0] != NULL) {
                /* specific conversion is needed */
                (*se->convert[to_host])(dst, src);
            } else {
                /* standard struct conversion */
                field_types = se->field_types;
                dst_offsets = se->field_offsets[to_host];
                src_offsets = se->field_offsets[1 - to_host];
                d = dst;
                s = src;
                for(i = 0;i < se->nb_fields; i++) {
260 261
                    field_types = thunk_convert(d + dst_offsets[i],
                                                s + src_offsets[i],
262 263 264 265 266 267 268 269 270 271 272 273 274 275 276
                                                field_types, to_host);
                }
            }
        }
        break;
    default:
        fprintf(stderr, "Invalid type 0x%x\n", type);
        break;
    }
    return type_ptr;
}

/* from em86 */

/* Utility function: Table-driven functions to translate bitmasks
277
 * between host and target formats
278
 */
279
unsigned int target_to_host_bitmask(unsigned int target_mask,
280
                                    const bitmask_transtbl * trans_tbl)
281
{
282
    const bitmask_transtbl *btp;
283
    unsigned int host_mask = 0;
284

285 286 287 288
    for (btp = trans_tbl; btp->target_mask && btp->host_mask; btp++) {
        if ((target_mask & btp->target_mask) == btp->target_bits) {
            host_mask |= btp->host_bits;
        }
289
    }
290
    return host_mask;
291 292
}

293
unsigned int host_to_target_bitmask(unsigned int host_mask,
294
                                    const bitmask_transtbl * trans_tbl)
295
{
296
    const bitmask_transtbl *btp;
297
    unsigned int target_mask = 0;
298

299 300 301 302
    for (btp = trans_tbl; btp->target_mask && btp->host_mask; btp++) {
        if ((host_mask & btp->host_mask) == btp->host_bits) {
            target_mask |= btp->target_bits;
        }
303
    }
304
    return target_mask;
305
}
306 307 308 309 310 311 312 313 314 315

int thunk_type_size_array(const argtype *type_ptr, int is_host)
{
    return thunk_type_size(type_ptr, is_host);
}

int thunk_type_align_array(const argtype *type_ptr, int is_host)
{
    return thunk_type_align(type_ptr, is_host);
}
316 317 318 319 320 321

void thunk_init(unsigned int max_structs)
{
    max_struct_entries = max_structs;
    struct_entries = g_new0(StructEntry, max_structs);
}