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/ipc.h>

#include <sys/msg.h>

#include <sys/wait.h>

#include <sys/time.h>

#include <sys/stat.h>

#include <sys/mount.h>

#include <sys/prctl.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/shm.h>

#include <sys/sem.h>

#include <sys/statfs.h>

#include <utime.h>

#include <sys/sysinfo.h>

//#include <sys/user.h>

#include <netinet/ip.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

#if defined(TARGET_I386) || defined(TARGET_ARM) || defined(TARGET_SPARC) \

    || defined(TARGET_M68K) || defined(TARGET_SH4)

/* 16 bit uid wrappers emulation */

#define USE_UID16

#endif

//#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])

#undef _syscall0

#undef _syscall1

#undef _syscall2

#undef _syscall3

#undef _syscall4

#undef _syscall5

#undef _syscall6

#define _syscall0(type,name)                \

type name (void)                        \

{                                        \

        return syscall(__NR_##name);        \

}

#define _syscall1(type,name,type1,arg1)                \

type name (type1 arg1)                                \

{                                                \

        return syscall(__NR_##name, arg1);        \

}

#define _syscall2(type,name,type1,arg1,type2,arg2)        \

type name (type1 arg1,type2 arg2)                        \

{                                                        \

        return syscall(__NR_##name, arg1, arg2);        \

}

#define _syscall3(type,name,type1,arg1,type2,arg2,type3,arg3)        \

type name (type1 arg1,type2 arg2,type3 arg3)                        \

{                                                                \

        return syscall(__NR_##name, arg1, arg2, arg3);                \

}

#define _syscall4(type,name,type1,arg1,type2,arg2,type3,arg3,type4,arg4)        \

type name (type1 arg1,type2 arg2,type3 arg3,type4 arg4)                                \

{                                                                                \

        return syscall(__NR_##name, arg1, arg2, arg3, arg4);                        \

}

#define _syscall5(type,name,type1,arg1,type2,arg2,type3,arg3,type4,arg4,        \

                  type5,arg5)                                                        \

type name (type1 arg1,type2 arg2,type3 arg3,type4 arg4,type5 arg5)                \

{                                                                                \

        return syscall(__NR_##name, arg1, arg2, arg3, arg4, arg5);                \

}

#define _syscall6(type,name,type1,arg1,type2,arg2,type3,arg3,type4,arg4,        \

                  type5,arg5,type6,arg6)                                        \

type name (type1 arg1,type2 arg2,type3 arg3,type4 arg4,type5 arg5,type6 arg6)        \

{                                                                                \

        return syscall(__NR_##name, arg1, arg2, arg3, arg4, arg5, arg6);        \

}

#define __NR_sys_uname __NR_uname

#define __NR_sys_faccessat __NR_faccessat

#define __NR_sys_fchmodat __NR_fchmodat

#define __NR_sys_fchownat __NR_fchownat

#define __NR_sys_getcwd1 __NR_getcwd

#define __NR_sys_getdents __NR_getdents

#define __NR_sys_getdents64 __NR_getdents64

#define __NR_sys_linkat __NR_linkat

#define __NR_sys_mkdirat __NR_mkdirat

#define __NR_sys_mknodat __NR_mknodat

#define __NR_sys_openat __NR_openat

#define __NR_sys_readlinkat __NR_readlinkat

#define __NR_sys_renameat __NR_renameat

#define __NR_sys_rt_sigqueueinfo __NR_rt_sigqueueinfo

#define __NR_sys_symlinkat __NR_symlinkat

#define __NR_sys_syslog __NR_syslog

#define __NR_sys_tgkill __NR_tgkill

#define __NR_sys_tkill __NR_tkill

#define __NR_sys_unlinkat __NR_unlinkat

#define __NR_sys_utimensat __NR_utimensat

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

#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)

#if defined(TARGET_NR_faccessat) && defined(__NR_faccessat)

_syscall4(int,sys_faccessat,int,dirfd,const char *,pathname,int,mode,int,flags)

#endif

#if defined(TARGET_NR_fchmodat) && defined(__NR_fchmodat)

_syscall4(int,sys_fchmodat,int,dirfd,const char *,pathname,

          mode_t,mode,int,flags)

#endif

#if defined(TARGET_NR_fchownat) && defined(__NR_fchownat)

_syscall5(int,sys_fchownat,int,dirfd,const char *,pathname,

          uid_t,owner,gid_t,group,int,flags)

#endif

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

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

#if defined(TARGET_NR_getdents64) && defined(__NR_getdents64)

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

#endif

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

          loff_t *, res, uint, wh);

#if defined(TARGET_NR_linkat) && defined(__NR_linkat)

_syscall5(int,sys_linkat,int,olddirfd,const char *,oldpath,

          int,newdirfd,const char *,newpath,int,flags)

#endif

#if defined(TARGET_NR_mkdirat) && defined(__NR_mkdirat)

_syscall3(int,sys_mkdirat,int,dirfd,const char *,pathname,mode_t,mode)

#endif

#if defined(TARGET_NR_mknodat) && defined(__NR_mknodat)

_syscall4(int,sys_mknodat,int,dirfd,const char *,pathname,

          mode_t,mode,dev_t,dev)

#endif

#if defined(TARGET_NR_openat) && defined(__NR_openat)

_syscall4(int,sys_openat,int,dirfd,const char *,pathname,int,flags,mode_t,mode)

#endif

#if defined(TARGET_NR_readlinkat) && defined(__NR_readlinkat)

_syscall4(int,sys_readlinkat,int,dirfd,const char *,pathname,

          char *,buf,size_t,bufsize)

#endif

#if defined(TARGET_NR_renameat) && defined(__NR_renameat)

_syscall4(int,sys_renameat,int,olddirfd,const char *,oldpath,

          int,newdirfd,const char *,newpath)

#endif

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

#if defined(TARGET_NR_symlinkat) && defined(__NR_symlinkat)

_syscall3(int,sys_symlinkat,const char *,oldpath,

          int,newdirfd,const char *,newpath)

#endif

_syscall3(int,sys_syslog,int,type,char*,bufp,int,len)

#if defined(TARGET_NR_tgkill) && defined(__NR_tgkill)

_syscall3(int,sys_tgkill,int,tgid,int,pid,int,sig)

#endif

#if defined(TARGET_NR_tkill) && defined(__NR_tkill)

_syscall2(int,sys_tkill,int,tid,int,sig)

#endif

#ifdef __NR_exit_group

_syscall1(int,exit_group,int,error_code)

#endif

#if defined(TARGET_NR_set_tid_address) && defined(__NR_set_tid_address)

_syscall1(int,set_tid_address,int *,tidptr)

#endif

#if defined(TARGET_NR_unlinkat) && defined(__NR_unlinkat)

_syscall3(int,sys_unlinkat,int,dirfd,const char *,pathname,int,flags)

#endif

#if defined(TARGET_NR_utimensat) && defined(__NR_utimensat)

_syscall4(int,sys_utimensat,int,dirfd,const char *,pathname,

          const struct timespec *,tsp,int,flags)

#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 *);

/*

 * This list is the union of errno values overridden in asm-<arch>/errno.h

 * minus the errnos that are not actually generic to all archs.

 */

static uint16_t host_to_target_errno_table[1200] = {

    [EIDRM]                = TARGET_EIDRM,

    [ECHRNG]                = TARGET_ECHRNG,

    [EL2NSYNC]                = TARGET_EL2NSYNC,

    [EL3HLT]                = TARGET_EL3HLT,

    [EL3RST]                = TARGET_EL3RST,

    [ELNRNG]                = TARGET_ELNRNG,

    [EUNATCH]                = TARGET_EUNATCH,

    [ENOCSI]                = TARGET_ENOCSI,

    [EL2HLT]                = TARGET_EL2HLT,

    [EDEADLK]                = TARGET_EDEADLK,

    [ENOLCK]                = TARGET_ENOLCK,

    [EBADE]                = TARGET_EBADE,

    [EBADR]                = TARGET_EBADR,

    [EXFULL]                = TARGET_EXFULL,

    [ENOANO]                = TARGET_ENOANO,

    [EBADRQC]                = TARGET_EBADRQC,

    [EBADSLT]                = TARGET_EBADSLT,

    [EBFONT]                = TARGET_EBFONT,

    [ENOSTR]                = TARGET_ENOSTR,

    [ENODATA]                = TARGET_ENODATA,

    [ETIME]                = TARGET_ETIME,

    [ENOSR]                = TARGET_ENOSR,

    [ENONET]                = TARGET_ENONET,

    [ENOPKG]                = TARGET_ENOPKG,

    [EREMOTE]                = TARGET_EREMOTE,

    [ENOLINK]                = TARGET_ENOLINK,

    [EADV]                = TARGET_EADV,

    [ESRMNT]                = TARGET_ESRMNT,

    [ECOMM]                = TARGET_ECOMM,

    [EPROTO]                = TARGET_EPROTO,

    [EDOTDOT]                = TARGET_EDOTDOT,

    [EMULTIHOP]                = TARGET_EMULTIHOP,

    [EBADMSG]                = TARGET_EBADMSG,

    [ENAMETOOLONG]        = TARGET_ENAMETOOLONG,

    [EOVERFLOW]                = TARGET_EOVERFLOW,

    [ENOTUNIQ]                = TARGET_ENOTUNIQ,

    [EBADFD]                = TARGET_EBADFD,

    [EREMCHG]                = TARGET_EREMCHG,

    [ELIBACC]                = TARGET_ELIBACC,

    [ELIBBAD]                = TARGET_ELIBBAD,

    [ELIBSCN]                = TARGET_ELIBSCN,

    [ELIBMAX]                = TARGET_ELIBMAX,

    [ELIBEXEC]                = TARGET_ELIBEXEC,

    [EILSEQ]                = TARGET_EILSEQ,

    [ENOSYS]                = TARGET_ENOSYS,

    [ELOOP]                = TARGET_ELOOP,

    [ERESTART]                = TARGET_ERESTART,

    [ESTRPIPE]                = TARGET_ESTRPIPE,

    [ENOTEMPTY]                = TARGET_ENOTEMPTY,

    [EUSERS]                = TARGET_EUSERS,

    [ENOTSOCK]                = TARGET_ENOTSOCK,

    [EDESTADDRREQ]        = TARGET_EDESTADDRREQ,

    [EMSGSIZE]                = TARGET_EMSGSIZE,

    [EPROTOTYPE]        = TARGET_EPROTOTYPE,

    [ENOPROTOOPT]        = TARGET_ENOPROTOOPT,

    [EPROTONOSUPPORT]        = TARGET_EPROTONOSUPPORT,

    [ESOCKTNOSUPPORT]        = TARGET_ESOCKTNOSUPPORT,

    [EOPNOTSUPP]        = TARGET_EOPNOTSUPP,

    [EPFNOSUPPORT]        = TARGET_EPFNOSUPPORT,

    [EAFNOSUPPORT]        = TARGET_EAFNOSUPPORT,

    [EADDRINUSE]        = TARGET_EADDRINUSE,

    [EADDRNOTAVAIL]        = TARGET_EADDRNOTAVAIL,

    [ENETDOWN]                = TARGET_ENETDOWN,

    [ENETUNREACH]        = TARGET_ENETUNREACH,

    [ENETRESET]                = TARGET_ENETRESET,

    [ECONNABORTED]        = TARGET_ECONNABORTED,

    [ECONNRESET]        = TARGET_ECONNRESET,

    [ENOBUFS]                = TARGET_ENOBUFS,

    [EISCONN]                = TARGET_EISCONN,

    [ENOTCONN]                = TARGET_ENOTCONN,

    [EUCLEAN]                = TARGET_EUCLEAN,

    [ENOTNAM]                = TARGET_ENOTNAM,

    [ENAVAIL]                = TARGET_ENAVAIL,

    [EISNAM]                = TARGET_EISNAM,

    [EREMOTEIO]                = TARGET_EREMOTEIO,

    [ESHUTDOWN]                = TARGET_ESHUTDOWN,

    [ETOOMANYREFS]        = TARGET_ETOOMANYREFS,

    [ETIMEDOUT]                = TARGET_ETIMEDOUT,

    [ECONNREFUSED]        = TARGET_ECONNREFUSED,

    [EHOSTDOWN]                = TARGET_EHOSTDOWN,

    [EHOSTUNREACH]        = TARGET_EHOSTUNREACH,

    [EALREADY]                = TARGET_EALREADY,

    [EINPROGRESS]        = TARGET_EINPROGRESS,

    [ESTALE]                = TARGET_ESTALE,

    [ECANCELED]                = TARGET_ECANCELED,

    [ENOMEDIUM]                = TARGET_ENOMEDIUM,

    [EMEDIUMTYPE]        = TARGET_EMEDIUMTYPE,

#ifdef ENOKEY

    [ENOKEY]                = TARGET_ENOKEY,

#endif

#ifdef EKEYEXPIRED

    [EKEYEXPIRED]        = TARGET_EKEYEXPIRED,

#endif

#ifdef EKEYREVOKED

    [EKEYREVOKED]        = TARGET_EKEYREVOKED,

#endif

#ifdef EKEYREJECTED

    [EKEYREJECTED]        = TARGET_EKEYREJECTED,

#endif

#ifdef EOWNERDEAD

    [EOWNERDEAD]        = TARGET_EOWNERDEAD,

#endif

#ifdef ENOTRECOVERABLE

    [ENOTRECOVERABLE]        = TARGET_ENOTRECOVERABLE,

#endif

        };

static inline int host_to_target_errno(int err)

{

    if(host_to_target_errno_table[err])

        return host_to_target_errno_table[err];

    return err;

}

static inline target_long get_errno(target_long ret)

{

    if (ret == -1)

        return -host_to_target_errno(errno);

    else

        return ret;

}

static inline int is_error(target_long ret)

{

    return (target_ulong)ret >= (target_ulong)(-4096);

}

static target_ulong target_brk;

static target_ulong target_original_brk;

void target_set_brk(target_ulong new_brk)

{

    target_original_brk = target_brk = HOST_PAGE_ALIGN(new_brk);

}

target_long do_brk(target_ulong new_brk)

{

    target_ulong brk_page;

    target_long mapped_addr;

    int        new_alloc_size;

    if (!new_brk)

        return target_brk;

    if (new_brk < target_original_brk)

        return -ENOMEM;

    brk_page = HOST_PAGE_ALIGN(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 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(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 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 - 1) / 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 target_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(target_ulong target_addr,

                                         const struct rusage *rusage)

{

    struct target_rusage *target_rusage;

    lock_user_struct(target_rusage, target_addr, 0);

    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);

    unlock_user_struct(target_rusage, target_addr, 1);

}

static inline void target_to_host_timeval(struct timeval *tv,

                                          target_ulong target_addr)

{

    struct target_timeval *target_tv;

    lock_user_struct(target_tv, target_addr, 1);

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

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

    unlock_user_struct(target_tv, target_addr, 0);

}

static inline void host_to_target_timeval(target_ulong target_addr,

                                          const struct timeval *tv)

{

    struct target_timeval *target_tv;

    lock_user_struct(target_tv, target_addr, 0);

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

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

    unlock_user_struct(target_tv, target_addr, 1);

}

static target_long do_select(int n,

                             target_ulong rfd_p, target_ulong wfd_p,

                             target_ulong efd_p, target_ulong target_tv)

{

    fd_set rfds, wfds, efds;

    fd_set *rfds_ptr, *wfds_ptr, *efds_ptr;

    target_long *target_rfds, *target_wfds, *target_efds;

    struct timeval tv, *tv_ptr;

    target_long ret;

    int ok;

    if (rfd_p) {

        target_rfds = lock_user(rfd_p, sizeof(target_long) * n, 1);

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

    } else {

        target_rfds = NULL;

        rfds_ptr = NULL;

    }

    if (wfd_p) {

        target_wfds = lock_user(wfd_p, sizeof(target_long) * n, 1);

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

    } else {

        target_wfds = NULL;

        wfds_ptr = NULL;

    }

    if (efd_p) {

        target_efds = lock_user(efd_p, sizeof(target_long) * n, 1);

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

    } else {

        target_efds = NULL;

        efds_ptr = NULL;

    }

    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));

    ok = !is_error(ret);

    if (ok) {

        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);

        }

    }

    if (target_rfds)

        unlock_user(target_rfds, rfd_p, ok ? sizeof(target_long) * n : 0);

    if (target_wfds)

        unlock_user(target_wfds, wfd_p, ok ? sizeof(target_long) * n : 0);

    if (target_efds)

        unlock_user(target_efds, efd_p, ok ? sizeof(target_long) * n : 0);

    return ret;

}

static inline void target_to_host_sockaddr(struct sockaddr *addr,

                                           target_ulong target_addr,

                                           socklen_t len)

{

    struct target_sockaddr *target_saddr;

    target_saddr = lock_user(target_addr, len, 1);

    memcpy(addr, target_saddr, len);

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

    unlock_user(target_saddr, target_addr, 0);

}

static inline void host_to_target_sockaddr(target_ulong target_addr,

                                           struct sockaddr *addr,

                                           socklen_t len)

{

    struct target_sockaddr *target_saddr;

    target_saddr = lock_user(target_addr, len, 0);

    memcpy(target_saddr, addr, len);

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

    unlock_user(target_saddr, target_addr, len);

}

/* ??? Should this also swap msgh->name?  */

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\n");

            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 != TARGET_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;

}

