Merge remote-tracking branch 'remotes/mst/tags/for_upstream' into staging
[qemu.git] / target-m68k / m68k-semi.c
blob9dffe8de60d19a2ac8b84dbed63d39d40eaa8ee3
1 /*
2 * m68k/ColdFire Semihosting syscall interface
4 * Copyright (c) 2005-2007 CodeSourcery.
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
11 * This program 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
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, see <http://www.gnu.org/licenses/>.
20 #include <sys/types.h>
21 #include <sys/stat.h>
22 #include <errno.h>
23 #include <fcntl.h>
24 #include <unistd.h>
25 #include <stdlib.h>
26 #include <stdio.h>
27 #include <sys/time.h>
28 #include <time.h>
30 #include "cpu.h"
31 #if defined(CONFIG_USER_ONLY)
32 #include "qemu.h"
33 #define SEMIHOSTING_HEAP_SIZE (128 * 1024 * 1024)
34 #else
35 #include "qemu-common.h"
36 #include "exec/gdbstub.h"
37 #include "exec/softmmu-semi.h"
38 #endif
39 #include "sysemu/sysemu.h"
41 #define HOSTED_EXIT 0
42 #define HOSTED_INIT_SIM 1
43 #define HOSTED_OPEN 2
44 #define HOSTED_CLOSE 3
45 #define HOSTED_READ 4
46 #define HOSTED_WRITE 5
47 #define HOSTED_LSEEK 6
48 #define HOSTED_RENAME 7
49 #define HOSTED_UNLINK 8
50 #define HOSTED_STAT 9
51 #define HOSTED_FSTAT 10
52 #define HOSTED_GETTIMEOFDAY 11
53 #define HOSTED_ISATTY 12
54 #define HOSTED_SYSTEM 13
56 typedef uint32_t gdb_mode_t;
57 typedef uint32_t gdb_time_t;
59 struct m68k_gdb_stat {
60 uint32_t gdb_st_dev; /* device */
61 uint32_t gdb_st_ino; /* inode */
62 gdb_mode_t gdb_st_mode; /* protection */
63 uint32_t gdb_st_nlink; /* number of hard links */
64 uint32_t gdb_st_uid; /* user ID of owner */
65 uint32_t gdb_st_gid; /* group ID of owner */
66 uint32_t gdb_st_rdev; /* device type (if inode device) */
67 uint64_t gdb_st_size; /* total size, in bytes */
68 uint64_t gdb_st_blksize; /* blocksize for filesystem I/O */
69 uint64_t gdb_st_blocks; /* number of blocks allocated */
70 gdb_time_t gdb_st_atime; /* time of last access */
71 gdb_time_t gdb_st_mtime; /* time of last modification */
72 gdb_time_t gdb_st_ctime; /* time of last change */
73 } QEMU_PACKED;
75 struct gdb_timeval {
76 gdb_time_t tv_sec; /* second */
77 uint64_t tv_usec; /* microsecond */
78 } QEMU_PACKED;
80 #define GDB_O_RDONLY 0x0
81 #define GDB_O_WRONLY 0x1
82 #define GDB_O_RDWR 0x2
83 #define GDB_O_APPEND 0x8
84 #define GDB_O_CREAT 0x200
85 #define GDB_O_TRUNC 0x400
86 #define GDB_O_EXCL 0x800
88 static int translate_openflags(int flags)
90 int hf;
92 if (flags & GDB_O_WRONLY)
93 hf = O_WRONLY;
94 else if (flags & GDB_O_RDWR)
95 hf = O_RDWR;
96 else
97 hf = O_RDONLY;
99 if (flags & GDB_O_APPEND) hf |= O_APPEND;
100 if (flags & GDB_O_CREAT) hf |= O_CREAT;
101 if (flags & GDB_O_TRUNC) hf |= O_TRUNC;
102 if (flags & GDB_O_EXCL) hf |= O_EXCL;
104 return hf;
107 static void translate_stat(CPUM68KState *env, target_ulong addr, struct stat *s)
109 struct m68k_gdb_stat *p;
111 if (!(p = lock_user(VERIFY_WRITE, addr, sizeof(struct m68k_gdb_stat), 0)))
112 /* FIXME - should this return an error code? */
113 return;
114 p->gdb_st_dev = cpu_to_be32(s->st_dev);
115 p->gdb_st_ino = cpu_to_be32(s->st_ino);
116 p->gdb_st_mode = cpu_to_be32(s->st_mode);
117 p->gdb_st_nlink = cpu_to_be32(s->st_nlink);
118 p->gdb_st_uid = cpu_to_be32(s->st_uid);
119 p->gdb_st_gid = cpu_to_be32(s->st_gid);
120 p->gdb_st_rdev = cpu_to_be32(s->st_rdev);
121 p->gdb_st_size = cpu_to_be64(s->st_size);
122 #ifdef _WIN32
123 /* Windows stat is missing some fields. */
124 p->gdb_st_blksize = 0;
125 p->gdb_st_blocks = 0;
126 #else
127 p->gdb_st_blksize = cpu_to_be64(s->st_blksize);
128 p->gdb_st_blocks = cpu_to_be64(s->st_blocks);
129 #endif
130 p->gdb_st_atime = cpu_to_be32(s->st_atime);
131 p->gdb_st_mtime = cpu_to_be32(s->st_mtime);
132 p->gdb_st_ctime = cpu_to_be32(s->st_ctime);
133 unlock_user(p, addr, sizeof(struct m68k_gdb_stat));
136 static void m68k_semi_return_u32(CPUM68KState *env, uint32_t ret, uint32_t err)
138 target_ulong args = env->dregs[1];
139 if (put_user_u32(ret, args) ||
140 put_user_u32(err, args + 4)) {
141 /* The m68k semihosting ABI does not provide any way to report this
142 * error to the guest, so the best we can do is log it in qemu.
143 * It is always a guest error not to pass us a valid argument block.
145 qemu_log_mask(LOG_GUEST_ERROR, "m68k-semihosting: return value "
146 "discarded because argument block not writable\n");
150 static void m68k_semi_return_u64(CPUM68KState *env, uint64_t ret, uint32_t err)
152 target_ulong args = env->dregs[1];
153 if (put_user_u32(ret >> 32, args) ||
154 put_user_u32(ret, args + 4) ||
155 put_user_u32(err, args + 8)) {
156 /* No way to report this via m68k semihosting ABI; just log it */
157 qemu_log_mask(LOG_GUEST_ERROR, "m68k-semihosting: return value "
158 "discarded because argument block not writable\n");
162 static int m68k_semi_is_fseek;
164 static void m68k_semi_cb(CPUState *cs, target_ulong ret, target_ulong err)
166 M68kCPU *cpu = M68K_CPU(cs);
167 CPUM68KState *env = &cpu->env;
169 if (m68k_semi_is_fseek) {
170 /* FIXME: We've already lost the high bits of the fseek
171 return value. */
172 m68k_semi_return_u64(env, ret, err);
173 m68k_semi_is_fseek = 0;
174 } else {
175 m68k_semi_return_u32(env, ret, err);
179 /* Read the input value from the argument block; fail the semihosting
180 * call if the memory read fails.
182 #define GET_ARG(n) do { \
183 if (get_user_ual(arg ## n, args + (n) * 4)) { \
184 result = -1; \
185 errno = EFAULT; \
186 goto failed; \
188 } while (0)
190 void do_m68k_semihosting(CPUM68KState *env, int nr)
192 uint32_t args;
193 target_ulong arg0, arg1, arg2, arg3;
194 void *p;
195 void *q;
196 uint32_t len;
197 uint32_t result;
199 args = env->dregs[1];
200 switch (nr) {
201 case HOSTED_EXIT:
202 gdb_exit(env, env->dregs[0]);
203 exit(env->dregs[0]);
204 case HOSTED_OPEN:
205 GET_ARG(0);
206 GET_ARG(1);
207 GET_ARG(2);
208 GET_ARG(3);
209 if (use_gdb_syscalls()) {
210 gdb_do_syscall(m68k_semi_cb, "open,%s,%x,%x", arg0, (int)arg1,
211 arg2, arg3);
212 return;
213 } else {
214 p = lock_user_string(arg0);
215 if (!p) {
216 /* FIXME - check error code? */
217 result = -1;
218 } else {
219 result = open(p, translate_openflags(arg2), arg3);
220 unlock_user(p, arg0, 0);
223 break;
224 case HOSTED_CLOSE:
226 /* Ignore attempts to close stdin/out/err. */
227 GET_ARG(0);
228 int fd = arg0;
229 if (fd > 2) {
230 if (use_gdb_syscalls()) {
231 gdb_do_syscall(m68k_semi_cb, "close,%x", arg0);
232 return;
233 } else {
234 result = close(fd);
236 } else {
237 result = 0;
239 break;
241 case HOSTED_READ:
242 GET_ARG(0);
243 GET_ARG(1);
244 GET_ARG(2);
245 len = arg2;
246 if (use_gdb_syscalls()) {
247 gdb_do_syscall(m68k_semi_cb, "read,%x,%x,%x",
248 arg0, arg1, len);
249 return;
250 } else {
251 p = lock_user(VERIFY_WRITE, arg1, len, 0);
252 if (!p) {
253 /* FIXME - check error code? */
254 result = -1;
255 } else {
256 result = read(arg0, p, len);
257 unlock_user(p, arg1, len);
260 break;
261 case HOSTED_WRITE:
262 GET_ARG(0);
263 GET_ARG(1);
264 GET_ARG(2);
265 len = arg2;
266 if (use_gdb_syscalls()) {
267 gdb_do_syscall(m68k_semi_cb, "write,%x,%x,%x",
268 arg0, arg1, len);
269 return;
270 } else {
271 p = lock_user(VERIFY_READ, arg1, len, 1);
272 if (!p) {
273 /* FIXME - check error code? */
274 result = -1;
275 } else {
276 result = write(arg0, p, len);
277 unlock_user(p, arg0, 0);
280 break;
281 case HOSTED_LSEEK:
283 uint64_t off;
284 GET_ARG(0);
285 GET_ARG(1);
286 GET_ARG(2);
287 GET_ARG(3);
288 off = (uint32_t)arg2 | ((uint64_t)arg1 << 32);
289 if (use_gdb_syscalls()) {
290 m68k_semi_is_fseek = 1;
291 gdb_do_syscall(m68k_semi_cb, "fseek,%x,%lx,%x",
292 arg0, off, arg3);
293 } else {
294 off = lseek(arg0, off, arg3);
295 m68k_semi_return_u64(env, off, errno);
297 return;
299 case HOSTED_RENAME:
300 GET_ARG(0);
301 GET_ARG(1);
302 GET_ARG(2);
303 GET_ARG(3);
304 if (use_gdb_syscalls()) {
305 gdb_do_syscall(m68k_semi_cb, "rename,%s,%s",
306 arg0, (int)arg1, arg2, (int)arg3);
307 return;
308 } else {
309 p = lock_user_string(arg0);
310 q = lock_user_string(arg2);
311 if (!p || !q) {
312 /* FIXME - check error code? */
313 result = -1;
314 } else {
315 result = rename(p, q);
317 unlock_user(p, arg0, 0);
318 unlock_user(q, arg2, 0);
320 break;
321 case HOSTED_UNLINK:
322 GET_ARG(0);
323 GET_ARG(1);
324 if (use_gdb_syscalls()) {
325 gdb_do_syscall(m68k_semi_cb, "unlink,%s",
326 arg0, (int)arg1);
327 return;
328 } else {
329 p = lock_user_string(arg0);
330 if (!p) {
331 /* FIXME - check error code? */
332 result = -1;
333 } else {
334 result = unlink(p);
335 unlock_user(p, arg0, 0);
338 break;
339 case HOSTED_STAT:
340 GET_ARG(0);
341 GET_ARG(1);
342 GET_ARG(2);
343 if (use_gdb_syscalls()) {
344 gdb_do_syscall(m68k_semi_cb, "stat,%s,%x",
345 arg0, (int)arg1, arg2);
346 return;
347 } else {
348 struct stat s;
349 p = lock_user_string(arg0);
350 if (!p) {
351 /* FIXME - check error code? */
352 result = -1;
353 } else {
354 result = stat(p, &s);
355 unlock_user(p, arg0, 0);
357 if (result == 0) {
358 translate_stat(env, arg2, &s);
361 break;
362 case HOSTED_FSTAT:
363 GET_ARG(0);
364 GET_ARG(1);
365 if (use_gdb_syscalls()) {
366 gdb_do_syscall(m68k_semi_cb, "fstat,%x,%x",
367 arg0, arg1);
368 return;
369 } else {
370 struct stat s;
371 result = fstat(arg0, &s);
372 if (result == 0) {
373 translate_stat(env, arg1, &s);
376 break;
377 case HOSTED_GETTIMEOFDAY:
378 GET_ARG(0);
379 GET_ARG(1);
380 if (use_gdb_syscalls()) {
381 gdb_do_syscall(m68k_semi_cb, "gettimeofday,%x,%x",
382 arg0, arg1);
383 return;
384 } else {
385 qemu_timeval tv;
386 struct gdb_timeval *p;
387 result = qemu_gettimeofday(&tv);
388 if (result != 0) {
389 if (!(p = lock_user(VERIFY_WRITE,
390 arg0, sizeof(struct gdb_timeval), 0))) {
391 /* FIXME - check error code? */
392 result = -1;
393 } else {
394 p->tv_sec = cpu_to_be32(tv.tv_sec);
395 p->tv_usec = cpu_to_be64(tv.tv_usec);
396 unlock_user(p, arg0, sizeof(struct gdb_timeval));
400 break;
401 case HOSTED_ISATTY:
402 GET_ARG(0);
403 if (use_gdb_syscalls()) {
404 gdb_do_syscall(m68k_semi_cb, "isatty,%x", arg0);
405 return;
406 } else {
407 result = isatty(arg0);
409 break;
410 case HOSTED_SYSTEM:
411 GET_ARG(0);
412 GET_ARG(1);
413 if (use_gdb_syscalls()) {
414 gdb_do_syscall(m68k_semi_cb, "system,%s",
415 arg0, (int)arg1);
416 return;
417 } else {
418 p = lock_user_string(arg0);
419 if (!p) {
420 /* FIXME - check error code? */
421 result = -1;
422 } else {
423 result = system(p);
424 unlock_user(p, arg0, 0);
427 break;
428 case HOSTED_INIT_SIM:
429 #if defined(CONFIG_USER_ONLY)
431 CPUState *cs = CPU(m68k_env_get_cpu(env));
432 TaskState *ts = cs->opaque;
433 /* Allocate the heap using sbrk. */
434 if (!ts->heap_limit) {
435 abi_ulong ret;
436 uint32_t size;
437 uint32_t base;
439 base = do_brk(0);
440 size = SEMIHOSTING_HEAP_SIZE;
441 /* Try a big heap, and reduce the size if that fails. */
442 for (;;) {
443 ret = do_brk(base + size);
444 if (ret >= (base + size)) {
445 break;
447 size >>= 1;
449 ts->heap_limit = base + size;
451 /* This call may happen before we have writable memory, so return
452 values directly in registers. */
453 env->dregs[1] = ts->heap_limit;
454 env->aregs[7] = ts->stack_base;
456 #else
457 /* FIXME: This is wrong for boards where RAM does not start at
458 address zero. */
459 env->dregs[1] = ram_size;
460 env->aregs[7] = ram_size;
461 #endif
462 return;
463 default:
464 cpu_abort(CPU(m68k_env_get_cpu(env)), "Unsupported semihosting syscall %d\n", nr);
465 result = 0;
467 failed:
468 m68k_semi_return_u32(env, result, errno);