pci: Change error_report to assert(3)
[qemu/ar7.git] / thunk.c
blob0718325d86e34d5259f550d90f3f9966b17374f5
1 /*
2 * Generic thunking code to convert data between host and target CPU
4 * Copyright (c) 2003 Fabrice Bellard
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.
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.
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/>.
19 #include "qemu/osdep.h"
21 #include "qemu.h"
22 #include "exec/user/thunk.h"
24 //#define DEBUG
26 static unsigned int max_struct_entries;
27 StructEntry *struct_entries;
29 static const argtype *thunk_type_next_ptr(const argtype *type_ptr);
31 static inline const argtype *thunk_type_next(const argtype *type_ptr)
33 int type;
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;
58 static const argtype *thunk_type_next_ptr(const argtype *type_ptr)
60 return thunk_type_next(type_ptr);
63 void thunk_register_struct(int id, const char *name, const argtype *types)
65 const argtype *type_ptr;
66 StructEntry *se;
67 int nb_fields, offset, max_align, align, size, i, j;
69 assert(id < max_struct_entries);
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++;
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 */
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);
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
114 void thunk_register_struct_direct(int id, const char *name,
115 const StructEntry *se1)
117 StructEntry *se;
119 assert(id < max_struct_entries);
120 se = struct_entries + id;
121 *se = *se1;
122 se->name = name;
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)
130 int type;
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);
164 } else {
165 *(uint32_t *)dst = tswap32(*(uint64_t *)src & 0xffffffff);
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);
188 break;
189 #else
190 #warning unsupported conversion
191 #endif
192 case TYPE_OLDDEVT:
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;
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;
217 break;
219 case TYPE_ARRAY:
221 int array_length, i, dst_size, src_size;
222 const uint8_t *s;
223 uint8_t *d;
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;
235 type_ptr = thunk_type_next(type_ptr);
237 break;
238 case TYPE_STRUCT:
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;
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);
266 break;
267 default:
268 fprintf(stderr, "Invalid type 0x%x\n", type);
269 break;
271 return type_ptr;
274 const argtype *thunk_print(void *arg, const argtype *type_ptr)
276 int type;
278 type = *type_ptr++;
280 switch (type) {
281 case TYPE_CHAR:
282 qemu_log("%c", *(uint8_t *)arg);
283 break;
284 case TYPE_SHORT:
285 qemu_log("%" PRId16, tswap16(*(uint16_t *)arg));
286 break;
287 case TYPE_INT:
288 qemu_log("%" PRId32, tswap32(*(uint32_t *)arg));
289 break;
290 case TYPE_LONGLONG:
291 qemu_log("%" PRId64, tswap64(*(uint64_t *)arg));
292 break;
293 case TYPE_ULONGLONG:
294 qemu_log("%" PRIu64, tswap64(*(uint64_t *)arg));
295 break;
296 #if HOST_LONG_BITS == 32 && TARGET_ABI_BITS == 32
297 case TYPE_PTRVOID:
298 qemu_log("0x%" PRIx32, tswap32(*(uint32_t *)arg));
299 break;
300 case TYPE_LONG:
301 qemu_log("%" PRId32, tswap32(*(uint32_t *)arg));
302 break;
303 case TYPE_ULONG:
304 qemu_log("%" PRIu32, tswap32(*(uint32_t *)arg));
305 break;
306 #elif HOST_LONG_BITS == 64 && TARGET_ABI_BITS == 32
307 case TYPE_PTRVOID:
308 qemu_log("0x%" PRIx32, tswap32(*(uint64_t *)arg & 0xffffffff));
309 break;
310 case TYPE_LONG:
311 qemu_log("%" PRId32, tswap32(*(uint64_t *)arg & 0xffffffff));
312 break;
313 case TYPE_ULONG:
314 qemu_log("%" PRIu32, tswap32(*(uint64_t *)arg & 0xffffffff));
315 break;
316 #elif HOST_LONG_BITS == 64 && TARGET_ABI_BITS == 64
317 case TYPE_PTRVOID:
318 qemu_log("0x%" PRIx64, tswap64(*(uint64_t *)arg));
319 break;
320 case TYPE_LONG:
321 qemu_log("%" PRId64, tswap64(*(uint64_t *)arg));
322 break;
323 case TYPE_ULONG:
324 qemu_log("%" PRIu64, tswap64(*(uint64_t *)arg));
325 break;
326 #else
327 case TYPE_PTRVOID:
328 qemu_log("0x%" PRIx64, tswap64(*(uint64_t *)arg));
329 break;
330 case TYPE_LONG:
331 qemu_log("%" PRId64, tswap64(*(uint64_t *)arg));
332 break;
333 case TYPE_ULONG:
334 qemu_log("%" PRIu64, tswap64(*(uint64_t *)arg));
335 break;
336 #endif
337 case TYPE_OLDDEVT:
339 uint64_t val = 0;
340 switch (thunk_type_size(type_ptr - 1, 1)) {
341 case 2:
342 val = *(uint16_t *)arg;
343 break;
344 case 4:
345 val = *(uint32_t *)arg;
346 break;
347 case 8:
348 val = *(uint64_t *)arg;
349 break;
351 switch (thunk_type_size(type_ptr - 1, 0)) {
352 case 2:
353 qemu_log("%" PRIu16, tswap16(val));
354 break;
355 case 4:
356 qemu_log("%" PRIu32, tswap32(val));
357 break;
358 case 8:
359 qemu_log("%" PRIu64, tswap64(val));
360 break;
363 break;
364 case TYPE_ARRAY:
366 int i, array_length, arg_size;
367 uint8_t *a;
368 int is_string = 0;
370 array_length = *type_ptr++;
371 arg_size = thunk_type_size(type_ptr, 0);
372 a = arg;
374 if (*type_ptr == TYPE_CHAR) {
375 qemu_log("\"");
376 is_string = 1;
377 } else {
378 qemu_log("[");
381 for (i = 0; i < array_length; i++) {
382 if (i > 0 && !is_string) {
383 qemu_log(",");
385 thunk_print(a, type_ptr);
386 a += arg_size;
389 if (is_string) {
390 qemu_log("\"");
391 } else {
392 qemu_log("]");
395 type_ptr = thunk_type_next(type_ptr);
397 break;
398 case TYPE_STRUCT:
400 int i;
401 const StructEntry *se;
402 uint8_t *a;
403 const argtype *field_types;
404 const int *arg_offsets;
406 se = struct_entries + *type_ptr++;
408 if (se->print != NULL) {
409 se->print(arg);
410 } else {
411 a = arg;
413 field_types = se->field_types;
414 arg_offsets = se->field_offsets[0];
416 qemu_log("{");
417 for (i = 0; i < se->nb_fields; i++) {
418 if (i > 0) {
419 qemu_log(",");
421 field_types = thunk_print(a + arg_offsets[i], field_types);
423 qemu_log("}");
426 break;
427 default:
428 g_assert_not_reached();
430 return type_ptr;
433 /* from em86 */
435 /* Utility function: Table-driven functions to translate bitmasks
436 * between host and target formats
438 unsigned int target_to_host_bitmask(unsigned int target_mask,
439 const bitmask_transtbl * trans_tbl)
441 const bitmask_transtbl *btp;
442 unsigned int host_mask = 0;
444 for (btp = trans_tbl; btp->target_mask && btp->host_mask; btp++) {
445 if ((target_mask & btp->target_mask) == btp->target_bits) {
446 host_mask |= btp->host_bits;
449 return host_mask;
452 unsigned int host_to_target_bitmask(unsigned int host_mask,
453 const bitmask_transtbl * trans_tbl)
455 const bitmask_transtbl *btp;
456 unsigned int target_mask = 0;
458 for (btp = trans_tbl; btp->target_mask && btp->host_mask; btp++) {
459 if ((host_mask & btp->host_mask) == btp->host_bits) {
460 target_mask |= btp->target_bits;
463 return target_mask;
466 int thunk_type_size_array(const argtype *type_ptr, int is_host)
468 return thunk_type_size(type_ptr, is_host);
471 int thunk_type_align_array(const argtype *type_ptr, int is_host)
473 return thunk_type_align(type_ptr, is_host);
476 void thunk_init(unsigned int max_structs)
478 max_struct_entries = max_structs;
479 struct_entries = g_new0(StructEntry, max_structs);