[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 <stdlib.h>
#include <stdio.h>
#include <stdarg.h>

#include "qemu.h"
#include "thunk.h"

//#define DEBUG

#define MAX_STRUCTS 128

/* XXX: make it dynamic */
StructEntry struct_entries[MAX_STRUCTS];

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

    se = struct_entries + id;

    /* 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++;
    }
    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 < 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;
            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;
    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_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;

            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 X86 and Alpha formats...
 */
unsigned int target_to_host_bitmask(unsigned int x86_mask,
                                    const bitmask_transtbl * trans_tbl)
{
    const bitmask_transtbl *btp;
    unsigned int	alpha_mask = 0;

    for(btp = trans_tbl; btp->x86_mask && btp->alpha_mask; btp++) {
	if((x86_mask & btp->x86_mask) == btp->x86_bits) {
	    alpha_mask |= btp->alpha_bits;
	}
    }
    return(alpha_mask);
}

unsigned int host_to_target_bitmask(unsigned int alpha_mask,
                                    const bitmask_transtbl * trans_tbl)
{
    const bitmask_transtbl *btp;
    unsigned int	x86_mask = 0;

    for(btp = trans_tbl; btp->x86_mask && btp->alpha_mask; btp++) {
	if((alpha_mask & btp->alpha_mask) == btp->alpha_bits) {
	    x86_mask |= btp->x86_bits;
	}
    }
    return(x86_mask);
}

#ifndef NO_THUNK_TYPE_SIZE
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);
}
#endif /* ndef NO_THUNK_TYPE_SIZE */
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
	9	* version 2 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 FB	18	*/
	19	#include <stdlib.h>
	20	#include <stdio.h>
	21	#include <stdarg.h>
	22
3ef693a0	23	#include "qemu.h"
31e31b8a FB	24	#include "thunk.h"
	25
	26	//#define DEBUG
	27
	28	#define MAX_STRUCTS 128
	29
	30	/* XXX: make it dynamic */
24374901	31	StructEntry struct_entries[MAX_STRUCTS];
31e31b8a	32
26553115 JM	33	static const argtype thunk_type_next_ptr(const argtype type_ptr);
26553115 JM	34
31e31b8a FB	35	static inline const argtype thunk_type_next(const argtype type_ptr)
	36	{
	37	int type;
	38
	39	type = *type_ptr++;
	40	switch(type) {
	41	case TYPE_CHAR:
	42	case TYPE_SHORT:
	43	case TYPE_INT:
	44	case TYPE_LONGLONG:
	45	case TYPE_ULONGLONG:
	46	case TYPE_LONG:
	47	case TYPE_ULONG:
	48	case TYPE_PTRVOID:
	49	return type_ptr;
	50	case TYPE_PTR:
26553115	51	return thunk_type_next_ptr(type_ptr);
31e31b8a	52	case TYPE_ARRAY:
26553115	53	return thunk_type_next_ptr(type_ptr + 1);
31e31b8a FB	54	case TYPE_STRUCT:
	55	return type_ptr + 1;
	56	default:
	57	return NULL;
	58	}
	59	}
	60
26553115 JM	61	static const argtype thunk_type_next_ptr(const argtype type_ptr)
	62	{
	63	return thunk_type_next(type_ptr);
	64	}
	65
