[qemu.git] / linux-user / thunk.c

/*
 *  Generic thunking code to convert data between host and target CPU
 *
 *  Copyright (c) 2003 Fabrice Bellard
 *
 * 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.1 of the License, or (at your option) any later version.
 *
 * 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.
 *
 * You should have received a copy of the GNU Lesser General Public
 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
 */
#include "qemu/osdep.h"
#include "qemu/log.h"

#include "qemu.h"
#include "exec/user/thunk.h"

//#define DEBUG

static unsigned int max_struct_entries;
StructEntry *struct_entries;

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

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:
    case TYPE_OLDDEVT:
        return type_ptr;
    case TYPE_PTR:
        return thunk_type_next_ptr(type_ptr);
    case TYPE_ARRAY:
        return thunk_type_next_ptr(type_ptr + 1);
    case TYPE_STRUCT:
        return type_ptr + 1;
    default:
        return NULL;
    }
}

static const argtype *thunk_type_next_ptr(const argtype *type_ptr)
{
    return thunk_type_next(type_ptr);
}

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;

    assert(id < max_struct_entries);

    /* 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++;
    }
    assert(nb_fields > 0);
    se = struct_entries + id;
    se->field_types = types;
    se->nb_fields = nb_fields;
    se->name = name;
#ifdef DEBUG
    printf("struct %s: id=%d nb_fields=%d\n",
           se->name, id, se->nb_fields);
#endif
    /* now we can alloc the data */

    for (i = 0; i < ARRAY_SIZE(se->field_offsets); i++) {
        offset = 0;
        max_align = 1;
        se->field_offsets[i] = g_new(int, nb_fields);
        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;
            type_ptr = thunk_type_next(type_ptr);
        }
        offset = (offset + max_align - 1) & ~(max_align - 1);
        se->size[i] = offset;
        se->align[i] = max_align;
#ifdef DEBUG
        printf("%s: size=%d align=%d\n",
               i == THUNK_HOST ? "host" : "target", offset, max_align);
#endif
    }
}

void thunk_register_struct_direct(int id, const char *name,
                                  const StructEntry *se1)
{
    StructEntry *se;

    assert(id < max_struct_entries);
    se = struct_entries + id;
    *se = *se1;
    se->name = name;
}


/* now we can define the main conversion functions */
const argtype *thunk_convert(void *dst, const void *src,
                             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;
#if HOST_LONG_BITS == 32 && TARGET_ABI_BITS == 32
    case TYPE_LONG:
    case TYPE_ULONG:
    case TYPE_PTRVOID:
        *(uint32_t *)dst = tswap32(*(uint32_t *)src);
        break;
#elif HOST_LONG_BITS == 64 && TARGET_ABI_BITS == 32
    case TYPE_LONG:
    case TYPE_ULONG:
    case TYPE_PTRVOID:
        if (to_host) {
            if (type == TYPE_LONG) {
                /* sign extension */
                *(uint64_t *)dst = (int32_t)tswap32(*(uint32_t *)src);
            } else {
                *(uint64_t *)dst = tswap32(*(uint32_t *)src);
            }
        } else {
            *(uint32_t *)dst = tswap32(*(uint64_t *)src & 0xffffffff);
        }
        break;
#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;
#else
#warning unsupported conversion
#endif
    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;
    }
    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;

            assert(*type_ptr < max_struct_entries);
            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++) {
                    field_types = thunk_convert(d + dst_offsets[i],
                                                s + src_offsets[i],
                                                field_types, to_host);
                }
            }
        }
        break;
    default:
        fprintf(stderr, "Invalid type 0x%x\n", type);
        break;
    }
    return type_ptr;
}

