Archipelago » qemu

/*

 *  Linux syscalls

 * 

 *  Copyright (c) 2003 Fabrice Bellard

 *

 *  This program is free software; you can redistribute it and/or modify

 *  it under the terms of the GNU General Public License as published by

 *  the Free Software Foundation; either version 2 of the License, or

 *  (at your option) any later version.

 *

 *  This program 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 General Public License for more details.

 *

 *  You should have received a copy of the GNU General Public License

 *  along with this program; if not, write to the Free Software

 *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.

 */

#include <stdlib.h>

#include <stdio.h>

#include <stdarg.h>

#include <string.h>

#include <elf.h>

#include <endian.h>

#include <errno.h>

#include <unistd.h>

#include <fcntl.h>

#include <time.h>

#include <sys/types.h>

#include <sys/wait.h>

#include <sys/time.h>

#include <sys/stat.h>

#include <sys/mount.h>

#include <sys/resource.h>

#include <sys/mman.h>

#include <sys/swap.h>

#include <signal.h>

#include <sched.h>

#include <sys/socket.h>

#include <sys/uio.h>

#include <sys/poll.h>

#include <sys/times.h>

//#include <sys/user.h>

#include <netinet/tcp.h>

#define termios host_termios

#define winsize host_winsize

#define termio host_termio

#define sgttyb host_sgttyb /* same as target */

#define tchars host_tchars /* same as target */

#define ltchars host_ltchars /* same as target */

#include <linux/termios.h>

#include <linux/unistd.h>

#include <linux/utsname.h>

#include <linux/cdrom.h>

#include <linux/hdreg.h>

#include <linux/soundcard.h>

#include <linux/dirent.h>

#include <linux/kd.h>

#include "qemu.h"

//#define DEBUG

//#include <linux/msdos_fs.h>

#define        VFAT_IOCTL_READDIR_BOTH                _IOR('r', 1, struct dirent [2])

#define        VFAT_IOCTL_READDIR_SHORT        _IOR('r', 2, struct dirent [2])

#define __NR_sys_uname __NR_uname

#define __NR_sys_getcwd1 __NR_getcwd

#define __NR_sys_statfs __NR_statfs

#define __NR_sys_fstatfs __NR_fstatfs

#define __NR_sys_getdents __NR_getdents

#define __NR_sys_getdents64 __NR_getdents64

#define __NR_sys_rt_sigqueueinfo __NR_rt_sigqueueinfo

#if defined(__alpha__) || defined (__ia64__)

#define __NR__llseek __NR_lseek

#endif

#ifdef __NR_gettid

_syscall0(int, gettid)

#else

static int gettid(void) {

    return -ENOSYS;

}

#endif

_syscall1(int,sys_uname,struct new_utsname *,buf)

_syscall2(int,sys_getcwd1,char *,buf,size_t,size)

_syscall3(int, sys_getdents, uint, fd, struct dirent *, dirp, uint, count);

_syscall3(int, sys_getdents64, uint, fd, struct dirent64 *, dirp, uint, count);

_syscall5(int, _llseek,  uint,  fd, ulong, hi, ulong, lo,

          loff_t *, res, uint, wh);

_syscall2(int,sys_statfs,const char *,path,struct kernel_statfs *,buf)

_syscall2(int,sys_fstatfs,int,fd,struct kernel_statfs *,buf)

_syscall3(int,sys_rt_sigqueueinfo,int,pid,int,sig,siginfo_t *,uinfo)

#ifdef __NR_exit_group

_syscall1(int,exit_group,int,error_code)

#endif

extern int personality(int);

extern int flock(int, int);

extern int setfsuid(int);

extern int setfsgid(int);

extern int setresuid(uid_t, uid_t, uid_t);

extern int getresuid(uid_t *, uid_t *, uid_t *);

extern int setresgid(gid_t, gid_t, gid_t);

extern int getresgid(gid_t *, gid_t *, gid_t *);

extern int setgroups(int, gid_t *);

static inline long get_errno(long ret)

{

    if (ret == -1)

        return -errno;

    else

        return ret;

}

static inline int is_error(long ret)

{

    return (unsigned long)ret >= (unsigned long)(-4096);

}

static char *target_brk;

static char *target_original_brk;

void target_set_brk(char *new_brk)

{

    target_brk = new_brk;

    target_original_brk = new_brk;

}

static long do_brk(char *new_brk)