31e31b8a FB	66	void thunk_register_struct(int id, const char name, const argtype types)
	67	{
	68	const argtype *type_ptr;
	69	StructEntry *se;
	70	int nb_fields, offset, max_align, align, size, i, j;
	71
	72	se = struct_entries + id;
3b46e624	73
31e31b8a FB	74	/* first we count the number of fields */
	75	type_ptr = types;
	76	nb_fields = 0;
	77	while (*type_ptr != TYPE_NULL) {
	78	type_ptr = thunk_type_next(type_ptr);
	79	nb_fields++;
	80	}
	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
	90	for(i = 0;i < 2; i++) {
	91	offset = 0;
	92	max_align = 1;
	93	se->field_offsets[i] = malloc(nb_fields * sizeof(int));
	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	{
	118	StructEntry *se;
	119	se = struct_entries + id;
	120	se = se1;
	121	se->name = name;
	122	}
	123
	124
	125	/* now we can define the main conversion functions */
5fafdf24	126	const argtype thunk_convert(void dst, const void *src,
31e31b8a FB	127	const argtype *type_ptr, int to_host)
	128	{
	129	int type;
	130
	131	type = *type_ptr++;
	132	switch(type) {
	133	case TYPE_CHAR:
	134	(uint8_t )dst = (uint8_t )src;
	135	break;
	136	case TYPE_SHORT:
	137	(uint16_t )dst = tswap16((uint16_t )src);
	138	break;
	139	case TYPE_INT:
	140	(uint32_t )dst = tswap32((uint32_t )src);
	141	break;
	142	case TYPE_LONGLONG:
	143	case TYPE_ULONGLONG:
	144	(uint64_t )dst = tswap64((uint64_t )src);
	145	break;
992f48a0	146	#if HOST_LONG_BITS == 32 && TARGET_ABI_BITS == 32
31e31b8a FB	147	case TYPE_LONG:
	148	case TYPE_ULONG:
	149	case TYPE_PTRVOID:
	150	(uint32_t )dst = tswap32((uint32_t )src);
	151	break;
992f48a0	152	#elif HOST_LONG_BITS == 64 && TARGET_ABI_BITS == 32
31e31b8a FB	153	case TYPE_LONG:
	154	case TYPE_ULONG:
	155	case TYPE_PTRVOID:
d0cd3b8d	156	if (to_host) {
70499c98 FB	157	if (type == TYPE_LONG) {
	158	/* sign extension */
	159	(uint64_t )dst = (int32_t)tswap32((uint32_t )src);
	160	} else {
	161	(uint64_t )dst = tswap32((uint32_t )src);
	162	}
31e31b8a FB	163	} else {
	164	(uint32_t )dst = tswap32((uint64_t )src & 0xffffffff);
	165	}
	166	break;
70499c98 FB	167	#elif HOST_LONG_BITS == 64 && TARGET_ABI_BITS == 64
	168	case TYPE_LONG:
	169	case TYPE_ULONG:
	170	case TYPE_PTRVOID:
	171	(uint64_t )dst = tswap64((uint64_t )src);
	172	break;
	173	#elif HOST_LONG_BITS == 32 && TARGET_ABI_BITS == 64
	174	case TYPE_LONG:
	175	case TYPE_ULONG:
	176	case TYPE_PTRVOID:
	177	if (to_host) {
	178	(uint32_t )dst = tswap64((uint64_t )src);
	179	} else {
	180	if (type == TYPE_LONG) {
	181	/* sign extension */
	182	(uint64_t )dst = tswap64((int32_t )src);
	183	} else {
	184	(uint64_t )dst = tswap64((uint32_t )src);
	185	}
	186	}
	187	break;
31e31b8a	188	#else
64b3ab24	189	#warning unsupported conversion
31e31b8a FB	190	#endif
	191	case TYPE_ARRAY:
	192	{
	193	int array_length, i, dst_size, src_size;
	194	const uint8_t *s;
	195	uint8_t *d;
	196
	197	array_length = *type_ptr++;
	198	dst_size = thunk_type_size(type_ptr, to_host);
	199	src_size = thunk_type_size(type_ptr, 1 - to_host);
	200	d = dst;
	201	s = src;
	202	for(i = 0;i < array_length; i++) {
	203	thunk_convert(d, s, type_ptr, to_host);
	204	d += dst_size;
	205	s += src_size;
	206	}
	207	type_ptr = thunk_type_next(type_ptr);
	208	}
	209	break;
	210	case TYPE_STRUCT:
	211	{
	212	int i;
	213	const StructEntry *se;
	214	const uint8_t *s;
	215	uint8_t *d;
	216	const argtype *field_types;
	217	const int dst_offsets, src_offsets;
3b46e624	218
31e31b8a FB	219	se = struct_entries + *type_ptr++;
	220	if (se->convert[0] != NULL) {
	221	/* specific conversion is needed */
	222	(*se->convert[to_host])(dst, src);
	223	} else {
	224	/* standard struct conversion */
	225	field_types = se->field_types;
	226	dst_offsets = se->field_offsets[to_host];
	227	src_offsets = se->field_offsets[1 - to_host];
	228	d = dst;
	229	s = src;
	230	for(i = 0;i < se->nb_fields; i++) {
5fafdf24 TS	231	field_types = thunk_convert(d + dst_offsets[i],
5fafdf24 TS	232	s + src_offsets[i],
31e31b8a FB	233	field_types, to_host);
	234	}
	235	}
	236	}
	237	break;
	238	default:
	239	fprintf(stderr, "Invalid type 0x%x\n", type);
	240	break;
	241	}
	242	return type_ptr;
	243	}
	244
	245	/* from em86 */
	246
	247	/* Utility function: Table-driven functions to translate bitmasks
	248	* between X86 and Alpha formats...
	249	*/
5fafdf24	250	unsigned int target_to_host_bitmask(unsigned int x86_mask,
b39bc503	251	const bitmask_transtbl * trans_tbl)
31e31b8a	252	{
b39bc503	253	const bitmask_transtbl *btp;
31e31b8a FB	254	unsigned int alpha_mask = 0;
	255
	256	for(btp = trans_tbl; btp->x86_mask && btp->alpha_mask; btp++) {
	257	if((x86_mask & btp->x86_mask) == btp->x86_bits) {
	258	alpha_mask \|= btp->alpha_bits;
	259	}
	260	}
	261	return(alpha_mask);
	262	}
	263
5fafdf24	264	unsigned int host_to_target_bitmask(unsigned int alpha_mask,
b39bc503	265	const bitmask_transtbl * trans_tbl)
31e31b8a	266	{
b39bc503	267	const bitmask_transtbl *btp;
31e31b8a FB	268	unsigned int x86_mask = 0;
	269
	270	for(btp = trans_tbl; btp->x86_mask && btp->alpha_mask; btp++) {
	271	if((alpha_mask & btp->alpha_mask) == btp->alpha_bits) {
7a987127	272	x86_mask \|= btp->x86_bits;
31e31b8a FB	273	}
	274	}
	275	return(x86_mask);
	276	}
26553115 JM	277
	278	#ifndef NO_THUNK_TYPE_SIZE
	279	int thunk_type_size_array(const argtype *type_ptr, int is_host)
	280	{
	281	return thunk_type_size(type_ptr, is_host);
	282	}
	283
	284	int thunk_type_align_array(const argtype *type_ptr, int is_host)
	285	{
	286	return thunk_type_align(type_ptr, is_host);
	287	}
	288	#endif /* ndef NO_THUNK_TYPE_SIZE */