linux/plat.c

   1 /*
   2  * (C) Gražvydas "notaz" Ignotas, 2008-2012
   3  *
   4  * This work is licensed under the terms of any of these licenses
   5  * (at your option):
   6  *  - GNU GPL, version 2 or later.
   7  *  - GNU LGPL, version 2.1 or later.
   8  *  - MAME license.
   9  * See the COPYING file in the top-level directory.
  10  */
  11
  12 #define _GNU_SOURCE 1
  13 #include <stdio.h>
  14 #include <string.h>
  15 #include <stdarg.h>
  16 #include <dirent.h>
  17 #include <sys/time.h>
  18 #include <time.h>
  19 #include <unistd.h>
  20 #include <sys/mman.h>
  21 #include <errno.h>
  22 #include <sys/stat.h>
  23
  24 #include "../plat.h"
  25
  26 /* XXX: maybe unhardcode pagesize? */
  27 #define HUGETLB_PAGESIZE (2 * 1024 * 1024)
  28 #define HUGETLB_THRESHOLD (HUGETLB_PAGESIZE / 2)
  29 #ifndef MAP_HUGETLB
  30 #define MAP_HUGETLB 0x40000 /* arch specific */
  31 #endif
  32
  33
  34 int plat_is_dir(const char *path)
  35 {
  36         DIR *dir;
  37         if ((dir = opendir(path))) {
  38                 closedir(dir);
  39                 return 1;
  40         }
  41         return 0;
  42 }
  43
  44 int plat_get_data_dir(char *dst, int len)
  45 {
  46         if (len > 1)
  47                 strcpy(dst, "/");
  48         else    *dst = 0;
  49         return strlen(dst);
  50 }
  51
  52 static int plat_get_exe_dir(char *dst, int len)
  53 {
  54 #ifdef PICO_DATA_DIR
  55         memcpy(dst, PICO_DATA_DIR, sizeof PICO_DATA_DIR);
  56         return sizeof(PICO_DATA_DIR) - 1;
  57 #else
  58         int j, ret = readlink("/proc/self/exe", dst, len - 1);
  59         if (ret < 0) {
  60                 perror("readlink");
  61                 ret = 0;
  62         }
  63         dst[ret] = 0;
  64
  65         for (j = ret - 1; j > 0; j--)
  66                 if (dst[j] == '/') {
  67                         dst[++j] = 0;
  68                         break;
  69                 }
  70         return j;
  71 #endif
  72 }
  73
  74 int plat_get_skin_dir(char *dst, int len)
  75 {
  76         int ret = plat_get_exe_dir(dst, len);
  77         if (ret < 0)
  78                 return ret;
  79
  80         memcpy(dst + ret, "skin/", sizeof "skin/");
  81         return ret + sizeof("skin/") - 1;
  82 }
  83
  84 #ifndef PICO_HOME_DIR
  85 #define PICO_HOME_DIR "/.picodrive/"
  86 #endif
  87 int plat_get_root_dir(char *dst, int len)
  88 {
  89 #if !defined(NO_HOME_DIR) && !defined(__GP2X__) && !defined(PANDORA)
  90         const char *home = getenv("HOME");
  91         int ret;
  92
  93         if (home != NULL) {
  94                 ret = snprintf(dst, len, "%s%s", home, PICO_HOME_DIR);
  95                 if (ret >= len)
  96                         ret = len - 1;
  97                 mkdir(dst, 0755);
  98                 return ret;
  99         }
 100 #endif
 101         return plat_get_exe_dir(dst, len);
 102 }
 103
 104 #ifdef __GP2X__
 105 /* Wiz has a borked gettimeofday().. */
 106 #define plat_get_ticks_ms plat_get_ticks_ms_good
 107 #define plat_get_ticks_us plat_get_ticks_us_good
 108 #endif
 109
 110 unsigned int plat_get_ticks_ms(void)
 111 {
 112         struct timeval tv;
 113         unsigned int ret;
 114
 115         gettimeofday(&tv, NULL);
 116
 117         ret = (unsigned)tv.tv_sec * 1000;
 118         /* approximate /= 1000 */
 119         ret += ((unsigned)tv.tv_usec * 4195) >> 22;
 120
 121         return ret;
 122 }
 123
 124 unsigned int plat_get_ticks_us(void)
 125 {
 126         struct timeval tv;
 127         unsigned int ret;
 128
 129         gettimeofday(&tv, NULL);
 130
 131         ret = (unsigned)tv.tv_sec * 1000000;
 132         ret += (unsigned)tv.tv_usec;
 133
 134         return ret;
 135 }
 136
 137 void plat_sleep_ms(int ms)
 138 {
 139         usleep(ms * 1000);
 140 }
 141
 142 int plat_wait_event(int *fds_hnds, int count, int timeout_ms)
 143 {
 144         struct timeval tv, *timeout = NULL;
 145         int i, ret, fdmax = -1;
 146         fd_set fdset;
 147
 148         if (timeout_ms >= 0) {
 149                 tv.tv_sec = timeout_ms / 1000;
 150                 tv.tv_usec = (timeout_ms % 1000) * 1000;
 151                 timeout = &tv;
 152         }
 153
 154         FD_ZERO(&fdset);
 155         for (i = 0; i < count; i++) {
 156                 if (fds_hnds[i] > fdmax) fdmax = fds_hnds[i];
 157                 FD_SET(fds_hnds[i], &fdset);
 158         }
 159
 160         ret = select(fdmax + 1, &fdset, NULL, NULL, timeout);
 161         if (ret == -1)
 162         {
 163                 perror("plat_wait_event: select failed");
 164                 sleep(1);
 165                 return -1;
 166         }
 167
 168         if (ret == 0)
 169                 return -1; /* timeout */
 170
 171         ret = -1;
 172         for (i = 0; i < count; i++)
 173                 if (FD_ISSET(fds_hnds[i], &fdset))
 174                         ret = fds_hnds[i];
 175
 176         return ret;
 177 }
 178
 179 void *plat_mmap(unsigned long addr, size_t size, int need_exec, int is_fixed)
 180 {
 181         static int hugetlb_warned;
 182         int prot = PROT_READ | PROT_WRITE;
 183         int flags = MAP_PRIVATE | MAP_ANONYMOUS;
 184         void *req, *ret;
 185
 186         req = (void *)addr;
 187         if (need_exec)
 188                 prot |= PROT_EXEC;
 189         /* avoid MAP_FIXED, it overrides existing mappings..
 190         if (is_fixed)
 191                 flags |= MAP_FIXED;
 192         */
 193         if (size >= HUGETLB_THRESHOLD)
 194                 flags |= MAP_HUGETLB;
 195
 196         ret = mmap(req, size, prot, flags, -1, 0);
 197         if (ret == MAP_FAILED && (flags & MAP_HUGETLB)) {
 198                 if (!hugetlb_warned) {
 199                         fprintf(stderr,
 200                                 "warning: failed to do hugetlb mmap (%p, %zu): %d\n",
 201                                 req, size, errno);
 202                         hugetlb_warned = 1;
 203                 }
 204                 flags &= ~MAP_HUGETLB;
 205                 ret = mmap(req, size, prot, flags, -1, 0);
 206         }
 207         if (ret == MAP_FAILED)
 208                 return NULL;
 209
 210         if (req != NULL && ret != req) {
 211                 fprintf(stderr, "%s: mmaped to %p, requested %p\n",
 212                         is_fixed ? "error" : "warning", ret, req);
 213                 if (is_fixed) {
 214                         munmap(ret, size);
 215                         return NULL;
 216                 }
 217         }
 218
 219         return ret;
 220 }
 221
 222 void *plat_mremap(void *ptr, size_t oldsize, size_t newsize)
 223 {
 224         void *ret;
 225
 226         ret = mremap(ptr, oldsize, newsize, MREMAP_MAYMOVE);
 227         if (ret == MAP_FAILED) {
 228                 fprintf(stderr, "mremap %p %zd %zd: ",
 229                         ptr, oldsize, newsize);
 230                 perror(NULL);
 231                 // might be because huge pages can't be remapped,
 232                 // just make a new mapping
 233                 ret = plat_mmap(0, newsize, 0, 0);
 234                 if (ret == MAP_FAILED)
 235                         return NULL;
 236                 memcpy(ret, ptr, oldsize);
 237                 munmap(ptr, oldsize);
 238         }
 239         if (ret != ptr)
 240                 printf("warning: mremap moved: %p -> %p\n", ptr, ret);
 241
 242         return ret;
 243 }
 244
 245 void plat_munmap(void *ptr, size_t size)
 246 {
 247         int ret;
 248
 249         ret = munmap(ptr, size);
 250         if (ret != 0 && (size & (HUGETLB_PAGESIZE - 1))) {
 251                 // prehaps an autorounded hugetlb mapping?
 252                 size = (size + HUGETLB_PAGESIZE - 1) & ~(HUGETLB_PAGESIZE - 1);
 253                 ret = munmap(ptr, size);
 254         }
 255         if (ret != 0) {
 256                 fprintf(stderr,
 257                         "munmap(%p, %zu) failed: %d\n", ptr, size, errno);
 258         }
 259 }
 260
 261 int plat_mem_set_exec(void *ptr, size_t size)
 262 {
 263         int ret = mprotect(ptr, size, PROT_READ | PROT_WRITE | PROT_EXEC);
 264         if (ret != 0)
 265                 fprintf(stderr, "mprotect(%p, %zd) failed: %d\n",
 266                         ptr, size, errno);
 267
 268         return ret;
 269 }
 270
 271 /* lprintf */
 272 void lprintf(const char *fmt, ...)
 273 {
 274         va_list vl;
 275
 276         va_start(vl, fmt);
 277         vprintf(fmt, vl);
 278         va_end(vl);
 279 }
 280