1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28#include "qemu/osdep.h"
29#include "cpu.h"
30#include "chardev/char-fe.h"
31#include "exec/helper-proto.h"
32#include "semihosting/semihost.h"
33#include "qapi/error.h"
34#include "qemu/log.h"
35
36enum {
37 TARGET_SYS_exit = 1,
38 TARGET_SYS_read = 3,
39 TARGET_SYS_write = 4,
40 TARGET_SYS_open = 5,
41 TARGET_SYS_close = 6,
42 TARGET_SYS_lseek = 19,
43 TARGET_SYS_select_one = 29,
44
45 TARGET_SYS_argc = 1000,
46 TARGET_SYS_argv_sz = 1001,
47 TARGET_SYS_argv = 1002,
48 TARGET_SYS_memset = 1004,
49};
50
51enum {
52 SELECT_ONE_READ = 1,
53 SELECT_ONE_WRITE = 2,
54 SELECT_ONE_EXCEPT = 3,
55};
56
57enum {
58 TARGET_EPERM = 1,
59 TARGET_ENOENT = 2,
60 TARGET_ESRCH = 3,
61 TARGET_EINTR = 4,
62 TARGET_EIO = 5,
63 TARGET_ENXIO = 6,
64 TARGET_E2BIG = 7,
65 TARGET_ENOEXEC = 8,
66 TARGET_EBADF = 9,
67 TARGET_ECHILD = 10,
68 TARGET_EAGAIN = 11,
69 TARGET_ENOMEM = 12,
70 TARGET_EACCES = 13,
71 TARGET_EFAULT = 14,
72 TARGET_ENOTBLK = 15,
73 TARGET_EBUSY = 16,
74 TARGET_EEXIST = 17,
75 TARGET_EXDEV = 18,
76 TARGET_ENODEV = 19,
77 TARGET_ENOTDIR = 20,
78 TARGET_EISDIR = 21,
79 TARGET_EINVAL = 22,
80 TARGET_ENFILE = 23,
81 TARGET_EMFILE = 24,
82 TARGET_ENOTTY = 25,
83 TARGET_ETXTBSY = 26,
84 TARGET_EFBIG = 27,
85 TARGET_ENOSPC = 28,
86 TARGET_ESPIPE = 29,
87 TARGET_EROFS = 30,
88 TARGET_EMLINK = 31,
89 TARGET_EPIPE = 32,
90 TARGET_EDOM = 33,
91 TARGET_ERANGE = 34,
92 TARGET_ENOSYS = 88,
93 TARGET_ELOOP = 92,
94};
95
96static uint32_t errno_h2g(int host_errno)
97{
98 switch (host_errno) {
99 case 0: return 0;
100 case EPERM: return TARGET_EPERM;
101 case ENOENT: return TARGET_ENOENT;
102 case ESRCH: return TARGET_ESRCH;
103 case EINTR: return TARGET_EINTR;
104 case EIO: return TARGET_EIO;
105 case ENXIO: return TARGET_ENXIO;
106 case E2BIG: return TARGET_E2BIG;
107 case ENOEXEC: return TARGET_ENOEXEC;
108 case EBADF: return TARGET_EBADF;
109 case ECHILD: return TARGET_ECHILD;
110 case EAGAIN: return TARGET_EAGAIN;
111 case ENOMEM: return TARGET_ENOMEM;
112 case EACCES: return TARGET_EACCES;
113 case EFAULT: return TARGET_EFAULT;
114#ifdef ENOTBLK
115 case ENOTBLK: return TARGET_ENOTBLK;
116#endif
117 case EBUSY: return TARGET_EBUSY;
118 case EEXIST: return TARGET_EEXIST;
119 case EXDEV: return TARGET_EXDEV;
120 case ENODEV: return TARGET_ENODEV;
121 case ENOTDIR: return TARGET_ENOTDIR;
122 case EISDIR: return TARGET_EISDIR;
123 case EINVAL: return TARGET_EINVAL;
124 case ENFILE: return TARGET_ENFILE;
125 case EMFILE: return TARGET_EMFILE;
126 case ENOTTY: return TARGET_ENOTTY;
127#ifdef ETXTBSY
128 case ETXTBSY: return TARGET_ETXTBSY;
129#endif
130 case EFBIG: return TARGET_EFBIG;
131 case ENOSPC: return TARGET_ENOSPC;
132 case ESPIPE: return TARGET_ESPIPE;
133 case EROFS: return TARGET_EROFS;
134 case EMLINK: return TARGET_EMLINK;
135 case EPIPE: return TARGET_EPIPE;
136 case EDOM: return TARGET_EDOM;
137 case ERANGE: return TARGET_ERANGE;
138 case ENOSYS: return TARGET_ENOSYS;
139#ifdef ELOOP
140 case ELOOP: return TARGET_ELOOP;
141#endif
142 };
143
144 return TARGET_EINVAL;
145}
146
147typedef struct XtensaSimConsole {
148 CharBackend be;
149 struct {
150 char buffer[16];
151 size_t offset;
152 } input;
153} XtensaSimConsole;
154
155static XtensaSimConsole *sim_console;
156
157static IOCanReadHandler sim_console_can_read;
158static int sim_console_can_read(void *opaque)
159{
160 XtensaSimConsole *p = opaque;
161
162 return sizeof(p->input.buffer) - p->input.offset;
163}
164
165static IOReadHandler sim_console_read;
166static void sim_console_read(void *opaque, const uint8_t *buf, int size)
167{
168 XtensaSimConsole *p = opaque;
169 size_t copy = sizeof(p->input.buffer) - p->input.offset;
170
171 if (size < copy) {
172 copy = size;
173 }
174 memcpy(p->input.buffer + p->input.offset, buf, copy);
175 p->input.offset += copy;
176}
177
178void xtensa_sim_open_console(Chardev *chr)
179{
180 static XtensaSimConsole console;
181
182 qemu_chr_fe_init(&console.be, chr, &error_abort);
183 qemu_chr_fe_set_handlers(&console.be,
184 sim_console_can_read,
185 sim_console_read,
186 NULL, NULL, &console,
187 NULL, true);
188 sim_console = &console;
189}
190
191void HELPER(simcall)(CPUXtensaState *env)
192{
193 CPUState *cs = env_cpu(env);
194 uint32_t *regs = env->regs;
195
196 switch (regs[2]) {
197 case TARGET_SYS_exit:
198 exit(regs[3]);
199 break;
200
201 case TARGET_SYS_read:
202 case TARGET_SYS_write:
203 {
204 bool is_write = regs[2] == TARGET_SYS_write;
205 uint32_t fd = regs[3];
206 uint32_t vaddr = regs[4];
207 uint32_t len = regs[5];
208 uint32_t len_done = 0;
209
210 while (len > 0) {
211 hwaddr paddr = cpu_get_phys_page_debug(cs, vaddr);
212 uint32_t page_left =
213 TARGET_PAGE_SIZE - (vaddr & (TARGET_PAGE_SIZE - 1));
214 uint32_t io_sz = page_left < len ? page_left : len;
215 hwaddr sz = io_sz;
216 void *buf = cpu_physical_memory_map(paddr, &sz, !is_write);
217 uint32_t io_done;
218 bool error = false;
219
220 if (buf) {
221 vaddr += io_sz;
222 len -= io_sz;
223 if (fd < 3 && sim_console) {
224 if (is_write && (fd == 1 || fd == 2)) {
225 io_done = qemu_chr_fe_write_all(&sim_console->be,
226 buf, io_sz);
227 regs[3] = errno_h2g(errno);
228 } else if (!is_write && fd == 0) {
229 if (sim_console->input.offset) {
230 io_done = sim_console->input.offset;
231 if (io_sz < io_done) {
232 io_done = io_sz;
233 }
234 memcpy(buf, sim_console->input.buffer, io_done);
235 memmove(sim_console->input.buffer,
236 sim_console->input.buffer + io_done,
237 sim_console->input.offset - io_done);
238 sim_console->input.offset -= io_done;
239 qemu_chr_fe_accept_input(&sim_console->be);
240 } else {
241 io_done = -1;
242 regs[3] = TARGET_EAGAIN;
243 }
244 } else {
245 qemu_log_mask(LOG_GUEST_ERROR,
246 "%s fd %d is not supported with chardev console\n",
247 is_write ?
248 "writing to" : "reading from", fd);
249 io_done = -1;
250 regs[3] = TARGET_EBADF;
251 }
252 } else {
253 io_done = is_write ?
254 write(fd, buf, io_sz) :
255 read(fd, buf, io_sz);
256 regs[3] = errno_h2g(errno);
257 }
258 if (io_done == -1) {
259 error = true;
260 io_done = 0;
261 }
262 cpu_physical_memory_unmap(buf, sz, !is_write, io_done);
263 } else {
264 error = true;
265 regs[3] = TARGET_EINVAL;
266 break;
267 }
268 if (error) {
269 if (!len_done) {
270 len_done = -1;
271 }
272 break;
273 }
274 len_done += io_done;
275 if (io_done < io_sz) {
276 break;
277 }
278 }
279 regs[2] = len_done;
280 }
281 break;
282
283 case TARGET_SYS_open:
284 {
285 char name[1024];
286 int rc;
287 int i;
288
289 for (i = 0; i < ARRAY_SIZE(name); ++i) {
290 rc = cpu_memory_rw_debug(cs, regs[3] + i,
291 (uint8_t *)name + i, 1, 0);
292 if (rc != 0 || name[i] == 0) {
293 break;
294 }
295 }
296
297 if (rc == 0 && i < ARRAY_SIZE(name)) {
298 regs[2] = open(name, regs[4], regs[5]);
299 regs[3] = errno_h2g(errno);
300 } else {
301 regs[2] = -1;
302 regs[3] = TARGET_EINVAL;
303 }
304 }
305 break;
306
307 case TARGET_SYS_close:
308 if (regs[3] < 3) {
309 regs[2] = regs[3] = 0;
310 } else {
311 regs[2] = close(regs[3]);
312 regs[3] = errno_h2g(errno);
313 }
314 break;
315
316 case TARGET_SYS_lseek:
317 regs[2] = lseek(regs[3], (off_t)(int32_t)regs[4], regs[5]);
318 regs[3] = errno_h2g(errno);
319 break;
320
321 case TARGET_SYS_select_one:
322 {
323 uint32_t fd = regs[3];
324 uint32_t rq = regs[4];
325 uint32_t target_tv = regs[5];
326 uint32_t target_tvv[2];
327
328 struct timeval tv = {0};
329
330 if (target_tv) {
331 cpu_memory_rw_debug(cs, target_tv,
332 (uint8_t *)target_tvv, sizeof(target_tvv), 0);
333 tv.tv_sec = (int32_t)tswap32(target_tvv[0]);
334 tv.tv_usec = (int32_t)tswap32(target_tvv[1]);
335 }
336 if (fd < 3 && sim_console) {
337 if ((fd == 1 || fd == 2) && rq == SELECT_ONE_WRITE) {
338 regs[2] = 1;
339 } else if (fd == 0 && rq == SELECT_ONE_READ) {
340 regs[2] = sim_console->input.offset > 0;
341 } else {
342 regs[2] = 0;
343 }
344 regs[3] = 0;
345 } else {
346 fd_set fdset;
347
348 FD_ZERO(&fdset);
349 FD_SET(fd, &fdset);
350 regs[2] = select(fd + 1,
351 rq == SELECT_ONE_READ ? &fdset : NULL,
352 rq == SELECT_ONE_WRITE ? &fdset : NULL,
353 rq == SELECT_ONE_EXCEPT ? &fdset : NULL,
354 target_tv ? &tv : NULL);
355 regs[3] = errno_h2g(errno);
356 }
357 }
358 break;
359
360 case TARGET_SYS_argc:
361 regs[2] = semihosting_get_argc();
362 regs[3] = 0;
363 break;
364
365 case TARGET_SYS_argv_sz:
366 {
367 int argc = semihosting_get_argc();
368 int sz = (argc + 1) * sizeof(uint32_t);
369 int i;
370
371 for (i = 0; i < argc; ++i) {
372 sz += 1 + strlen(semihosting_get_arg(i));
373 }
374 regs[2] = sz;
375 regs[3] = 0;
376 }
377 break;
378
379 case TARGET_SYS_argv:
380 {
381 int argc = semihosting_get_argc();
382 int str_offset = (argc + 1) * sizeof(uint32_t);
383 int i;
384 uint32_t argptr;
385
386 for (i = 0; i < argc; ++i) {
387 const char *str = semihosting_get_arg(i);
388 int str_size = strlen(str) + 1;
389
390 argptr = tswap32(regs[3] + str_offset);
391
392 cpu_memory_rw_debug(cs,
393 regs[3] + i * sizeof(uint32_t),
394 (uint8_t *)&argptr, sizeof(argptr), 1);
395 cpu_memory_rw_debug(cs,
396 regs[3] + str_offset,
397 (uint8_t *)str, str_size, 1);
398 str_offset += str_size;
399 }
400 argptr = 0;
401 cpu_memory_rw_debug(cs,
402 regs[3] + i * sizeof(uint32_t),
403 (uint8_t *)&argptr, sizeof(argptr), 1);
404 regs[3] = 0;
405 }
406 break;
407
408 case TARGET_SYS_memset:
409 {
410 uint32_t base = regs[3];
411 uint32_t sz = regs[5];
412
413 while (sz) {
414 hwaddr len = sz;
415 void *buf = cpu_physical_memory_map(base, &len, 1);
416
417 if (buf && len) {
418 memset(buf, regs[4], len);
419 cpu_physical_memory_unmap(buf, len, 1, len);
420 } else {
421 len = 1;
422 }
423 base += len;
424 sz -= len;
425 }
426 regs[2] = regs[3];
427 regs[3] = 0;
428 }
429 break;
430
431 default:
432 qemu_log_mask(LOG_GUEST_ERROR, "%s(%d): not implemented\n", __func__, regs[2]);
433 regs[2] = -1;
434 regs[3] = TARGET_ENOSYS;
435 break;
436 }
437}
438