/* ??? Should this also swap msgh->name?  */

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\n");

            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 != TARGET_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 target_long do_setsockopt(int sockfd, int level, int optname,

                                 target_ulong optval, socklen_t optlen)

{

    target_long ret;

    int val;

    switch(level) {

    case SOL_TCP:

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

        if (optlen < sizeof(uint32_t))

            return -EINVAL;

        val = tget32(optval);

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

        break;

    case SOL_IP:

        switch(optname) {

        case IP_TOS:

        case IP_TTL:

        case IP_HDRINCL:

        case IP_ROUTER_ALERT:

        case IP_RECVOPTS:

        case IP_RETOPTS:

        case IP_PKTINFO:

        case IP_MTU_DISCOVER:

        case IP_RECVERR:

        case IP_RECVTOS:

#ifdef IP_FREEBIND

        case IP_FREEBIND:

#endif

        case IP_MULTICAST_TTL:

        case IP_MULTICAST_LOOP:

            val = 0;

            if (optlen >= sizeof(uint32_t)) {

                val = tget32(optval);

            } else if (optlen >= 1) {

                val = tget8(optval);

            }

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

            break;

        default:

            goto unimplemented;

        }

        break;

    case TARGET_SOL_SOCKET:

        switch (optname) {

            /* Options with 'int' argument.  */

        case TARGET_SO_DEBUG:

                optname = SO_DEBUG;

                break;

        case TARGET_SO_REUSEADDR:

                optname = SO_REUSEADDR;

                break;

        case TARGET_SO_TYPE:

                optname = SO_TYPE;

                break;

        case TARGET_SO_ERROR:

                optname = SO_ERROR;

                break;

        case TARGET_SO_DONTROUTE:

                optname = SO_DONTROUTE;

                break;

        case TARGET_SO_BROADCAST:

                optname = SO_BROADCAST;

                break;

        case TARGET_SO_SNDBUF:

                optname = SO_SNDBUF;

                break;

        case TARGET_SO_RCVBUF:

                optname = SO_RCVBUF;

                break;

        case TARGET_SO_KEEPALIVE:

                optname = SO_KEEPALIVE;

                break;

        case TARGET_SO_OOBINLINE:

                optname = SO_OOBINLINE;

                break;

        case TARGET_SO_NO_CHECK:

                optname = SO_NO_CHECK;

                break;

        case TARGET_SO_PRIORITY:

                optname = SO_PRIORITY;

                break;

#ifdef SO_BSDCOMPAT

        case TARGET_SO_BSDCOMPAT:

                optname = SO_BSDCOMPAT;

                break;

#endif

        case TARGET_SO_PASSCRED:

                optname = SO_PASSCRED;

                break;

        case TARGET_SO_TIMESTAMP:

                optname = SO_TIMESTAMP;

                break;

        case TARGET_SO_RCVLOWAT:

                optname = SO_RCVLOWAT;

                break;

        case TARGET_SO_RCVTIMEO:

                optname = SO_RCVTIMEO;

                break;

        case TARGET_SO_SNDTIMEO:

                optname = SO_SNDTIMEO;

                break;

            break;

        default:

            goto unimplemented;

        }

        if (optlen < sizeof(uint32_t))

        return -EINVAL;

        val = tget32(optval);

        ret = get_errno(setsockopt(sockfd, SOL_SOCKET, optname, &val, sizeof(val)));

        break;

    default:

    unimplemented:

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

        ret = -ENOSYS;

    }

    return ret;

}

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

                                 target_ulong optval, target_ulong optlen)

