osdep.c

   1 /*
   2  * QEMU low level functions
   3  *
   4  * Copyright (c) 2003 Fabrice Bellard
   5  *
   6  * Permission is hereby granted, free of charge, to any person obtaining a copy
   7  * of this software and associated documentation files (the "Software"), to deal
   8  * in the Software without restriction, including without limitation the rights
   9  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  10  * copies of the Software, and to permit persons to whom the Software is
  11  * furnished to do so, subject to the following conditions:
  12  *
  13  * The above copyright notice and this permission notice shall be included in
  14  * all copies or substantial portions of the Software.
  15  *
  16  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  17  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  18  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  19  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  20  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  21  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  22  * THE SOFTWARE.
  23  */
  24 #include <stdlib.h>
  25 #include <stdio.h>
  26 #include <stdarg.h>
  27 #include <string.h>
  28 #include <errno.h>
  29 #include <unistd.h>
  30 #include <fcntl.h>
  31
  32 /* Needed early for CONFIG_BSD etc. */
  33 #include "config-host.h"
  34
  35 #ifdef CONFIG_SOLARIS
  36 #include <sys/types.h>
  37 #include <sys/statvfs.h>
  38 #endif
  39
  40 #ifdef CONFIG_EVENTFD
  41 #include <sys/eventfd.h>
  42 #endif
  43
  44 #ifdef _WIN32
  45 #include <windows.h>
  46 #elif defined(CONFIG_BSD)
  47 #include <stdlib.h>
  48 #else
  49 #include <malloc.h>
  50 #endif
  51
  52 #include "qemu-common.h"
  53 #include "trace.h"
  54 #include "sysemu.h"
  55 #include "qemu_socket.h"
  56
  57 #if !defined(_POSIX_C_SOURCE) || defined(_WIN32) || defined(__sun__)
  58 static void *oom_check(void *ptr)
  59 {
  60     if (ptr == NULL) {
  61 #if defined(_WIN32)
  62         fprintf(stderr, "Failed to allocate memory: %lu\n", GetLastError());
  63 #else
  64         fprintf(stderr, "Failed to allocate memory: %s\n", strerror(errno));
  65 #endif
  66         abort();
  67     }
  68     return ptr;
  69 }
  70 #endif
  71
  72 #if defined(_WIN32)
  73 void *qemu_memalign(size_t alignment, size_t size)
  74 {
  75     void *ptr;
  76
  77     if (!size) {
  78         abort();
  79     }
  80     ptr = oom_check(VirtualAlloc(NULL, size, MEM_COMMIT, PAGE_READWRITE));
  81     trace_qemu_memalign(alignment, size, ptr);
  82     return ptr;
  83 }
  84
  85 void *qemu_vmalloc(size_t size)
  86 {
  87     void *ptr;
  88
  89     /* FIXME: this is not exactly optimal solution since VirtualAlloc
  90        has 64Kb granularity, but at least it guarantees us that the
  91        memory is page aligned. */
  92     if (!size) {
  93         abort();
  94     }
  95     ptr = oom_check(VirtualAlloc(NULL, size, MEM_COMMIT, PAGE_READWRITE));
  96     trace_qemu_vmalloc(size, ptr);
  97     return ptr;
  98 }
  99
 100 void qemu_vfree(void *ptr)
 101 {
 102     trace_qemu_vfree(ptr);
 103     VirtualFree(ptr, 0, MEM_RELEASE);
 104 }
 105
 106 #else
 107
 108 void *qemu_memalign(size_t alignment, size_t size)
 109 {
 110     void *ptr;
 111 #if defined(_POSIX_C_SOURCE) && !defined(__sun__)
 112     int ret;
 113     ret = posix_memalign(&ptr, alignment, size);
 114     if (ret != 0) {
 115         fprintf(stderr, "Failed to allocate %zu B: %s\n",
 116                 size, strerror(ret));
 117         abort();
 118     }
 119 #elif defined(CONFIG_BSD)
 120     ptr = oom_check(valloc(size));
 121 #else
 122     ptr = oom_check(memalign(alignment, size));
 123 #endif
 124     trace_qemu_memalign(alignment, size, ptr);
 125     return ptr;
 126 }
 127
 128 /* alloc shared memory pages */
 129 void *qemu_vmalloc(size_t size)
 130 {
 131 #ifndef __ia64__
 132     return qemu_memalign(getpagesize(), size);
 133 #else
 134     return qemu_memalign(65536, size);
 135 #endif
 136 }
 137
 138 void qemu_vfree(void *ptr)
 139 {
 140     trace_qemu_vfree(ptr);
 141     free(ptr);
 142 }
 143
 144 #endif
 145
 146 int qemu_create_pidfile(const char *filename)
 147 {
 148     char buffer[128];
 149     int len;
 150 #ifndef _WIN32
 151     int fd;
 152
 153     fd = qemu_open(filename, O_RDWR | O_CREAT, 0600);
 154     if (fd == -1)
 155         return -1;
 156
 157     if (lockf(fd, F_TLOCK, 0) == -1)
 158         return -1;
 159
 160     len = snprintf(buffer, sizeof(buffer), "%ld\n", (long)getpid());
 161     if (write(fd, buffer, len) != len)
 162         return -1;
 163 #else
 164     HANDLE file;
 165     OVERLAPPED overlap;
 166     BOOL ret;
 167     memset(&overlap, 0, sizeof(overlap));
 168
 169     file = CreateFile(filename, GENERIC_WRITE, FILE_SHARE_READ, NULL,
 170                       OPEN_ALWAYS, FILE_ATTRIBUTE_NORMAL, NULL);
 171
 172     if (file == INVALID_HANDLE_VALUE)
 173       return -1;
 174
 175     len = snprintf(buffer, sizeof(buffer), "%ld\n", (long)getpid());
 176     ret = WriteFileEx(file, (LPCVOID)buffer, (DWORD)len,
 177                       &overlap, NULL);
 178     if (ret == 0)
 179       return -1;
 180 #endif
 181     return 0;
 182 }
 183
 184 #ifdef _WIN32
 185
 186 /* mingw32 needs ffs for compilations without optimization. */
 187 int ffs(int i)
 188 {
 189     /* Use gcc's builtin ffs. */
 190     return __builtin_ffs(i);
 191 }
 192
 193 /* Offset between 1/1/1601 and 1/1/1970 in 100 nanosec units */
 194 #define _W32_FT_OFFSET (116444736000000000ULL)
 195
 196 int qemu_gettimeofday(qemu_timeval *tp)
 197 {
 198   union {
 199     unsigned long long ns100; /*time since 1 Jan 1601 in 100ns units */
 200     FILETIME ft;
 201   }  _now;
 202
 203   if(tp)
 204     {
 205       GetSystemTimeAsFileTime (&_now.ft);
 206       tp->tv_usec=(long)((_now.ns100 / 10ULL) % 1000000ULL );
 207       tp->tv_sec= (long)((_now.ns100 - _W32_FT_OFFSET) / 10000000ULL);
 208     }
 209   /* Always return 0 as per Open Group Base Specifications Issue 6.
 210      Do not set errno on error.  */
 211   return 0;
 212 }
 213 #endif /* _WIN32 */
 214
 215
 216 #ifdef _WIN32
 217 void socket_set_nonblock(int fd)
 218 {
 219     unsigned long opt = 1;
 220     ioctlsocket(fd, FIONBIO, &opt);
 221 }
 222
 223 int inet_aton(const char *cp, struct in_addr *ia)
 224 {
 225     uint32_t addr = inet_addr(cp);
 226     if (addr == 0xffffffff)
 227         return 0;
 228     ia->s_addr = addr;
 229     return 1;
 230 }
 231
 232 void qemu_set_cloexec(int fd)
 233 {
 234 }
 235
 236 #else
 237
 238 void socket_set_nonblock(int fd)
 239 {
 240     int f;
 241     f = fcntl(fd, F_GETFL);
 242     fcntl(fd, F_SETFL, f | O_NONBLOCK);
 243 }
 244
 245 void qemu_set_cloexec(int fd)
 246 {
 247     int f;
 248     f = fcntl(fd, F_GETFD);
 249     fcntl(fd, F_SETFD, f | FD_CLOEXEC);
 250 }
 251
 252 #endif
 253
 254 /*
 255  * Opens a file with FD_CLOEXEC set
 256  */
 257 int qemu_open(const char *name, int flags, ...)
 258 {
 259     int ret;
 260     int mode = 0;
 261
 262     if (flags & O_CREAT) {
 263         va_list ap;
 264
 265         va_start(ap, flags);
 266         mode = va_arg(ap, int);
 267         va_end(ap);
 268     }
 269
 270 #ifdef O_CLOEXEC
 271     ret = open(name, flags | O_CLOEXEC, mode);
 272 #else
 273     ret = open(name, flags, mode);
 274     if (ret >= 0) {
 275         qemu_set_cloexec(ret);
 276     }
 277 #endif
 278
 279     return ret;
 280 }
 281
 282 /*
 283  * A variant of write(2) which handles partial write.
 284  *
 285  * Return the number of bytes transferred.
 286  * Set errno if fewer than `count' bytes are written.
 287  *
 288  * This function don't work with non-blocking fd's.
 289  * Any of the possibilities with non-bloking fd's is bad:
 290  *   - return a short write (then name is wrong)
 291  *   - busy wait adding (errno == EAGAIN) to the loop
 292  */
 293 ssize_t qemu_write_full(int fd, const void *buf, size_t count)
 294 {
 295     ssize_t ret = 0;
 296     ssize_t total = 0;
 297
 298     while (count) {
 299         ret = write(fd, buf, count);
 300         if (ret < 0) {
 301             if (errno == EINTR)
 302                 continue;
 303             break;
 304         }
 305
 306         count -= ret;
 307         buf += ret;
 308         total += ret;
 309     }
 310
 311     return total;
 312 }
 313
 314 #ifndef _WIN32
 315 /*
 316  * Creates an eventfd that looks like a pipe and has EFD_CLOEXEC set.
 317  */
 318 int qemu_eventfd(int fds[2])
 319 {
 320 #ifdef CONFIG_EVENTFD
 321     int ret;
 322
 323     ret = eventfd(0, 0);
 324     if (ret >= 0) {
 325         fds[0] = ret;
 326         qemu_set_cloexec(ret);
 327         if ((fds[1] = dup(ret)) == -1) {
 328             close(ret);
 329             return -1;
 330         }
 331         qemu_set_cloexec(fds[1]);
 332         return 0;
 333     }
 334
 335     if (errno != ENOSYS) {
 336         return -1;
 337     }
 338 #endif
 339
 340     return qemu_pipe(fds);
 341 }
 342
 343 /*
 344  * Creates a pipe with FD_CLOEXEC set on both file descriptors
 345  */
 346 int qemu_pipe(int pipefd[2])
 347 {
 348     int ret;
 349
 350 #ifdef CONFIG_PIPE2
 351     ret = pipe2(pipefd, O_CLOEXEC);
 352     if (ret != -1 || errno != ENOSYS) {
 353         return ret;
 354     }
 355 #endif
 356     ret = pipe(pipefd);
 357     if (ret == 0) {
 358         qemu_set_cloexec(pipefd[0]);
 359         qemu_set_cloexec(pipefd[1]);
 360     }
 361
 362     return ret;
 363 }
 364 #endif
 365
 366 /*
 367  * Opens a socket with FD_CLOEXEC set
 368  */
 369 int qemu_socket(int domain, int type, int protocol)
 370 {
 371     int ret;
 372
 373 #ifdef SOCK_CLOEXEC
 374     ret = socket(domain, type | SOCK_CLOEXEC, protocol);
 375     if (ret != -1 || errno != EINVAL) {
 376         return ret;
 377     }
 378 #endif
 379     ret = socket(domain, type, protocol);
 380     if (ret >= 0) {
 381         qemu_set_cloexec(ret);
 382     }
 383
 384     return ret;
 385 }
 386
 387 /*
 388  * Accept a connection and set FD_CLOEXEC
 389  */
 390 int qemu_accept(int s, struct sockaddr *addr, socklen_t *addrlen)
 391 {
 392     int ret;
 393
 394 #ifdef CONFIG_ACCEPT4
 395     ret = accept4(s, addr, addrlen, SOCK_CLOEXEC);
 396     if (ret != -1 || errno != ENOSYS) {
 397         return ret;
 398     }
 399 #endif
 400     ret = accept(s, addr, addrlen);
 401     if (ret >= 0) {
 402         qemu_set_cloexec(ret);
 403     }
 404
 405     return ret;
 406 }