const argtype *thunk_print(void *arg, const argtype *type_ptr)
{
    int type;

    type = *type_ptr++;

    switch (type) {
    case TYPE_CHAR:
        qemu_log("%c", *(uint8_t *)arg);
        break;
    case TYPE_SHORT:
        qemu_log("%" PRId16, tswap16(*(uint16_t *)arg));
        break;
    case TYPE_INT:
        qemu_log("%" PRId32, tswap32(*(uint32_t *)arg));
        break;
    case TYPE_LONGLONG:
        qemu_log("%" PRId64, tswap64(*(uint64_t *)arg));
        break;
    case TYPE_ULONGLONG:
        qemu_log("%" PRIu64, tswap64(*(uint64_t *)arg));
        break;
#if HOST_LONG_BITS == 32 && TARGET_ABI_BITS == 32
    case TYPE_PTRVOID:
        qemu_log("0x%" PRIx32, tswap32(*(uint32_t *)arg));
        break;
    case TYPE_LONG:
        qemu_log("%" PRId32, tswap32(*(uint32_t *)arg));
        break;
    case TYPE_ULONG:
        qemu_log("%" PRIu32, tswap32(*(uint32_t *)arg));
        break;
#elif HOST_LONG_BITS == 64 && TARGET_ABI_BITS == 32
    case TYPE_PTRVOID:
        qemu_log("0x%" PRIx32, tswap32(*(uint64_t *)arg & 0xffffffff));
        break;
    case TYPE_LONG:
        qemu_log("%" PRId32, tswap32(*(uint64_t *)arg & 0xffffffff));
        break;
    case TYPE_ULONG:
        qemu_log("%" PRIu32, tswap32(*(uint64_t *)arg & 0xffffffff));
        break;
#elif HOST_LONG_BITS == 64 && TARGET_ABI_BITS == 64
    case TYPE_PTRVOID:
        qemu_log("0x%" PRIx64, tswap64(*(uint64_t *)arg));
        break;
    case TYPE_LONG:
        qemu_log("%" PRId64, tswap64(*(uint64_t *)arg));
        break;
    case TYPE_ULONG:
        qemu_log("%" PRIu64, tswap64(*(uint64_t *)arg));
        break;
#else
    case TYPE_PTRVOID:
        qemu_log("0x%" PRIx64, tswap64(*(uint64_t *)arg));
        break;
    case TYPE_LONG:
        qemu_log("%" PRId64, tswap64(*(uint64_t *)arg));
        break;
    case TYPE_ULONG:
        qemu_log("%" PRIu64, tswap64(*(uint64_t *)arg));
        break;
#endif
    case TYPE_OLDDEVT:
    {
        uint64_t val = 0;
        switch (thunk_type_size(type_ptr - 1, 1)) {
        case 2:
            val = *(uint16_t *)arg;
            break;
        case 4:
            val = *(uint32_t *)arg;
            break;
        case 8:
            val = *(uint64_t *)arg;
            break;
        }
        switch (thunk_type_size(type_ptr - 1, 0)) {
        case 2:
            qemu_log("%" PRIu16, tswap16(val));
            break;
        case 4:
            qemu_log("%" PRIu32, tswap32(val));
            break;
        case 8:
            qemu_log("%" PRIu64, tswap64(val));
            break;
        }
    }
    break;
    case TYPE_ARRAY:
        {
            int i, array_length, arg_size;
            uint8_t *a;
            int is_string = 0;

            array_length = *type_ptr++;
            arg_size = thunk_type_size(type_ptr, 0);
            a = arg;

            if (*type_ptr == TYPE_CHAR) {
                qemu_log("\"");
                is_string = 1;
            } else {
                qemu_log("[");
            }

            for (i = 0; i < array_length; i++) {
                if (i > 0 && !is_string) {
                    qemu_log(",");
                }
                thunk_print(a, type_ptr);
                a += arg_size;
            }

            if (is_string) {
                qemu_log("\"");
            } else {
                qemu_log("]");
            }

            type_ptr = thunk_type_next(type_ptr);
        }
        break;
    case TYPE_STRUCT:
        {
            int i;
            const StructEntry *se;
            uint8_t  *a;
            const argtype *field_types;
            const int *arg_offsets;

            se = struct_entries + *type_ptr++;

            if (se->print != NULL) {
                se->print(arg);
            } else {
                a = arg;

                field_types = se->field_types;
                arg_offsets = se->field_offsets[0];

                qemu_log("{");
                for (i = 0; i < se->nb_fields; i++) {
                    if (i > 0) {
                        qemu_log(",");
                    }
                    field_types = thunk_print(a + arg_offsets[i], field_types);
                }
                qemu_log("}");
            }
        }
        break;
    default:
        g_assert_not_reached();
    }
    return type_ptr;
}