{

    char *brk_page;

    long mapped_addr;

    int        new_alloc_size;

    if (!new_brk)

        return (long)target_brk;

    if (new_brk < target_original_brk)

        return -ENOMEM;

    brk_page = (char *)HOST_PAGE_ALIGN((unsigned long)target_brk);

    /* If the new brk is less than this, set it and we're done... */

    if (new_brk < brk_page) {

        target_brk = new_brk;

            return (long)target_brk;

    }

    /* We need to allocate more memory after the brk... */

    new_alloc_size = HOST_PAGE_ALIGN(new_brk - brk_page + 1);

    mapped_addr = get_errno(target_mmap((unsigned long)brk_page, new_alloc_size, 

                                        PROT_READ|PROT_WRITE,

                                        MAP_ANON|MAP_FIXED|MAP_PRIVATE, 0, 0));

    if (is_error(mapped_addr)) {

        return mapped_addr;

    } else {

        target_brk = new_brk;

            return (long)target_brk;

    }

}

static inline fd_set *target_to_host_fds(fd_set *fds, 

                                         target_long *target_fds, int n)

{

#if !defined(BSWAP_NEEDED) && !defined(WORDS_BIGENDIAN)

    return (fd_set *)target_fds;

#else

    int i, b;

    if (target_fds) {

        FD_ZERO(fds);

        for(i = 0;i < n; i++) {

            b = (tswapl(target_fds[i / TARGET_LONG_BITS]) >>

                 (i & (TARGET_LONG_BITS - 1))) & 1;

            if (b)

                FD_SET(i, fds);

        }

        return fds;

    } else {

        return NULL;

    }

#endif

}

static inline void host_to_target_fds(target_long *target_fds, 

                                      fd_set *fds, int n)

{

#if !defined(BSWAP_NEEDED) && !defined(WORDS_BIGENDIAN)

    /* nothing to do */

#else

    int i, nw, j, k;

    target_long v;

    if (target_fds) {

        nw = n / TARGET_LONG_BITS;

        k = 0;

        for(i = 0;i < nw; i++) {

            v = 0;

            for(j = 0; j < TARGET_LONG_BITS; j++) {

                v |= ((FD_ISSET(k, fds) != 0) << j);

                k++;

            }

            target_fds[i] = tswapl(v);

        }

    }

#endif

}

#if defined(__alpha__)

#define HOST_HZ 1024

#else

#define HOST_HZ 100

#endif

static inline long host_to_target_clock_t(long ticks)

{

#if HOST_HZ == TARGET_HZ

    return ticks;

#else

    return ((int64_t)ticks * TARGET_HZ) / HOST_HZ;

#endif

}

static inline void host_to_target_rusage(struct target_rusage *target_rusage, 

                                         const struct rusage *rusage)

{

    target_rusage->ru_utime.tv_sec = tswapl(rusage->ru_utime.tv_sec);

    target_rusage->ru_utime.tv_usec = tswapl(rusage->ru_utime.tv_usec);

    target_rusage->ru_stime.tv_sec = tswapl(rusage->ru_stime.tv_sec);

    target_rusage->ru_stime.tv_usec = tswapl(rusage->ru_stime.tv_usec);

    target_rusage->ru_maxrss = tswapl(rusage->ru_maxrss);

    target_rusage->ru_ixrss = tswapl(rusage->ru_ixrss);

    target_rusage->ru_idrss = tswapl(rusage->ru_idrss);

    target_rusage->ru_isrss = tswapl(rusage->ru_isrss);

    target_rusage->ru_minflt = tswapl(rusage->ru_minflt);

    target_rusage->ru_majflt = tswapl(rusage->ru_majflt);

    target_rusage->ru_nswap = tswapl(rusage->ru_nswap);

    target_rusage->ru_inblock = tswapl(rusage->ru_inblock);

    target_rusage->ru_oublock = tswapl(rusage->ru_oublock);

    target_rusage->ru_msgsnd = tswapl(rusage->ru_msgsnd);

    target_rusage->ru_msgrcv = tswapl(rusage->ru_msgrcv);

    target_rusage->ru_nsignals = tswapl(rusage->ru_nsignals);

    target_rusage->ru_nvcsw = tswapl(rusage->ru_nvcsw);

    target_rusage->ru_nivcsw = tswapl(rusage->ru_nivcsw);

}

static inline void target_to_host_timeval(struct timeval *tv, 

                                          const struct target_timeval *target_tv)

{

    tv->tv_sec = tswapl(target_tv->tv_sec);

    tv->tv_usec = tswapl(target_tv->tv_usec);

}

static inline void host_to_target_timeval(struct target_timeval *target_tv, 

                                          const struct timeval *tv)

