[mirror_qemu.git] / 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 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.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;
}

/* 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
	1	/*
	2	* Generic thunking code to convert data between host and target CPU
	3	*
	4	* Copyright (c) 2003 Fabrice Bellard
	5	*
	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
	9	* version 2 of the License, or (at your option) any later version.
	10	*
	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.
	15	*
	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	*/
	19	#include "qemu/osdep.h"
	20
	21	#include "qemu.h"
	22	#include "exec/user/thunk.h"
	23
	24	//#define DEBUG
	25
	26	static unsigned int max_struct_entries;
	27	StructEntry *struct_entries;
	28
	29	static const argtype thunk_type_next_ptr(const argtype type_ptr);
	30
	31	static inline const argtype thunk_type_next(const argtype type_ptr)
	32	{
	33	int type;
	34
	35	type = *type_ptr++;
	36	switch(type) {
	37	case TYPE_CHAR:
	38	case TYPE_SHORT:
	39	case TYPE_INT:
	40	case TYPE_LONGLONG:
	41	case TYPE_ULONGLONG:
	42	case TYPE_LONG:
	43	case TYPE_ULONG:
	44	case TYPE_PTRVOID:
	45	case TYPE_OLDDEVT:
	46	return type_ptr;
	47	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	case TYPE_STRUCT:
	52	return type_ptr + 1;
	53	default:
	54	return NULL;
	55	}
	56	}
	57
	58	static const argtype thunk_type_next_ptr(const argtype type_ptr)
	59	{
	60	return thunk_type_next(type_ptr);
	61	}
	62
	63	void thunk_register_struct(int id, const char name, const argtype types)
	64	{
	65	const argtype *type_ptr;
	66	StructEntry *se;
	67	int nb_fields, offset, max_align, align, size, i, j;
	68
	69	assert(id < max_struct_entries);
	70
	71	/* first we count the number of fields */
	72	type_ptr = types;
	73	nb_fields = 0;
	74	while (*type_ptr != TYPE_NULL) {
	75	type_ptr = thunk_type_next(type_ptr);
	76	nb_fields++;
	77	}
	78	assert(nb_fields > 0);
	79	se = struct_entries + id;
	80	se->field_types = types;
	81	se->nb_fields = nb_fields;
	82	se->name = name;
	83	#ifdef DEBUG
	84	printf("struct %s: id=%d nb_fields=%d\n",
	85	se->name, id, se->nb_fields);
	86	#endif
	87	/* now we can alloc the data */
	88
	89	for (i = 0; i < ARRAY_SIZE(se->field_offsets); i++) {
	90	offset = 0;
	91	max_align = 1;
	92	se->field_offsets[i] = g_new(int, nb_fields);
	93	type_ptr = se->field_types;
	94	for(j = 0;j < nb_fields; j++) {
	95	size = thunk_type_size(type_ptr, i);
	96	align = thunk_type_align(type_ptr, i);
	97	offset = (offset + align - 1) & ~(align - 1);
	98	se->field_offsets[i][j] = offset;
	99	offset += size;
	100	if (align > max_align)
	101	max_align = align;
	102	type_ptr = thunk_type_next(type_ptr);
	103	}
	104	offset = (offset + max_align - 1) & ~(max_align - 1);
	105	se->size[i] = offset;
	106	se->align[i] = max_align;
	107	#ifdef DEBUG
	108	printf("%s: size=%d align=%d\n",
	109	i == THUNK_HOST ? "host" : "target", offset, max_align);
	110	#endif
	111	}
	112	}
	113
	114	void thunk_register_struct_direct(int id, const char *name,
	115	const StructEntry *se1)
	116	{
	117	StructEntry *se;
	118
	119	assert(id < max_struct_entries);
	120	se = struct_entries + id;
	121	se = se1;
	122	se->name = name;
	123	}
	124
	125
	126	/* now we can define the main conversion functions */
	127	const argtype thunk_convert(void dst, const void *src,
	128	const argtype *type_ptr, int to_host)
	129	{
	130	int type;
	131
	132	type = *type_ptr++;
	133	switch(type) {
	134	case TYPE_CHAR:
	135	(uint8_t )dst = (uint8_t )src;
	136	break;
	137	case TYPE_SHORT:
	138	(uint16_t )dst = tswap16((uint16_t )src);
	139	break;
	140	case TYPE_INT:
	141	(uint32_t )dst = tswap32((uint32_t )src);
	142	break;
	143	case TYPE_LONGLONG:
	144	case TYPE_ULONGLONG:
	145	(uint64_t )dst = tswap64((uint64_t )src);
	146	break;
	147	#if HOST_LONG_BITS == 32 && TARGET_ABI_BITS == 32
	148	case TYPE_LONG:
	149	case TYPE_ULONG:
	150	case TYPE_PTRVOID:
	151	(uint32_t )dst = tswap32((uint32_t )src);
	152	break;
	153	#elif HOST_LONG_BITS == 64 && TARGET_ABI_BITS == 32
	154	case TYPE_LONG:
	155	case TYPE_ULONG:
	156	case TYPE_PTRVOID:
	157	if (to_host) {
	158	if (type == TYPE_LONG) {
	159	/* sign extension */
	160	(uint64_t )dst = (int32_t)tswap32((uint32_t )src);
	161	} else {
	162	(uint64_t )dst = tswap32((uint32_t )src);
	163	}
	164	} else {
	165	(uint32_t )dst = tswap32((uint64_t )src & 0xffffffff);
	166	}
	167	break;
	168	#elif HOST_LONG_BITS == 64 && TARGET_ABI_BITS == 64
	169	case TYPE_LONG:
	170	case TYPE_ULONG:
	171	case TYPE_PTRVOID:
	172	(uint64_t )dst = tswap64((uint64_t )src);
	173	break;
	174	#elif HOST_LONG_BITS == 32 && TARGET_ABI_BITS == 64
	175	case TYPE_LONG:
	176	case TYPE_ULONG:
	177	case TYPE_PTRVOID:
	178	if (to_host) {
	179	(uint32_t )dst = tswap64((uint64_t )src);
	180	} else {
	181	if (type == TYPE_LONG) {
	182	/* sign extension */
	183	(uint64_t )dst = tswap64((int32_t )src);
	184	} else {
	185	(uint64_t )dst = tswap64((uint32_t )src);
	186	}
	187	}
	188	break;
	189	#else
	190	#warning unsupported conversion
	191	#endif
	192	case TYPE_OLDDEVT:
	193	{
	194	uint64_t val = 0;
	195	switch (thunk_type_size(type_ptr - 1, !to_host)) {
	196	case 2:
	197	val = (uint16_t )src;
	198	break;
	199	case 4:
	200	val = (uint32_t )src;
	201	break;
	202	case 8:
	203	val = (uint64_t )src;
	204	break;
	205	}
	206	switch (thunk_type_size(type_ptr - 1, to_host)) {
	207	case 2:
	208	(uint16_t )dst = tswap16(val);
	209	break;
	210	case 4:
	211	(uint32_t )dst = tswap32(val);
	212	break;
	213	case 8:
	214	(uint64_t )dst = tswap64(val);
	215	break;
	216	}
	217	break;
	218	}
	219	case TYPE_ARRAY:
	220	{
	221	int array_length, i, dst_size, src_size;
	222	const uint8_t *s;
	223	uint8_t *d;
	224
	225	array_length = *type_ptr++;
	226	dst_size = thunk_type_size(type_ptr, to_host);
	227	src_size = thunk_type_size(type_ptr, 1 - to_host);
	228	d = dst;
	229	s = src;
	230	for(i = 0;i < array_length; i++) {
	231	thunk_convert(d, s, type_ptr, to_host);
	232	d += dst_size;
	233	s += src_size;
	234	}
	235	type_ptr = thunk_type_next(type_ptr);
	236	}
	237	break;
	238	case TYPE_STRUCT:
	239	{
	240	int i;
	241	const StructEntry *se;
	242	const uint8_t *s;
	243	uint8_t *d;
	244	const argtype *field_types;
	245	const int dst_offsets, src_offsets;
	246
	247	assert(*type_ptr < max_struct_entries);
	248	se = struct_entries + *type_ptr++;
	249	if (se->convert[0] != NULL) {
	250	/* specific conversion is needed */
	251	(*se->convert[to_host])(dst, src);
	252	} else {
	253	/* standard struct conversion */
	254	field_types = se->field_types;
	255	dst_offsets = se->field_offsets[to_host];
	256	src_offsets = se->field_offsets[1 - to_host];
	257	d = dst;
	258	s = src;
	259	for(i = 0;i < se->nb_fields; i++) {
	260	field_types = thunk_convert(d + dst_offsets[i],
	261	s + src_offsets[i],
	262	field_types, to_host);
	263	}
	264	}
	265	}
	266	break;
	267	default:
	268	fprintf(stderr, "Invalid type 0x%x\n", type);
	269	break;
	270	}
	271	return type_ptr;
	272	}
	273
	274	/* from em86 */
	275
	276	/* 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	for (btp = trans_tbl; btp->target_mask && btp->host_mask; btp++) {
	286	if ((target_mask & btp->target_mask) == btp->target_bits) {
	287	host_mask \|= btp->host_bits;
	288	}
	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	for (btp = trans_tbl; btp->target_mask && btp->host_mask; btp++) {
	300	if ((host_mask & btp->host_mask) == btp->host_bits) {
	301	target_mask \|= btp->target_bits;
	302	}
	303	}
	304	return target_mask;
	305	}
	306
	307	int thunk_type_size_array(const argtype *type_ptr, int is_host)
	308	{
	309	return thunk_type_size(type_ptr, is_host);
	310	}
	311
	312	int thunk_type_align_array(const argtype *type_ptr, int is_host)
	313	{
	314	return thunk_type_align(type_ptr, is_host);
	315	}
	316
	317	void thunk_init(unsigned int max_structs)
	318	{
	319	max_struct_entries = max_structs;
	320	struct_entries = g_new0(StructEntry, max_structs);
	321	}