/* from em86 */

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

    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;
        }
    }
    return host_mask;
}

unsigned int host_to_target_bitmask(unsigned int host_mask,
                                    const bitmask_transtbl * trans_tbl)
{
    const bitmask_transtbl *btp;
    unsigned int target_mask = 0;

    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;
        }
    }
    return target_mask;
}

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);
}

void thunk_init(unsigned int max_structs)
{
    max_struct_entries = max_structs;
    struct_entries = g_new0(StructEntry, max_structs);
}
Commit	Line	Data
31e31b8a FB	1	/*
31e31b8a FB	2	* Generic thunking code to convert data between host and target CPU
5fafdf24	3	*
31e31b8a FB	4	* Copyright (c) 2003 Fabrice Bellard
31e31b8a FB	5	*
3ef693a0 FB	6	* This library is free software; you can redistribute it and/or
	7	* modify it under the terms of the GNU Lesser General Public
	8	* License as published by the Free Software Foundation; either
b4424aab	9	* version 2.1 of the License, or (at your option) any later version.
31e31b8a	10	*
3ef693a0 FB	11	* This library is distributed in the hope that it will be useful,
	12	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	13	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
	14	* Lesser General Public License for more details.
31e31b8a	15	*
3ef693a0	16	* You should have received a copy of the GNU Lesser General Public
8167ee88	17	* License along with this library; if not, see <http://www.gnu.org/licenses/>.
31e31b8a	18	*/
d38ea87a	19	#include "qemu/osdep.h"
d0a7920e	20	#include "qemu/log.h"
31e31b8a	21
3ef693a0	22	#include "qemu.h"
022c62cb	23	#include "exec/user/thunk.h"
31e31b8a FB	24
	25	//#define DEBUG
	26
8be656b8 AG	27	static unsigned int max_struct_entries;
8be656b8 AG	28	StructEntry *struct_entries;
31e31b8a	29
26553115 JM	30	static const argtype thunk_type_next_ptr(const argtype type_ptr);
26553115 JM	31
31e31b8a FB	32	static inline const argtype thunk_type_next(const argtype type_ptr)
	33	{
	34	int type;
	35
	36	type = *type_ptr++;
	37	switch(type) {
	38	case TYPE_CHAR:
	39	case TYPE_SHORT:
	40	case TYPE_INT:
	41	case TYPE_LONGLONG:
	42	case TYPE_ULONGLONG:
	43	case TYPE_LONG:
	44	case TYPE_ULONG:
	45	case TYPE_PTRVOID:
6083abd9	46	case TYPE_OLDDEVT:
31e31b8a FB	47	return type_ptr;
31e31b8a FB	48	case TYPE_PTR:
26553115	49	return thunk_type_next_ptr(type_ptr);
31e31b8a	50	case TYPE_ARRAY:
26553115	51	return thunk_type_next_ptr(type_ptr + 1);
31e31b8a FB	52	case TYPE_STRUCT:
	53	return type_ptr + 1;
	54	default:
	55	return NULL;
	56	}
	57	}
	58
26553115 JM	59	static const argtype thunk_type_next_ptr(const argtype type_ptr)
	60	{
	61	return thunk_type_next(type_ptr);
	62	}
	63