{

    target_tv->tv_sec = tswapl(tv->tv_sec);

    target_tv->tv_usec = tswapl(tv->tv_usec);

}

static long do_select(long n, 

                      target_long *target_rfds, target_long *target_wfds, 

                      target_long *target_efds, struct target_timeval *target_tv)

{

    fd_set rfds, wfds, efds;

    fd_set *rfds_ptr, *wfds_ptr, *efds_ptr;

    struct timeval tv, *tv_ptr;

    long ret;

    rfds_ptr = target_to_host_fds(&rfds, target_rfds, n);

    wfds_ptr = target_to_host_fds(&wfds, target_wfds, n);

    efds_ptr = target_to_host_fds(&efds, target_efds, n);

    if (target_tv) {

        target_to_host_timeval(&tv, target_tv);

        tv_ptr = &tv;

    } else {

        tv_ptr = NULL;

    }

    ret = get_errno(select(n, rfds_ptr, wfds_ptr, efds_ptr, tv_ptr));

    if (!is_error(ret)) {

        host_to_target_fds(target_rfds, rfds_ptr, n);

        host_to_target_fds(target_wfds, wfds_ptr, n);

        host_to_target_fds(target_efds, efds_ptr, n);

        if (target_tv) {

            host_to_target_timeval(target_tv, &tv);

        }

    }

    return ret;

}

static inline void target_to_host_sockaddr(struct sockaddr *addr,

                                           struct target_sockaddr *target_addr,

                                           socklen_t len)

{

    memcpy(addr, target_addr, len);

    addr->sa_family = tswap16(target_addr->sa_family);

}

static inline void host_to_target_sockaddr(struct target_sockaddr *target_addr,

                                           struct sockaddr *addr,

                                           socklen_t len)

{

    memcpy(target_addr, addr, len);

    target_addr->sa_family = tswap16(addr->sa_family);

}

static inline void target_to_host_cmsg(struct msghdr *msgh,

                                       struct target_msghdr *target_msgh)

{

    struct cmsghdr *cmsg = CMSG_FIRSTHDR(msgh);

    struct target_cmsghdr *target_cmsg = TARGET_CMSG_FIRSTHDR(target_msgh);

    socklen_t space = 0;

    while (cmsg && target_cmsg) {

        void *data = CMSG_DATA(cmsg);

        void *target_data = TARGET_CMSG_DATA(target_cmsg);

        int len = tswapl(target_cmsg->cmsg_len) 

                  - TARGET_CMSG_ALIGN(sizeof (struct target_cmsghdr));

        space += CMSG_SPACE(len);

        if (space > msgh->msg_controllen) {

            space -= CMSG_SPACE(len);

            gemu_log("Host cmsg overflow");

            break;

        }

        cmsg->cmsg_level = tswap32(target_cmsg->cmsg_level);

        cmsg->cmsg_type = tswap32(target_cmsg->cmsg_type);

        cmsg->cmsg_len = CMSG_LEN(len);

        if (cmsg->cmsg_level != SOL_SOCKET || cmsg->cmsg_type != SCM_RIGHTS) {

            gemu_log("Unsupported ancillary data: %d/%d\n", cmsg->cmsg_level, cmsg->cmsg_type);

            memcpy(data, target_data, len);

        } else {

            int *fd = (int *)data;

            int *target_fd = (int *)target_data;

            int i, numfds = len / sizeof(int);

            for (i = 0; i < numfds; i++)

                fd[i] = tswap32(target_fd[i]);

        }

        cmsg = CMSG_NXTHDR(msgh, cmsg);

        target_cmsg = TARGET_CMSG_NXTHDR(target_msgh, target_cmsg);

    }

    msgh->msg_controllen = space;

}

static inline void host_to_target_cmsg(struct target_msghdr *target_msgh,

                                       struct msghdr *msgh)

{

    struct cmsghdr *cmsg = CMSG_FIRSTHDR(msgh);

    struct target_cmsghdr *target_cmsg = TARGET_CMSG_FIRSTHDR(target_msgh);

    socklen_t space = 0;

