Archipelago » qemu

/*

 * QEMU low level functions

 *

 * Copyright (c) 2003 Fabrice Bellard

 *

 * Permission is hereby granted, free of charge, to any person obtaining a copy

 * of this software and associated documentation files (the "Software"), to deal

 * in the Software without restriction, including without limitation the rights

 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell

 * copies of the Software, and to permit persons to whom the Software is

 * furnished to do so, subject to the following conditions:

 *

 * The above copyright notice and this permission notice shall be included in

 * all copies or substantial portions of the Software.

 *

 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR

 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,

 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL

 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER

 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,

 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN

 * THE SOFTWARE.

 */

#include <stdlib.h>

#include <stdio.h>

#include <stdarg.h>

#include <string.h>

#include <errno.h>

#include <unistd.h>

#include <fcntl.h>

/* Needed early for CONFIG_BSD etc. */

#include "config-host.h"

#ifdef CONFIG_SOLARIS

#include <sys/types.h>

#include <sys/statvfs.h>

#endif

#ifdef CONFIG_EVENTFD

#include <sys/eventfd.h>

#endif

#ifdef _WIN32

#include <windows.h>

#elif defined(CONFIG_BSD)

#include <stdlib.h>

#else

#include <malloc.h>

#endif

#include "qemu-common.h"

#include "trace.h"

#include "sysemu.h"

#include "qemu_socket.h"

#if !defined(_POSIX_C_SOURCE) || defined(_WIN32) || defined(__sun__)

static void *oom_check(void *ptr)

{

    if (ptr == NULL) {

#if defined(_WIN32)

        fprintf(stderr, "Failed to allocate memory: %lu\n", GetLastError());

#else

        fprintf(stderr, "Failed to allocate memory: %s\n", strerror(errno));

#endif

        abort();

    }

    return ptr;

}

#endif

#if defined(_WIN32)

void *qemu_memalign(size_t alignment, size_t size)

{

    void *ptr;

    if (!size) {

        abort();

    }

    ptr = oom_check(VirtualAlloc(NULL, size, MEM_COMMIT, PAGE_READWRITE));

    trace_qemu_memalign(alignment, size, ptr);

    return ptr;

}

void *qemu_vmalloc(size_t size)

{

    void *ptr;

    /* FIXME: this is not exactly optimal solution since VirtualAlloc

       has 64Kb granularity, but at least it guarantees us that the

       memory is page aligned. */

    if (!size) {

        abort();

    }

    ptr = oom_check(VirtualAlloc(NULL, size, MEM_COMMIT, PAGE_READWRITE));

    trace_qemu_vmalloc(size, ptr);

    return ptr;

}

void qemu_vfree(void *ptr)

{

    trace_qemu_vfree(ptr);

    VirtualFree(ptr, 0, MEM_RELEASE);

}

#else

void *qemu_memalign(size_t alignment, size_t size)

{

    void *ptr;

#if defined(_POSIX_C_SOURCE) && !defined(__sun__)

    int ret;

    ret = posix_memalign(&ptr, alignment, size);

    if (ret != 0) {

        fprintf(stderr, "Failed to allocate %zu B: %s\n",

                size, strerror(ret));

        abort();

    }

#elif defined(CONFIG_BSD)

    ptr = oom_check(valloc(size));

#else

    ptr = oom_check(memalign(alignment, size));

#endif

    trace_qemu_memalign(alignment, size, ptr);

    return ptr;

}

/* alloc shared memory pages */

void *qemu_vmalloc(size_t size)

{

    return qemu_memalign(getpagesize(), size);

}

void qemu_vfree(void *ptr)

{

    trace_qemu_vfree(ptr);

    free(ptr);

}

#endif

int qemu_create_pidfile(const char *filename)

{

    char buffer[128];

    int len;

#ifndef _WIN32

    int fd;

    fd = qemu_open(filename, O_RDWR | O_CREAT, 0600);

    if (fd == -1)

        return -1;

    if (lockf(fd, F_TLOCK, 0) == -1)

        return -1;

    len = snprintf(buffer, sizeof(buffer), "%ld\n", (long)getpid());

    if (write(fd, buffer, len) != len)

        return -1;

#else

    HANDLE file;

    OVERLAPPED overlap;

    BOOL ret;

    memset(&overlap, 0, sizeof(overlap));

    file = CreateFile(filename, GENERIC_WRITE, FILE_SHARE_READ, NULL,

                      OPEN_ALWAYS, FILE_ATTRIBUTE_NORMAL, NULL);

    if (file == INVALID_HANDLE_VALUE)

      return -1;

    len = snprintf(buffer, sizeof(buffer), "%ld\n", (long)getpid());

    ret = WriteFileEx(file, (LPCVOID)buffer, (DWORD)len,

                      &overlap, NULL);

    if (ret == 0)

      return -1;

#endif

    return 0;

}

#ifdef _WIN32

/* mingw32 needs ffs for compilations without optimization. */

int ffs(int i)

{

    /* Use gcc's builtin ffs. */

    return __builtin_ffs(i);

}

/* Offset between 1/1/1601 and 1/1/1970 in 100 nanosec units */