31e31b8a FB	64	void thunk_register_struct(int id, const char name, const argtype types)
	65	{
	66	const argtype *type_ptr;
	67	StructEntry *se;
	68	int nb_fields, offset, max_align, align, size, i, j;
	69
8be656b8	70	assert(id < max_struct_entries);
3b46e624	71
31e31b8a FB	72	/* first we count the number of fields */
	73	type_ptr = types;
	74	nb_fields = 0;
	75	while (*type_ptr != TYPE_NULL) {
	76	type_ptr = thunk_type_next(type_ptr);
	77	nb_fields++;
	78	}
a44af723 PMD	79	assert(nb_fields > 0);
a44af723 PMD	80	se = struct_entries + id;
31e31b8a FB	81	se->field_types = types;
	82	se->nb_fields = nb_fields;
	83	se->name = name;
	84	#ifdef DEBUG
5fafdf24	85	printf("struct %s: id=%d nb_fields=%d\n",
31e31b8a FB	86	se->name, id, se->nb_fields);
	87	#endif
	88	/* now we can alloc the data */
	89
a8df4845	90	for (i = 0; i < ARRAY_SIZE(se->field_offsets); i++) {
31e31b8a FB	91	offset = 0;
31e31b8a FB	92	max_align = 1;
0e081fde	93	se->field_offsets[i] = g_new(int, nb_fields);
31e31b8a FB	94	type_ptr = se->field_types;
	95	for(j = 0;j < nb_fields; j++) {
	96	size = thunk_type_size(type_ptr, i);
	97	align = thunk_type_align(type_ptr, i);
	98	offset = (offset + align - 1) & ~(align - 1);
	99	se->field_offsets[i][j] = offset;
	100	offset += size;
	101	if (align > max_align)
	102	max_align = align;
24374901	103	type_ptr = thunk_type_next(type_ptr);
31e31b8a FB	104	}
	105	offset = (offset + max_align - 1) & ~(max_align - 1);
	106	se->size[i] = offset;
	107	se->align[i] = max_align;
	108	#ifdef DEBUG
5fafdf24	109	printf("%s: size=%d align=%d\n",
31e31b8a FB	110	i == THUNK_HOST ? "host" : "target", offset, max_align);
	111	#endif
	112	}
	113	}
	114
8e853dc7 BS	115	void thunk_register_struct_direct(int id, const char *name,
8e853dc7 BS	116	const StructEntry *se1)
31e31b8a FB	117	{
31e31b8a FB	118	StructEntry *se;
8be656b8 AG	119
8be656b8 AG	120	assert(id < max_struct_entries);
31e31b8a FB	121	se = struct_entries + id;
	122	se = se1;
	123	se->name = name;
	124	}
	125
	126
	127	/* now we can define the main conversion functions */