    while (cmsg && target_cmsg) {

        void *data = CMSG_DATA(cmsg);

        void *target_data = TARGET_CMSG_DATA(target_cmsg);

        int len = cmsg->cmsg_len - CMSG_ALIGN(sizeof (struct cmsghdr));

        space += TARGET_CMSG_SPACE(len);

        if (space > tswapl(target_msgh->msg_controllen)) {

            space -= TARGET_CMSG_SPACE(len);

            gemu_log("Target cmsg overflow");

            break;

        }

        target_cmsg->cmsg_level = tswap32(cmsg->cmsg_level);

        target_cmsg->cmsg_type = tswap32(cmsg->cmsg_type);

        target_cmsg->cmsg_len = tswapl(TARGET_CMSG_LEN(len));

        if (cmsg->cmsg_level != SOL_SOCKET || cmsg->cmsg_type != SCM_RIGHTS) {

            gemu_log("Unsupported ancillary data: %d/%d\n", cmsg->cmsg_level, cmsg->cmsg_type);

            memcpy(target_data, data, len);

        } else {

            int *fd = (int *)data;

            int *target_fd = (int *)target_data;

            int i, numfds = len / sizeof(int);

            for (i = 0; i < numfds; i++)

                target_fd[i] = tswap32(fd[i]);

        }

        cmsg = CMSG_NXTHDR(msgh, cmsg);

        target_cmsg = TARGET_CMSG_NXTHDR(target_msgh, target_cmsg);

    }

    msgh->msg_controllen = tswapl(space);

}

static long do_setsockopt(int sockfd, int level, int optname, 

                          void *optval, socklen_t optlen)

{

    if (level == SOL_TCP) {

        /* TCP options all take an 'int' value.  */

        int val;

        if (optlen < sizeof(uint32_t))

            return -EINVAL;

        val = tswap32(*(uint32_t *)optval);

        return get_errno(setsockopt(sockfd, level, optname, &val, sizeof(val)));

    }

    else if (level != SOL_SOCKET) {

        gemu_log("Unsupported setsockopt level: %d\n", level);

        return -ENOSYS;

    }

    switch (optname) {

    /* Options with 'int' argument.  */

    case SO_DEBUG:

    case SO_REUSEADDR:

    case SO_TYPE:

    case SO_ERROR:

    case SO_DONTROUTE:

    case SO_BROADCAST:

    case SO_SNDBUF:

    case SO_RCVBUF:

    case SO_KEEPALIVE:

    case SO_OOBINLINE:

    case SO_NO_CHECK:

    case SO_PRIORITY:

    case SO_BSDCOMPAT:

    case SO_PASSCRED:

    case SO_TIMESTAMP:

    case SO_RCVLOWAT:

    case SO_RCVTIMEO:

    case SO_SNDTIMEO:

    {

        int val;

        if (optlen < sizeof(uint32_t))

            return -EINVAL;

        val = tswap32(*(uint32_t *)optval);

        return get_errno(setsockopt(sockfd, level, optname, &val, sizeof(val)));

    }

    default:

        gemu_log("Unsupported setsockopt SOL_SOCKET option: %d\n", optname);

        return -ENOSYS;

    }

}

static long do_getsockopt(int sockfd, int level, int optname, 

                          void *optval, socklen_t *optlen)

{

    gemu_log("getsockopt not yet supported\n");

    return -ENOSYS;

}

static long do_socketcall(int num, int32_t *vptr)