#define _W32_FT_OFFSET (116444736000000000ULL)

int qemu_gettimeofday(qemu_timeval *tp)

{

  union {

    unsigned long long ns100; /*time since 1 Jan 1601 in 100ns units */

    FILETIME ft;

  }  _now;

  if(tp)

    {

      GetSystemTimeAsFileTime (&_now.ft);

      tp->tv_usec=(long)((_now.ns100 / 10ULL) % 1000000ULL );

      tp->tv_sec= (long)((_now.ns100 - _W32_FT_OFFSET) / 10000000ULL);

    }

  /* Always return 0 as per Open Group Base Specifications Issue 6.

     Do not set errno on error.  */

  return 0;

}

#endif /* _WIN32 */

#ifdef _WIN32

void socket_set_nonblock(int fd)

{

    unsigned long opt = 1;

    ioctlsocket(fd, FIONBIO, &opt);

}

int inet_aton(const char *cp, struct in_addr *ia)

{

    uint32_t addr = inet_addr(cp);

    if (addr == 0xffffffff)

        return 0;

    ia->s_addr = addr;

    return 1;

}

void qemu_set_cloexec(int fd)

{

}

#else

void socket_set_nonblock(int fd)

{

    int f;

    f = fcntl(fd, F_GETFL);

    fcntl(fd, F_SETFL, f | O_NONBLOCK);

}

void qemu_set_cloexec(int fd)

{

    int f;

    f = fcntl(fd, F_GETFD);

    fcntl(fd, F_SETFD, f | FD_CLOEXEC);

}

#endif

/*

 * Opens a file with FD_CLOEXEC set

 */

int qemu_open(const char *name, int flags, ...)

{

    int ret;

    int mode = 0;

    if (flags & O_CREAT) {

        va_list ap;

        va_start(ap, flags);

        mode = va_arg(ap, int);

        va_end(ap);

    }

#ifdef O_CLOEXEC

    ret = open(name, flags | O_CLOEXEC, mode);

#else

    ret = open(name, flags, mode);

    if (ret >= 0) {

        qemu_set_cloexec(ret);

    }

#endif

    return ret;

}

/*

 * A variant of write(2) which handles partial write.

 *

 * Return the number of bytes transferred.

 * Set errno if fewer than `count' bytes are written.

 *

 * This function don't work with non-blocking fd's.

 * Any of the possibilities with non-bloking fd's is bad:

 *   - return a short write (then name is wrong)

 *   - busy wait adding (errno == EAGAIN) to the loop

 */

ssize_t qemu_write_full(int fd, const void *buf, size_t count)

{

    ssize_t ret = 0;

    ssize_t total = 0;

    while (count) {

        ret = write(fd, buf, count);

        if (ret < 0) {

            if (errno == EINTR)

                continue;

            break;

        }

        count -= ret;

        buf += ret;

        total += ret;

    }

    return total;

}

#ifndef _WIN32

/*

 * Creates an eventfd that looks like a pipe and has EFD_CLOEXEC set.

 */

int qemu_eventfd(int fds[2])

{

#ifdef CONFIG_EVENTFD

    int ret;

    ret = eventfd(0, 0);

    if (ret >= 0) {

        fds[0] = ret;

        qemu_set_cloexec(ret);

        if ((fds[1] = dup(ret)) == -1) {

            close(ret);

            return -1;

        }

        qemu_set_cloexec(fds[1]);

        return 0;

    }

    if (errno != ENOSYS) {

        return -1;

    }

#endif

    return qemu_pipe(fds);

}

/*

 * Creates a pipe with FD_CLOEXEC set on both file descriptors

 */

int qemu_pipe(int pipefd[2])

{

    int ret;

#ifdef CONFIG_PIPE2

    ret = pipe2(pipefd, O_CLOEXEC);

    if (ret != -1 || errno != ENOSYS) {

        return ret;

    }

#endif

    ret = pipe(pipefd);

    if (ret == 0) {

        qemu_set_cloexec(pipefd[0]);

        qemu_set_cloexec(pipefd[1]);

    }

    return ret;

}

#endif

/*

 * Opens a socket with FD_CLOEXEC set

 */

int qemu_socket(int domain, int type, int protocol)

{

    int ret;

#ifdef SOCK_CLOEXEC

    ret = socket(domain, type | SOCK_CLOEXEC, protocol);

    if (ret != -1 || errno != EINVAL) {

        return ret;

    }

#endif

    ret = socket(domain, type, protocol);

    if (ret >= 0) {

        qemu_set_cloexec(ret);

    }

    return ret;

}

/*

 * Accept a connection and set FD_CLOEXEC

 */

int qemu_accept(int s, struct sockaddr *addr, socklen_t *addrlen)

{

    int ret;

#ifdef CONFIG_ACCEPT4

    ret = accept4(s, addr, addrlen, SOCK_CLOEXEC);

    if (ret != -1 || errno != ENOSYS) {

        return ret;

    }

#endif

    ret = accept(s, addr, addrlen);

    if (ret >= 0) {

        qemu_set_cloexec(ret);

    }

    return ret;

}