5fafdf24	128	const argtype thunk_convert(void dst, const void *src,
31e31b8a FB	129	const argtype *type_ptr, int to_host)
	130	{
	131	int type;
	132
	133	type = *type_ptr++;
	134	switch(type) {
	135	case TYPE_CHAR:
	136	(uint8_t )dst = (uint8_t )src;
	137	break;
	138	case TYPE_SHORT:
	139	(uint16_t )dst = tswap16((uint16_t )src);
	140	break;
	141	case TYPE_INT:
	142	(uint32_t )dst = tswap32((uint32_t )src);
	143	break;
	144	case TYPE_LONGLONG:
	145	case TYPE_ULONGLONG:
	146	(uint64_t )dst = tswap64((uint64_t )src);
	147	break;
992f48a0	148	#if HOST_LONG_BITS == 32 && TARGET_ABI_BITS == 32
31e31b8a FB	149	case TYPE_LONG:
	150	case TYPE_ULONG:
	151	case TYPE_PTRVOID:
	152	(uint32_t )dst = tswap32((uint32_t )src);
	153	break;
992f48a0	154	#elif HOST_LONG_BITS == 64 && TARGET_ABI_BITS == 32
31e31b8a FB	155	case TYPE_LONG:
	156	case TYPE_ULONG:
	157	case TYPE_PTRVOID:
d0cd3b8d	158	if (to_host) {
70499c98 FB	159	if (type == TYPE_LONG) {
	160	/* sign extension */
	161	(uint64_t )dst = (int32_t)tswap32((uint32_t )src);
	162	} else {
	163	(uint64_t )dst = tswap32((uint32_t )src);
	164	}
31e31b8a FB	165	} else {
	166	(uint32_t )dst = tswap32((uint64_t )src & 0xffffffff);
	167	}
	168	break;
70499c98 FB	169	#elif HOST_LONG_BITS == 64 && TARGET_ABI_BITS == 64
	170	case TYPE_LONG:
	171	case TYPE_ULONG:
	172	case TYPE_PTRVOID:
	173	(uint64_t )dst = tswap64((uint64_t )src);
	174	break;
	175	#elif HOST_LONG_BITS == 32 && TARGET_ABI_BITS == 64
	176	case TYPE_LONG:
	177	case TYPE_ULONG:
	178	case TYPE_PTRVOID:
	179	if (to_host) {
	180	(uint32_t )dst = tswap64((uint64_t )src);
	181	} else {
	182	if (type == TYPE_LONG) {
	183	/* sign extension */
	184	(uint64_t )dst = tswap64((int32_t )src);
	185	} else {
	186	(uint64_t )dst = tswap64((uint32_t )src);
	187	}
	188	}
	189	break;
31e31b8a	190	#else
64b3ab24	191	#warning unsupported conversion
31e31b8a	192	#endif
6083abd9 AG	193	case TYPE_OLDDEVT:
	194	{
	195	uint64_t val = 0;
	196	switch (thunk_type_size(type_ptr - 1, !to_host)) {
	197	case 2:
	198	val = (uint16_t )src;
	199	break;
	200	case 4:
	201	val = (uint32_t )src;
	202	break;
	203	case 8:
	204	val = (uint64_t )src;
	205	break;
	206	}
	207	switch (thunk_type_size(type_ptr - 1, to_host)) {
	208	case 2:
	209	(uint16_t )dst = tswap16(val);
	210	break;
	211	case 4:
	212	(uint32_t )dst = tswap32(val);
	213	break;
	214	case 8:
	215	(uint64_t )dst = tswap64(val);
	216	break;
	217	}
	218	break;
	219	}
31e31b8a FB	220	case TYPE_ARRAY:
	221	{
	222	int array_length, i, dst_size, src_size;
	223	const uint8_t *s;
	224	uint8_t *d;
	225
	226	array_length = *type_ptr++;
	227	dst_size = thunk_type_size(type_ptr, to_host);
	228	src_size = thunk_type_size(type_ptr, 1 - to_host);
	229	d = dst;
	230	s = src;
	231	for(i = 0;i < array_length; i++) {
	232	thunk_convert(d, s, type_ptr, to_host);
	233	d += dst_size;
	234	s += src_size;
	235	}
	236	type_ptr = thunk_type_next(type_ptr);
	237	}
	238	break;
	239	case TYPE_STRUCT:
	240	{
	241	int i;
	242	const StructEntry *se;
	243	const uint8_t *s;
	244	uint8_t *d;
	245	const argtype *field_types;
	246	const int dst_offsets, src_offsets;
3b46e624	247
8be656b8	248	assert(*type_ptr < max_struct_entries);
31e31b8a FB	249	se = struct_entries + *type_ptr++;
	250	if (se->convert[0] != NULL) {
	251	/* specific conversion is needed */
	252	(*se->convert[to_host])(dst, src);
	253	} else {
	254	/* standard struct conversion */
	255	field_types = se->field_types;
	256	dst_offsets = se->field_offsets[to_host];
	257	src_offsets = se->field_offsets[1 - to_host];
	258	d = dst;
	259	s = src;
	260	for(i = 0;i < se->nb_fields; i++) {
5fafdf24 TS	261	field_types = thunk_convert(d + dst_offsets[i],
5fafdf24 TS	262	s + src_offsets[i],
31e31b8a FB	263	field_types, to_host);
	264	}
	265	}
	266	}
	267	break;
	268	default:
	269	fprintf(stderr, "Invalid type 0x%x\n", type);
	270	break;
	271	}
	272	return type_ptr;
	273	}
	274