{

    target_long ret;

    int len, lv, val;

    switch(level) {

    case TARGET_SOL_SOCKET:

            level = SOL_SOCKET;

        switch (optname) {

        case TARGET_SO_LINGER:

        case TARGET_SO_RCVTIMEO:

        case TARGET_SO_SNDTIMEO:

        case TARGET_SO_PEERCRED:

        case TARGET_SO_PEERNAME:

            /* These don't just return a single integer */

            goto unimplemented;

        default:

            goto int_case;

        }

        break;

    case SOL_TCP:

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

    int_case:

        len = tget32(optlen);

        if (len < 0)

            return -EINVAL;

        lv = sizeof(int);

        ret = get_errno(getsockopt(sockfd, level, optname, &val, &lv));

        if (ret < 0)

            return ret;

        val = tswap32(val);

        if (len > lv)

            len = lv;

        if (len == 4)

            tput32(optval, val);

        else

            tput8(optval, val);

        tput32(optlen, len);

        break;

    case SOL_IP:

        switch(optname) {

        case IP_TOS:

        case IP_TTL:

        case IP_HDRINCL:

        case IP_ROUTER_ALERT:

        case IP_RECVOPTS:

        case IP_RETOPTS:

        case IP_PKTINFO:

        case IP_MTU_DISCOVER:

        case IP_RECVERR:

        case IP_RECVTOS:

#ifdef IP_FREEBIND

        case IP_FREEBIND:

#endif

        case IP_MULTICAST_TTL:

        case IP_MULTICAST_LOOP:

            len = tget32(optlen);

            if (len < 0)

                return -EINVAL;

            lv = sizeof(int);

            ret = get_errno(getsockopt(sockfd, level, optname, &val, &lv));

            if (ret < 0)

                return ret;

            if (len < sizeof(int) && len > 0 && val >= 0 && val < 255) {

                len = 1;

                tput32(optlen, len);

                tput8(optval, val);