qemu/target-xtensa/xtensa-semi.c
<<
>>
Prefs
   1/*
   2 * Copyright (c) 2011, Max Filippov, Open Source and Linux Lab.
   3 * All rights reserved.
   4 *
   5 * Redistribution and use in source and binary forms, with or without
   6 * modification, are permitted provided that the following conditions are met:
   7 *     * Redistributions of source code must retain the above copyright
   8 *       notice, this list of conditions and the following disclaimer.
   9 *     * Redistributions in binary form must reproduce the above copyright
  10 *       notice, this list of conditions and the following disclaimer in the
  11 *       documentation and/or other materials provided with the distribution.
  12 *     * Neither the name of the Open Source and Linux Lab nor the
  13 *       names of its contributors may be used to endorse or promote products
  14 *       derived from this software without specific prior written permission.
  15 *
  16 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  17 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  19 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
  20 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
  21 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
  22 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
  23 * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  24 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
  25 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  26 */
  27
  28#include <errno.h>
  29#include <unistd.h>
  30#include <string.h>
  31#include <stddef.h>
  32#include "cpu.h"
  33#include "exec/helper-proto.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    static const uint32_t guest_errno[] = {
  99        [EPERM]         = TARGET_EPERM,
 100        [ENOENT]        = TARGET_ENOENT,
 101        [ESRCH]         = TARGET_ESRCH,
 102        [EINTR]         = TARGET_EINTR,
 103        [EIO]           = TARGET_EIO,
 104        [ENXIO]         = TARGET_ENXIO,
 105        [E2BIG]         = TARGET_E2BIG,
 106        [ENOEXEC]       = TARGET_ENOEXEC,
 107        [EBADF]         = TARGET_EBADF,
 108        [ECHILD]        = TARGET_ECHILD,
 109        [EAGAIN]        = TARGET_EAGAIN,
 110        [ENOMEM]        = TARGET_ENOMEM,
 111        [EACCES]        = TARGET_EACCES,
 112        [EFAULT]        = TARGET_EFAULT,
 113#ifdef ENOTBLK
 114        [ENOTBLK]       = TARGET_ENOTBLK,
 115#endif
 116        [EBUSY]         = TARGET_EBUSY,
 117        [EEXIST]        = TARGET_EEXIST,
 118        [EXDEV]         = TARGET_EXDEV,
 119        [ENODEV]        = TARGET_ENODEV,
 120        [ENOTDIR]       = TARGET_ENOTDIR,
 121        [EISDIR]        = TARGET_EISDIR,
 122        [EINVAL]        = TARGET_EINVAL,
 123        [ENFILE]        = TARGET_ENFILE,
 124        [EMFILE]        = TARGET_EMFILE,
 125        [ENOTTY]        = TARGET_ENOTTY,
 126#ifdef ETXTBSY
 127        [ETXTBSY]       = TARGET_ETXTBSY,
 128#endif
 129        [EFBIG]         = TARGET_EFBIG,
 130        [ENOSPC]        = TARGET_ENOSPC,
 131        [ESPIPE]        = TARGET_ESPIPE,
 132        [EROFS]         = TARGET_EROFS,
 133        [EMLINK]        = TARGET_EMLINK,
 134        [EPIPE]         = TARGET_EPIPE,
 135        [EDOM]          = TARGET_EDOM,
 136        [ERANGE]        = TARGET_ERANGE,
 137        [ENOSYS]        = TARGET_ENOSYS,
 138#ifdef ELOOP
 139        [ELOOP]         = TARGET_ELOOP,
 140#endif
 141    };
 142
 143    if (host_errno == 0) {
 144        return 0;
 145    } else if (host_errno > 0 && host_errno < ARRAY_SIZE(guest_errno) &&
 146            guest_errno[host_errno]) {
 147        return guest_errno[host_errno];
 148    } else {
 149        return TARGET_EINVAL;
 150    }
 151}
 152
 153void HELPER(simcall)(CPUXtensaState *env)
 154{
 155    CPUState *cs = CPU(xtensa_env_get_cpu(env));
 156    uint32_t *regs = env->regs;
 157
 158    switch (regs[2]) {
 159    case TARGET_SYS_exit:
 160        qemu_log("exit(%d) simcall\n", regs[3]);
 161        exit(regs[3]);
 162        break;
 163
 164    case TARGET_SYS_read:
 165    case TARGET_SYS_write:
 166        {
 167            bool is_write = regs[2] == TARGET_SYS_write;
 168            uint32_t fd = regs[3];
 169            uint32_t vaddr = regs[4];
 170            uint32_t len = regs[5];
 171
 172            while (len > 0) {
 173                hwaddr paddr = cpu_get_phys_page_debug(cs, vaddr);
 174                uint32_t page_left =
 175                    TARGET_PAGE_SIZE - (vaddr & (TARGET_PAGE_SIZE - 1));
 176                uint32_t io_sz = page_left < len ? page_left : len;
 177                hwaddr sz = io_sz;
 178                void *buf = cpu_physical_memory_map(paddr, &sz, is_write);
 179
 180                if (buf) {
 181                    vaddr += io_sz;
 182                    len -= io_sz;
 183                    regs[2] = is_write ?
 184                        write(fd, buf, io_sz) :
 185                        read(fd, buf, io_sz);
 186                    regs[3] = errno_h2g(errno);
 187                    cpu_physical_memory_unmap(buf, sz, is_write, sz);
 188                    if (regs[2] == -1) {
 189                        break;
 190                    }
 191                } else {
 192                    regs[2] = -1;
 193                    regs[3] = TARGET_EINVAL;
 194                    break;
 195                }
 196            }
 197        }
 198        break;
 199
 200    case TARGET_SYS_open:
 201        {
 202            char name[1024];
 203            int rc;
 204            int i;
 205
 206            for (i = 0; i < ARRAY_SIZE(name); ++i) {
 207                rc = cpu_memory_rw_debug(cs, regs[3] + i,
 208                                         (uint8_t *)name + i, 1, 0);
 209                if (rc != 0 || name[i] == 0) {
 210                    break;
 211                }
 212            }
 213
 214            if (rc == 0 && i < ARRAY_SIZE(name)) {
 215                regs[2] = open(name, regs[4], regs[5]);
 216                regs[3] = errno_h2g(errno);
 217            } else {
 218                regs[2] = -1;
 219                regs[3] = TARGET_EINVAL;
 220            }
 221        }
 222        break;
 223
 224    case TARGET_SYS_close:
 225        if (regs[3] < 3) {
 226            regs[2] = regs[3] = 0;
 227        } else {
 228            regs[2] = close(regs[3]);
 229            regs[3] = errno_h2g(errno);
 230        }
 231        break;
 232
 233    case TARGET_SYS_lseek:
 234        regs[2] = lseek(regs[3], (off_t)(int32_t)regs[4], regs[5]);
 235        regs[3] = errno_h2g(errno);
 236        break;
 237
 238    case TARGET_SYS_select_one:
 239        {
 240            uint32_t fd = regs[3];
 241            uint32_t rq = regs[4];
 242            uint32_t target_tv = regs[5];
 243            uint32_t target_tvv[2];
 244
 245            struct timeval tv = {0};
 246            fd_set fdset;
 247
 248            FD_ZERO(&fdset);
 249            FD_SET(fd, &fdset);
 250
 251            if (target_tv) {
 252                cpu_memory_rw_debug(cs, target_tv,
 253                        (uint8_t *)target_tvv, sizeof(target_tvv), 0);
 254                tv.tv_sec = (int32_t)tswap32(target_tvv[0]);
 255                tv.tv_usec = (int32_t)tswap32(target_tvv[1]);
 256            }
 257            regs[2] = select(fd + 1,
 258                    rq == SELECT_ONE_READ   ? &fdset : NULL,
 259                    rq == SELECT_ONE_WRITE  ? &fdset : NULL,
 260                    rq == SELECT_ONE_EXCEPT ? &fdset : NULL,
 261                    target_tv ? &tv : NULL);
 262            regs[3] = errno_h2g(errno);
 263        }
 264        break;
 265
 266    case TARGET_SYS_argc:
 267        regs[2] = 1;
 268        regs[3] = 0;
 269        break;
 270
 271    case TARGET_SYS_argv_sz:
 272        regs[2] = 128;
 273        regs[3] = 0;
 274        break;
 275
 276    case TARGET_SYS_argv:
 277        {
 278            struct Argv {
 279                uint32_t argptr[2];
 280                char text[120];
 281            } argv = {
 282                {0, 0},
 283                "test"
 284            };
 285
 286            argv.argptr[0] = tswap32(regs[3] + offsetof(struct Argv, text));
 287            cpu_memory_rw_debug(cs,
 288                                regs[3], (uint8_t *)&argv, sizeof(argv), 1);
 289        }
 290        break;
 291
 292    case TARGET_SYS_memset:
 293        {
 294            uint32_t base = regs[3];
 295            uint32_t sz = regs[5];
 296
 297            while (sz) {
 298                hwaddr len = sz;
 299                void *buf = cpu_physical_memory_map(base, &len, 1);
 300
 301                if (buf && len) {
 302                    memset(buf, regs[4], len);
 303                    cpu_physical_memory_unmap(buf, len, 1, len);
 304                } else {
 305                    len = 1;
 306                }
 307                base += len;
 308                sz -= len;
 309            }
 310            regs[2] = regs[3];
 311            regs[3] = 0;
 312        }
 313        break;
 314
 315    default:
 316        qemu_log("%s(%d): not implemented\n", __func__, regs[2]);
 317        regs[2] = -1;
 318        regs[3] = TARGET_ENOSYS;
 319        break;
 320    }
 321}
 322