79482e59 FB	275	const argtype thunk_print(void arg, const argtype *type_ptr)
	276	{
	277	int type;
	278
	279	type = *type_ptr++;
	280
	281	switch (type) {
	282	case TYPE_CHAR:
	283	qemu_log("%c", (uint8_t )arg);
	284	break;
	285	case TYPE_SHORT:
	286	qemu_log("%" PRId16, tswap16((uint16_t )arg));
	287	break;
	288	case TYPE_INT:
	289	qemu_log("%" PRId32, tswap32((uint32_t )arg));
	290	break;
	291	case TYPE_LONGLONG:
	292	qemu_log("%" PRId64, tswap64((uint64_t )arg));
	293	break;
	294	case TYPE_ULONGLONG:
	295	qemu_log("%" PRIu64, tswap64((uint64_t )arg));
	296	break;
	297	#if HOST_LONG_BITS == 32 && TARGET_ABI_BITS == 32
	298	case TYPE_PTRVOID:
	299	qemu_log("0x%" PRIx32, tswap32((uint32_t )arg));
	300	break;
	301	case TYPE_LONG:
	302	qemu_log("%" PRId32, tswap32((uint32_t )arg));
	303	break;
	304	case TYPE_ULONG:
	305	qemu_log("%" PRIu32, tswap32((uint32_t )arg));
	306	break;
	307	#elif HOST_LONG_BITS == 64 && TARGET_ABI_BITS == 32
	308	case TYPE_PTRVOID:
	309	qemu_log("0x%" PRIx32, tswap32((uint64_t )arg & 0xffffffff));
	310	break;
	311	case TYPE_LONG:
	312	qemu_log("%" PRId32, tswap32((uint64_t )arg & 0xffffffff));
	313	break;
	314	case TYPE_ULONG:
	315	qemu_log("%" PRIu32, tswap32((uint64_t )arg & 0xffffffff));
	316	break;
	317	#elif HOST_LONG_BITS == 64 && TARGET_ABI_BITS == 64
	318	case TYPE_PTRVOID:
	319	qemu_log("0x%" PRIx64, tswap64((uint64_t )arg));
	320	break;
	321	case TYPE_LONG:
	322	qemu_log("%" PRId64, tswap64((uint64_t )arg));
	323	break;
	324	case TYPE_ULONG:
	325	qemu_log("%" PRIu64, tswap64((uint64_t )arg));
	326	break;
	327	#else
	328	case TYPE_PTRVOID:
	329	qemu_log("0x%" PRIx64, tswap64((uint64_t )arg));
	330	break;
	331	case TYPE_LONG:
	332	qemu_log("%" PRId64, tswap64((uint64_t )arg));
	333	break;
	334	case TYPE_ULONG:
	335	qemu_log("%" PRIu64, tswap64((uint64_t )arg));
	336	break;
	337	#endif
	338	case TYPE_OLDDEVT:
339	{
340	uint64_t val = 0;
341	switch (thunk_type_size(type_ptr - 1, 1)) {
342	case 2:
343	val = (uint16_t )arg;
344	break;
345	case 4:
346	val = (uint32_t )arg;
347	break;
348	case 8:
349	val = (uint64_t )arg;
350	break;
351	}
352	switch (thunk_type_size(type_ptr - 1, 0)) {
353	case 2:
354	qemu_log("%" PRIu16, tswap16(val));
355	break;
356	case 4:
357	qemu_log("%" PRIu32, tswap32(val));
358	break;
359	case 8:
360	qemu_log("%" PRIu64, tswap64(val));
361	break;
362	}
363	}
364	break;
365	case TYPE_ARRAY:
366	{
367	int i, array_length, arg_size;
368	uint8_t *a;
369	int is_string = 0;
370
371	array_length = *type_ptr++;
372	arg_size = thunk_type_size(type_ptr, 0);
373	a = arg;
374
375	if (*type_ptr == TYPE_CHAR) {
376	qemu_log("\"");
377	is_string = 1;
378	} else {
379	qemu_log("[");
380	}
381
382	for (i = 0; i < array_length; i++) {
383	if (i > 0 && !is_string) {
384	qemu_log(",");
385	}
386	thunk_print(a, type_ptr);
387	a += arg_size;
388	}
389
390	if (is_string) {
391	qemu_log("\"");
392	} else {
393	qemu_log("]");
394	}
395
396	type_ptr = thunk_type_next(type_ptr);
397	}
398	break;
399	case TYPE_STRUCT:
400	{
401	int i;
402	const StructEntry *se;
403	uint8_t *a;
404	const argtype *field_types;
405	const int *arg_offsets;
406
407	se = struct_entries + *type_ptr++;
79482e59	408
888468db FB	409	if (se->print != NULL) {
	410	se->print(arg);
	411	} else {
	412	a = arg;
79482e59	413
888468db FB	414	field_types = se->field_types;
	415	arg_offsets = se->field_offsets[0];
	416
	417	qemu_log("{");
	418	for (i = 0; i < se->nb_fields; i++) {
	419	if (i > 0) {
	420	qemu_log(",");
	421	}
	422	field_types = thunk_print(a + arg_offsets[i], field_types);
79482e59	423	}
888468db	424	qemu_log("}");
79482e59	425	}
79482e59 FB	426	}
	427	break;
	428	default:
	429	g_assert_not_reached();
	430	}
	431	return type_ptr;
	432	}
	433