{

    long ret;

    switch(num) {

    case SOCKOP_socket:

        {

            int domain = tswap32(vptr[0]);

            int type = tswap32(vptr[1]);

            int protocol = tswap32(vptr[2]);

            ret = get_errno(socket(domain, type, protocol));

        }

        break;

    case SOCKOP_bind:

        {

            int sockfd = tswap32(vptr[0]);

            void *target_addr = (void *)tswap32(vptr[1]);

            socklen_t addrlen = tswap32(vptr[2]);

            void *addr = alloca(addrlen);

            target_to_host_sockaddr(addr, target_addr, addrlen);

            ret = get_errno(bind(sockfd, addr, addrlen));

        }

        break;

    case SOCKOP_connect:

        {

            int sockfd = tswap32(vptr[0]);

            void *target_addr = (void *)tswap32(vptr[1]);

            socklen_t addrlen = tswap32(vptr[2]);

            void *addr = alloca(addrlen);

            target_to_host_sockaddr(addr, target_addr, addrlen);

            ret = get_errno(connect(sockfd, addr, addrlen));

        }

        break;

    case SOCKOP_listen:

        {

            int sockfd = tswap32(vptr[0]);

            int backlog = tswap32(vptr[1]);

            ret = get_errno(listen(sockfd, backlog));

        }

        break;

    case SOCKOP_accept:

        {

            int sockfd = tswap32(vptr[0]);

            void *target_addr = (void *)tswap32(vptr[1]);

            uint32_t *target_addrlen = (void *)tswap32(vptr[2]);

            socklen_t addrlen = tswap32(*target_addrlen);

            void *addr = alloca(addrlen);

            ret = get_errno(accept(sockfd, addr, &addrlen));

            if (!is_error(ret)) {

                host_to_target_sockaddr(target_addr, addr, addrlen);

                *target_addrlen = tswap32(addrlen);

            }

        }

        break;

    case SOCKOP_getsockname:

        {

            int sockfd = tswap32(vptr[0]);

            void *target_addr = (void *)tswap32(vptr[1]);

            uint32_t *target_addrlen = (void *)tswap32(vptr[2]);

            socklen_t addrlen = tswap32(*target_addrlen);

            void *addr = alloca(addrlen);

            ret = get_errno(getsockname(sockfd, addr, &addrlen));

            if (!is_error(ret)) {

                host_to_target_sockaddr(target_addr, addr, addrlen);

                *target_addrlen = tswap32(addrlen);

            }

        }

        break;

    case SOCKOP_getpeername:

        {

            int sockfd = tswap32(vptr[0]);

            void *target_addr = (void *)tswap32(vptr[1]);

            uint32_t *target_addrlen = (void *)tswap32(vptr[2]);

            socklen_t addrlen = tswap32(*target_addrlen);

            void *addr = alloca(addrlen);

            ret = get_errno(getpeername(sockfd, addr, &addrlen));

            if (!is_error(ret)) {

                host_to_target_sockaddr(target_addr, addr, addrlen);

                *target_addrlen = tswap32(addrlen);

            }

        }

        break;

    case SOCKOP_socketpair:

        {

            int domain = tswap32(vptr[0]);

            int type = tswap32(vptr[1]);

            int protocol = tswap32(vptr[2]);

            int32_t *target_tab = (void *)tswap32(vptr[3]);

            int tab[2];

            ret = get_errno(socketpair(domain, type, protocol, tab));

            if (!is_error(ret)) {

                target_tab[0] = tswap32(tab[0]);

                target_tab[1] = tswap32(tab[1]);

            }

        }

        break;

    case SOCKOP_send:

        {

            int sockfd = tswap32(vptr[0]);

            void *msg = (void *)tswap32(vptr[1]);

            size_t len = tswap32(vptr[2]);

            int flags = tswap32(vptr[3]);

            ret = get_errno(send(sockfd, msg, len, flags));

        }

        break;

    case SOCKOP_recv:

        {

            int sockfd = tswap32(vptr[0]);

            void *msg = (void *)tswap32(vptr[1]);

            size_t len = tswap32(vptr[2]);

            int flags = tswap32(vptr[3]);

            ret = get_errno(recv(sockfd, msg, len, flags));

        }

        break;

    case SOCKOP_sendto:

        {

            int sockfd = tswap32(vptr[0]);

            void *msg = (void *)tswap32(vptr[1]);

            size_t len = tswap32(vptr[2]);

            int flags = tswap32(vptr[3]);

            void *target_addr = (void *)tswap32(vptr[4]);

            socklen_t addrlen = tswap32(vptr[5]);

            void *addr = alloca(addrlen);

            target_to_host_sockaddr(addr, target_addr, addrlen);

            ret = get_errno(sendto(sockfd, msg, len, flags, addr, addrlen));

        }

        break;

    case SOCKOP_recvfrom:

        {

            int sockfd = tswap32(vptr[0]);

            void *msg = (void *)tswap32(vptr[1]);

            size_t len = tswap32(vptr[2]);

            int flags = tswap32(vptr[3]);

            void *target_addr = (void *)tswap32(vptr[4]);

            uint32_t *target_addrlen = (void *)tswap32(vptr[5]);

            socklen_t addrlen = tswap32(*target_addrlen);

            void *addr = alloca(addrlen);

            ret = get_errno(recvfrom(sockfd, msg, len, flags, addr, &addrlen));

            if (!is_error(ret)) {

                host_to_target_sockaddr(target_addr, addr, addrlen);

                *target_addrlen = tswap32(addrlen);

            }

        }

        break;

    case SOCKOP_shutdown:

        {

            int sockfd = tswap32(vptr[0]);

            int how = tswap32(vptr[1]);

            ret = get_errno(shutdown(sockfd, how));

        }

        break;

    case SOCKOP_sendmsg:

    case SOCKOP_recvmsg:

        {

            int fd;

            struct target_msghdr *msgp;

            struct msghdr msg;

            int flags, count, i;

            struct iovec *vec;

            struct target_iovec *target_vec;

            msgp = (void *)tswap32(vptr[1]);

            msg.msg_name = (void *)tswapl(msgp->msg_name);

            msg.msg_namelen = tswapl(msgp->msg_namelen);

            msg.msg_controllen = 2 * tswapl(msgp->msg_controllen);

            msg.msg_control = alloca(msg.msg_controllen);

            msg.msg_flags = tswap32(msgp->msg_flags);

            count = tswapl(msgp->msg_iovlen);

            vec = alloca(count * sizeof(struct iovec));

            target_vec = (void *)tswapl(msgp->msg_iov);

            for(i = 0;i < count; i++) {

                vec[i].iov_base = (void *)tswapl(target_vec[i].iov_base);

                vec[i].iov_len = tswapl(target_vec[i].iov_len);

            }

            msg.msg_iovlen = count;

            msg.msg_iov = vec;

            fd = tswap32(vptr[0]);

            flags = tswap32(vptr[2]);

            if (num == SOCKOP_sendmsg) {

                target_to_host_cmsg(&msg, msgp);

                ret = get_errno(sendmsg(fd, &msg, flags));

            } else {

                ret = get_errno(recvmsg(fd, &msg, flags));

                if (!is_error(ret))

                  host_to_target_cmsg(msgp, &msg);

            }

        }

        break;

    case SOCKOP_setsockopt:

        {

            int sockfd = tswap32(vptr[0]);

            int level = tswap32(vptr[1]);

            int optname = tswap32(vptr[2]);

            void *optval = (void *)tswap32(vptr[3]);

            socklen_t optlen = tswap32(vptr[4]);

            ret = do_setsockopt(sockfd, level, optname, optval, optlen);

        }

        break;

    case SOCKOP_getsockopt:

        {

            int sockfd = tswap32(vptr[0]);

            int level = tswap32(vptr[1]);

            int optname = tswap32(vptr[2]);

            void *optval = (void *)tswap32(vptr[3]);

            uint32_t *target_len = (void *)tswap32(vptr[4]);

            socklen_t optlen = tswap32(*target_len);

            ret = do_getsockopt(sockfd, level, optname, optval, &optlen);

            if (!is_error(ret))

                *target_len = tswap32(optlen);

        }

        break;

    default:

        gemu_log("Unsupported socketcall: %d\n", num);

        ret = -ENOSYS;

        break;

    }

    return ret;

}