31e31b8a FB	434	/* from em86 */
	435
	436	/* Utility function: Table-driven functions to translate bitmasks
e0ca2ed5	437	* between host and target formats
31e31b8a	438	*/
e0ca2ed5	439	unsigned int target_to_host_bitmask(unsigned int target_mask,
b39bc503	440	const bitmask_transtbl * trans_tbl)
31e31b8a	441	{
b39bc503	442	const bitmask_transtbl *btp;
e0ca2ed5	443	unsigned int host_mask = 0;
31e31b8a	444
e0ca2ed5 PM	445	for (btp = trans_tbl; btp->target_mask && btp->host_mask; btp++) {
	446	if ((target_mask & btp->target_mask) == btp->target_bits) {
	447	host_mask \|= btp->host_bits;
	448	}
31e31b8a	449	}
e0ca2ed5	450	return host_mask;
31e31b8a FB	451	}
31e31b8a FB	452
e0ca2ed5	453	unsigned int host_to_target_bitmask(unsigned int host_mask,
b39bc503	454	const bitmask_transtbl * trans_tbl)
31e31b8a	455	{
b39bc503	456	const bitmask_transtbl *btp;
e0ca2ed5	457	unsigned int target_mask = 0;
31e31b8a	458
e0ca2ed5 PM	459	for (btp = trans_tbl; btp->target_mask && btp->host_mask; btp++) {
	460	if ((host_mask & btp->host_mask) == btp->host_bits) {
	461	target_mask \|= btp->target_bits;
	462	}
31e31b8a	463	}
e0ca2ed5	464	return target_mask;
31e31b8a	465	}
26553115	466
26553115 JM	467	int thunk_type_size_array(const argtype *type_ptr, int is_host)
	468	{
	469	return thunk_type_size(type_ptr, is_host);
	470	}
	471
	472	int thunk_type_align_array(const argtype *type_ptr, int is_host)
	473	{
	474	return thunk_type_align(type_ptr, is_host);
	475	}
8be656b8 AG	476
	477	void thunk_init(unsigned int max_structs)
	478	{
	479	max_struct_entries = max_structs;
	480	struct_entries = g_new0(StructEntry, max_structs);
	481	}