/* kernel structure types definitions */

#define IFNAMSIZ        16

#define STRUCT(name, list...) STRUCT_ ## name,

#define STRUCT_SPECIAL(name) STRUCT_ ## name,

enum {

#include "syscall_types.h"

};

#undef STRUCT

#undef STRUCT_SPECIAL

#define STRUCT(name, list...) const argtype struct_ ## name ## _def[] = { list, TYPE_NULL };

#define STRUCT_SPECIAL(name)

#include "syscall_types.h"

#undef STRUCT

#undef STRUCT_SPECIAL

typedef struct IOCTLEntry {

    unsigned int target_cmd;

    unsigned int host_cmd;

    const char *name;

    int access;

    const argtype arg_type[5];

} IOCTLEntry;

#define IOC_R 0x0001

#define IOC_W 0x0002

#define IOC_RW (IOC_R | IOC_W)

#define MAX_STRUCT_SIZE 4096

IOCTLEntry ioctl_entries[] = {

#define IOCTL(cmd, access, types...) \

    { TARGET_ ## cmd, cmd, #cmd, access, { types } },

#include "ioctls.h"

    { 0, 0, },

};

static long do_ioctl(long fd, long cmd, long arg)

{

    const IOCTLEntry *ie;

    const argtype *arg_type;

    long ret;

    uint8_t buf_temp[MAX_STRUCT_SIZE];

    ie = ioctl_entries;

    for(;;) {

        if (ie->target_cmd == 0) {

            gemu_log("Unsupported ioctl: cmd=0x%04lx\n", cmd);

            return -ENOSYS;

        }

        if (ie->target_cmd == cmd)

            break;

        ie++;

    }

    arg_type = ie->arg_type;

#if defined(DEBUG)

    gemu_log("ioctl: cmd=0x%04lx (%s)\n", cmd, ie->name);

#endif

    switch(arg_type[0]) {

    case TYPE_NULL:

        /* no argument */

        ret = get_errno(ioctl(fd, ie->host_cmd));

        break;

    case TYPE_PTRVOID:

    case TYPE_INT:

        /* int argment */

        ret = get_errno(ioctl(fd, ie->host_cmd, arg));

        break;

    case TYPE_PTR:

        arg_type++;

        switch(ie->access) {

        case IOC_R:

            ret = get_errno(ioctl(fd, ie->host_cmd, buf_temp));

            if (!is_error(ret)) {

                thunk_convert((void *)arg, buf_temp, arg_type, THUNK_TARGET);

            }

            break;

        case IOC_W:

            thunk_convert(buf_temp, (void *)arg, arg_type, THUNK_HOST);

            ret = get_errno(ioctl(fd, ie->host_cmd, buf_temp));

            break;

        default:

        case IOC_RW:

            thunk_convert(buf_temp, (void *)arg, arg_type, THUNK_HOST);

            ret = get_errno(ioctl(fd, ie->host_cmd, buf_temp));

            if (!is_error(ret)) {

                thunk_convert((void *)arg, buf_temp, arg_type, THUNK_TARGET);

            }

            break;

        }

        break;

    default:

        gemu_log("Unsupported ioctl type: cmd=0x%04lx type=%d\n", cmd, arg_type[0]);

        ret = -ENOSYS;

        break;

    }

    return ret;

}

bitmask_transtbl iflag_tbl[] = {

        { TARGET_IGNBRK, TARGET_IGNBRK, IGNBRK, IGNBRK },

        { TARGET_BRKINT, TARGET_BRKINT, BRKINT, BRKINT },

        { TARGET_IGNPAR, TARGET_IGNPAR, IGNPAR, IGNPAR },

        { TARGET_PARMRK, TARGET_PARMRK, PARMRK, PARMRK },

        { TARGET_INPCK, TARGET_INPCK, INPCK, INPCK },

        { TARGET_ISTRIP, TARGET_ISTRIP, ISTRIP, ISTRIP },

        { TARGET_INLCR, TARGET_INLCR, INLCR, INLCR },

        { TARGET_IGNCR, TARGET_IGNCR, IGNCR, IGNCR },

        { TARGET_ICRNL, TARGET_ICRNL, ICRNL, ICRNL },

        { TARGET_IUCLC, TARGET_IUCLC, IUCLC, IUCLC },

        { TARGET_IXON, TARGET_IXON, IXON, IXON },

        { TARGET_IXANY, TARGET_IXANY, IXANY, IXANY },

        { TARGET_IXOFF, TARGET_IXOFF, IXOFF, IXOFF },

        { TARGET_IMAXBEL, TARGET_IMAXBEL, IMAXBEL, IMAXBEL },

        { 0, 0, 0, 0 }

};

bitmask_transtbl oflag_tbl[] = {

        { TARGET_OPOST, TARGET_OPOST, OPOST, OPOST },

        { TARGET_OLCUC, TARGET_OLCUC, OLCUC, OLCUC },

        { TARGET_ONLCR, TARGET_ONLCR, ONLCR, ONLCR },

        { TARGET_OCRNL, TARGET_OCRNL, OCRNL, OCRNL },

        { TARGET_ONOCR, TARGET_ONOCR, ONOCR, ONOCR },

        { TARGET_ONLRET, TARGET_ONLRET, ONLRET, ONLRET },

        { TARGET_OFILL, TARGET_OFILL, OFILL, OFILL },

        { TARGET_OFDEL, TARGET_OFDEL, OFDEL, OFDEL },

        { TARGET_NLDLY, TARGET_NL0, NLDLY, NL0 },

        { TARGET_NLDLY, TARGET_NL1, NLDLY, NL1 },

        { TARGET_CRDLY, TARGET_CR0, CRDLY, CR0 },

        { TARGET_CRDLY, TARGET_CR1, CRDLY, CR1 },

        { TARGET_CRDLY, TARGET_CR2, CRDLY, CR2 },

        { TARGET_CRDLY, TARGET_CR3, CRDLY, CR3 },

        { TARGET_TABDLY, TARGET_TAB0, TABDLY, TAB0 },

        { TARGET_TABDLY, TARGET_TAB1, TABDLY, TAB1 },

        { TARGET_TABDLY, TARGET_TAB2, TABDLY, TAB2 },

        { TARGET_TABDLY, TARGET_TAB3, TABDLY, TAB3 },

        { TARGET_BSDLY, TARGET_BS0, BSDLY, BS0 },

        { TARGET_BSDLY, TARGET_BS1, BSDLY, BS1 },

        { TARGET_VTDLY, TARGET_VT0, VTDLY, VT0 },

        { TARGET_VTDLY, TARGET_VT1, VTDLY, VT1 },

        { TARGET_FFDLY, TARGET_FF0, FFDLY, FF0 },

        { TARGET_FFDLY, TARGET_FF1, FFDLY, FF1 },

        { 0, 0, 0, 0 }

};

bitmask_transtbl cflag_tbl[] = {

        { TARGET_CBAUD, TARGET_B0, CBAUD, B0 },

        { TARGET_CBAUD, TARGET_B50, CBAUD, B50 },

        { TARGET_CBAUD, TARGET_B75, CBAUD, B75 },

        { TARGET_CBAUD, TARGET_B110, CBAUD, B110 },

        { TARGET_CBAUD, TARGET_B134, CBAUD, B134 },

        { TARGET_CBAUD, TARGET_B150, CBAUD, B150 },

        { TARGET_CBAUD, TARGET_B200, CBAUD, B200 },

        { TARGET_CBAUD, TARGET_B300, CBAUD, B300 },

        { TARGET_CBAUD, TARGET_B600, CBAUD, B600 },

        { TARGET_CBAUD, TARGET_B1200, CBAUD, B1200 },

        { TARGET_CBAUD, TARGET_B1800, CBAUD, B1800 },

        { TARGET_CBAUD, TARGET_B2400, CBAUD, B2400 },

        { TARGET_CBAUD, TARGET_B4800, CBAUD, B4800 },

        { TARGET_CBAUD, TARGET_B9600, CBAUD, B9600 },

        { TARGET_CBAUD, TARGET_B19200, CBAUD, B19200 },

        { TARGET_CBAUD, TARGET_B38400, CBAUD, B38400 },

        { TARGET_CBAUD, TARGET_B57600, CBAUD, B57600 },

        { TARGET_CBAUD, TARGET_B115200, CBAUD, B115200 },

        { TARGET_CBAUD, TARGET_B230400, CBAUD, B230400 },

        { TARGET_CBAUD, TARGET_B460800, CBAUD, B460800 },

        { TARGET_CSIZE, TARGET_CS5, CSIZE, CS5 },

        { TARGET_CSIZE, TARGET_CS6, CSIZE, CS6 },

        { TARGET_CSIZE, TARGET_CS7, CSIZE, CS7 },

        { TARGET_CSIZE, TARGET_CS8, CSIZE, CS8 },

        { TARGET_CSTOPB, TARGET_CSTOPB, CSTOPB, CSTOPB },

        { TARGET_CREAD, TARGET_CREAD, CREAD, CREAD },

        { TARGET_PARENB, TARGET_PARENB, PARENB, PARENB },

        { TARGET_PARODD, TARGET_PARODD, PARODD, PARODD },

        { TARGET_HUPCL, TARGET_HUPCL, HUPCL, HUPCL },

        { TARGET_CLOCAL, TARGET_CLOCAL, CLOCAL, CLOCAL },

        { TARGET_CRTSCTS, TARGET_CRTSCTS, CRTSCTS, CRTSCTS },

        { 0, 0, 0, 0 }

};

bitmask_transtbl lflag_tbl[] = {

        { TARGET_ISIG, TARGET_ISIG, ISIG, ISIG },

        { TARGET_ICANON, TARGET_ICANON, ICANON, ICANON },

        { TARGET_XCASE, TARGET_XCASE, XCASE, XCASE },

        { TARGET_ECHO, TARGET_ECHO, ECHO, ECHO },

        { TARGET_ECHOE, TARGET_ECHOE, ECHOE, ECHOE },

        { TARGET_ECHOK, TARGET_ECHOK, ECHOK, ECHOK },

        { TARGET_ECHONL, TARGET_ECHONL, ECHONL, ECHONL },

        { TARGET_NOFLSH, TARGET_NOFLSH, NOFLSH, NOFLSH },

        { TARGET_TOSTOP, TARGET_TOSTOP, TOSTOP, TOSTOP },

        { TARGET_ECHOCTL, TARGET_ECHOCTL, ECHOCTL, ECHOCTL },

        { TARGET_ECHOPRT, TARGET_ECHOPRT, ECHOPRT, ECHOPRT },

        { TARGET_ECHOKE, TARGET_ECHOKE, ECHOKE, ECHOKE },

        { TARGET_FLUSHO, TARGET_FLUSHO, FLUSHO, FLUSHO },

        { TARGET_PENDIN, TARGET_PENDIN, PENDIN, PENDIN },

        { TARGET_IEXTEN, TARGET_IEXTEN, IEXTEN, IEXTEN },