loader/override.c

   1 /*
   2  * GINGE - GINGE Is Not Gp2x Emulator
   3  * (C) notaz, 2010-2011,2016
   4  *
   5  * This work is licensed under the MAME license, see COPYING file for details.
   6  */
   7 #include <stdio.h>
   8 #include <stdlib.h>
   9 #include <stdarg.h>
  10 #include <string.h>
  11 #include <sys/types.h>
  12 #include <sys/stat.h>
  13 #include <fcntl.h>
  14 #include <sys/mman.h>
  15 #include <unistd.h>
  16 #include <sys/ioctl.h>
  17 #include <signal.h>
  18 #include <termios.h>
  19 #include <errno.h>
  20
  21 #include "realfuncs.h"
  22 #include "syscalls.h"
  23 #include "llibc.h"
  24 #include "header.h"
  25
  26 #if (DBG & 1)
  27 #define strace g_printf
  28 #else
  29 #define strace(...)
  30 #endif
  31
  32 #define UNUSED __attribute__((unused))
  33
  34 static const struct dev_fd_t takeover_devs[] = {
  35   { "/dev/mem",     FAKEDEV_MEM },
  36   { "/dev/GPIO",    FAKEDEV_GPIO },
  37   { "/dev/fb0",     FAKEDEV_FB0 },
  38   { "/dev/fb/0",    FAKEDEV_FB0 },
  39   { "/dev/fb1",     FAKEDEV_FB1 },
  40   { "/dev/fb/1",    FAKEDEV_FB1 },
  41   { "/dev/mmuhack", FAKEDEV_MMUHACK },
  42   { "/dev/tty",     FAKEDEV_TTY0 },
  43   { "/dev/tty0",    FAKEDEV_TTY0 },
  44 #ifdef PND
  45   { "/dev/input/event*", -1 }, // hide for now, may cause dupe events
  46 #endif
  47 };
  48
  49 static long w_open_raw(const char *pathname, int flags, mode_t mode)
  50 {
  51   long ret;
  52   int i;
  53
  54   for (i = 0; i < ARRAY_SIZE(takeover_devs); i++) {
  55     const char *p, *oname;
  56     int len;
  57
  58     oname = takeover_devs[i].name;
  59     p = strchr(oname, '*');
  60     if (p != NULL)
  61       len = p - oname;
  62     else
  63       len = strlen(oname) + 1;
  64
  65     if (strncmp(pathname, oname, len) == 0) {
  66       ret = takeover_devs[i].fd;
  67       break;
  68     }
  69   }
  70
  71   if (i == ARRAY_SIZE(takeover_devs))
  72     ret = g_open_raw(pathname, flags, mode);
  73
  74   if (ret >= 0) {
  75     for (i = 0; emu_interesting_fds[i].name != NULL; i++) {
  76       struct dev_fd_t *eifd = &emu_interesting_fds[i];
  77       if (strcmp(pathname, eifd->name) == 0) {
  78         eifd->fd = ret;
  79         if (eifd->open_cb != NULL)
  80           eifd->open_cb(ret);
  81         break;
  82       }
  83     }
  84   }
  85
  86   strace("open(%s) = %ld\n", pathname, ret);
  87   return ret;
  88 }
  89
  90 static int w_open(const char *pathname, int flags, mode_t mode)
  91 {
  92   long ret = w_open_raw(pathname, flags, mode);
  93   return g_syscall_error(ret);
  94 }
  95
  96 static long w_mmap_raw(void *addr, size_t length, int prot, int flags,
  97   int fd, off_t offset)
  98 {
  99   long ret;
 100
 101   if (FAKEDEV_MEM <= fd && fd < FAKEDEV_FD_BOUNDARY)
 102     ret = emu_do_mmap(length, prot, flags, fd, offset);
 103   else
 104     ret = g_mmap2_raw(addr, length, prot, flags, fd, offset >> 12);
 105
 106   strace("mmap(%p, %x, %x, %x, %d, %lx) = %lx\n",
 107          addr, length, prot, flags, fd, (long)offset, ret);
 108   return ret;
 109 }
 110
 111 static long w_mmap(void *addr, size_t length, int prot, int flags, int fd, off_t offset)
 112 {
 113   long ret = w_mmap_raw(addr, length, prot, flags, fd, offset);
 114   return g_syscall_error(ret);
 115 }
 116 #define w_mmap2 w_mmap
 117
 118 static long w_munmap_raw(void *addr, size_t length)
 119 {
 120   long ret;
 121
 122   ret = emu_do_munmap(addr, length);
 123   if (ret == -EAGAIN)
 124     ret = g_munmap_raw(addr, length);
 125
 126   strace("munmap(%p, %x) = %ld\n", addr, length, ret);
 127   return ret;
 128 }
 129
 130 static int w_munmap(void *addr, size_t length)
 131 {
 132   long ret = w_munmap_raw(addr, length);
 133   return g_syscall_error(ret);
 134 }
 135
 136 long w_read_raw(int fd, void *buf, size_t count)
 137 {
 138   long ret;
 139
 140   if (fd == FAKEDEV_GPIO)
 141     ret = emu_read_gpiodev(buf, count);
 142   else
 143     ret = g_read_raw(fd, buf, count);
 144
 145   //strace("read(%d, %p, %ld) = %ld\n", fd, buf, count, ret);
 146   return ret;
 147 }
 148
 149 static ssize_t w_read(int fd, void *buf, size_t count)
 150 {
 151   long ret = w_read_raw(fd, buf, count);
 152   return g_syscall_error(ret);
 153 }
 154
 155 long w_ioctl_raw(int fd, int request, void *argp)
 156 {
 157   long ret;
 158
 159   if ((FAKEDEV_MEM <= fd && fd < FAKEDEV_FD_BOUNDARY) ||
 160       fd == emu_interesting_fds[IFD_SOUND].fd)
 161     ret = emu_do_ioctl(fd, request, argp);
 162   else
 163     ret = g_ioctl_raw(fd, request, argp);
 164
 165   strace("ioctl(%d, %08x, %p) = %ld\n", fd, request, argp, ret);
 166   return ret;
 167 }
 168
 169 static int w_ioctl(int fd, int request, void *argp)
 170 {
 171   long ret = w_ioctl_raw(fd, request, argp);
 172   return g_syscall_error(ret);
 173 }
 174
 175 static int w_sigaction(int signum, const void *act, void *oldact)
 176 {
 177   strace("sigaction(%d, %p, %p) = %d\n", signum, act, oldact, 0);
 178   return 0;
 179 }
 180
 181 /* dynamic only */
 182 static UNUSED int w_tcgetattr(int fd, struct termios *termios_p)
 183 {
 184   int ret;
 185   if (fd != FAKEDEV_TTY0)
 186     ret = tcgetattr(fd, termios_p);
 187   else
 188     ret = 0;
 189
 190   strace("tcgetattr(%d, %p) = %d\n", fd, termios_p, ret);
 191   return ret;
 192 }
 193
 194 static UNUSED int w_tcsetattr(int fd, int optional_actions,
 195                        const struct termios *termios_p)
 196 {
 197   int ret;
 198   if (fd != FAKEDEV_TTY0)
 199     ret = tcsetattr(fd, optional_actions, termios_p);
 200   else
 201     ret = 0;
 202
 203   strace("tcsetattr(%d, %x, %p) = %d\n", fd, optional_actions, termios_p, ret);
 204   return ret;
 205 }
 206
 207 static UNUSED FILE *w_fopen(const char *path, const char *mode)
 208 {
 209   FILE *ret = emu_do_fopen(path, mode);
 210   strace("fopen(%s, %s) = %p\n", path, mode, ret);
 211   return ret;
 212 }
 213
 214 static UNUSED int w_system(const char *command)
 215 {
 216   int ret = emu_do_system(command);
 217   strace("system(%s) = %d\n", command, ret);
 218   return ret;
 219 }
 220
 221 extern char **environ;
 222
 223 static UNUSED int w_execl(const char *path, const char *arg, ...)
 224 {
 225   // don't allow exec (for now)
 226   strace("execl(%s, %s, ...) = ?\n", path, arg);
 227   exit(1);
 228 }
 229
 230 static UNUSED int w_execlp(const char *file, const char *arg, ...)
 231 {
 232   strace("execlp(%s, %s, ...) = ?\n", file, arg);
 233   exit(1);
 234 }
 235
 236 static UNUSED int w_execle(const char *path, const char *arg, ...)
 237 {
 238   strace("execle(%s, %s, ...) = ?\n", path, arg);
 239   exit(1);
 240 }
 241
 242 static UNUSED int w_execv(const char *path, char *const argv[])
 243 {
 244   strace("execv(%s, %p) = ?\n", path, argv);
 245   return emu_do_execve(path, argv, environ);
 246 }
 247
 248 static UNUSED int w_execvp(const char *file, char *const argv[])
 249 {
 250   strace("execvp(%s, %p) = ?\n", file, argv);
 251   return emu_do_execve(file, argv, environ);
 252 }
 253
 254 long w_execve_raw(const char *filename, char * const argv[],
 255                   char * const envp[])
 256 {
 257   strace("execve(%s, %p, %p) = ?\n", filename, argv, envp);
 258   return emu_do_execve(filename, argv, envp);
 259 }
 260
 261 static UNUSED int w_execve(const char *filename, char * const argv[],
 262                            char * const envp[])
 263 {
 264   long ret = w_execve_raw(filename, argv, envp);
 265   return g_syscall_error(ret);
 266 }
 267
 268 static int w_chdir(const char *path)
 269 {
 270   long ret;
 271
 272   if (path != NULL && strstr(path, "/usr/gp2x") != NULL)
 273     ret = 0;
 274   else
 275     ret = g_chdir_raw(path);
 276
 277   strace("chdir(%s) = %ld\n", path, ret);
 278   return g_syscall_error(ret);
 279 }
 280
 281 static ssize_t w_readlink(const char *path, char *buf, size_t bufsiz)
 282 {
 283   long ret;
 284
 285 #ifndef DL
 286   if (path != NULL && strncmp(path, "/proc/", 6) == 0
 287       && strcmp(strrchr(path, '/'), "/exe") == 0)
 288   {
 289     ret = snprintf(buf, bufsiz, "%s", bin_path);
 290     if (ret > bufsiz)
 291       ret = bufsiz;
 292   }
 293   else
 294 #endif
 295     ret = g_readlink_raw(path, buf, bufsiz);
 296
 297   strace("readlink(%s, %s, %zd) = %ld\n", path, buf, bufsiz, ret);
 298   return g_syscall_error(ret);
 299 }
 300
 301 #undef open
 302 #undef fopen
 303 #undef mmap
 304 #undef munmap
 305 #undef read
 306 #undef ioctl
 307 #undef close
 308 #undef sigaction
 309 #undef tcgetattr
 310 #undef tcsetattr
 311 #undef system
 312 #undef execl
 313 #undef execlp
 314 #undef execle
 315 #undef execv
 316 #undef execvp
 317 #undef execve
 318 #undef chdir
 319 #undef readlink
 320
 321 #ifdef DL
 322
 323 #define MAKE_WRAP_SYM_N(sym) \
 324   /* alias wrap symbols to real names */ \
 325   typeof(sym) sym __attribute__((alias("w_" #sym)))
 326
 327 #define MAKE_WRAP_SYM(sym) \
 328   MAKE_WRAP_SYM_N(sym); \
 329   /* wrapper to real functions, to be set up on load */ \
 330   static typeof(sym) *p_real_##sym
 331
 332 // note: update symver too
 333 MAKE_WRAP_SYM_N(open);
 334 MAKE_WRAP_SYM(fopen);
 335 MAKE_WRAP_SYM_N(mmap);
 336 MAKE_WRAP_SYM_N(munmap);
 337 MAKE_WRAP_SYM_N(read);
 338 MAKE_WRAP_SYM_N(ioctl);
 339 MAKE_WRAP_SYM(sigaction);
 340 MAKE_WRAP_SYM(tcgetattr);
 341 MAKE_WRAP_SYM(tcsetattr);
 342 MAKE_WRAP_SYM(system);
 343 MAKE_WRAP_SYM_N(execl);
 344 MAKE_WRAP_SYM_N(execlp);
 345 MAKE_WRAP_SYM_N(execle);
 346 MAKE_WRAP_SYM_N(execv);
 347 MAKE_WRAP_SYM_N(execvp);
 348 MAKE_WRAP_SYM_N(execve);
 349 MAKE_WRAP_SYM_N(chdir);
 350 MAKE_WRAP_SYM_N(readlink);
 351 typeof(mmap) mmap2 __attribute__((alias("w_mmap")));
 352
 353 #define REAL_FUNC_NP(name) \
 354   { #name, (void **)&p_real_##name }
 355
 356 static const struct {
 357   const char *name;
 358   void **func_ptr;
 359 } real_funcs_np[] = {
 360   //REAL_FUNC_NP(open),
 361   REAL_FUNC_NP(fopen),
 362   //REAL_FUNC_NP(mmap),
 363   //REAL_FUNC_NP(munmap),
 364   //REAL_FUNC_NP(read),
 365   //REAL_FUNC_NP(ioctl),
 366   REAL_FUNC_NP(sigaction),
 367   REAL_FUNC_NP(tcgetattr),
 368   REAL_FUNC_NP(tcsetattr),
 369   REAL_FUNC_NP(system),
 370   // exec* - skipped
 371   //REAL_FUNC_NP(execve),
 372   //REAL_FUNC_NP(chdir),
 373 };
 374
 375 //#define open p_real_open
 376 #define fopen p_real_fopen
 377 //#define mmap p_real_mmap
 378 //#define munmap p_real_munmap
 379 //#define read p_real_read
 380 //#define ioctl p_real_ioctl
 381 #define sigaction p_real_sigaction
 382 #define tcgetattr p_real_tcgetattr
 383 #define tcsetattr p_real_tcsetattr
 384 #define system p_real_system
 385 //#define execve p_real_execve
 386 //#define chdir p_real_chdir
 387
 388 #undef MAKE_WRAP_SYM
 389 #undef REAL_FUNC_NP
 390
 391 #endif
 392
 393 // just call real funcs for static, pointer for dynamic
 394 int real_open(const char *pathname, int flags, ...)
 395 {
 396   va_list ap;
 397   mode_t mode;
 398   long ret;
 399
 400   va_start(ap, flags);
 401   mode = va_arg(ap, mode_t);
 402   va_end(ap);
 403   ret = g_open_raw(pathname, flags, mode);
 404   return g_syscall_error(ret);
 405 }
 406
 407 FILE *real_fopen(const char *path, const char *mode)
 408 {
 409   return fopen(path, mode);
 410 }
 411
 412 void *real_mmap(void *addr, size_t length, int prot, int flags,
 413   int fd, off_t offset)
 414 {
 415   long ret = g_mmap2_raw(addr, length, prot, flags, fd, offset >> 12);
 416   return (void *)g_syscall_error(ret);
 417 }
 418
 419 int real_munmap(void *addr, size_t length)
 420 {
 421   return g_syscall_error(g_munmap_raw(addr, length));
 422 }
 423
 424 int real_read(int fd, void *buf, size_t count)
 425 {
 426   long ret = g_read_raw(fd, buf, count);
 427   return g_syscall_error(ret);
 428 }
 429
 430 int real_ioctl(int fd, int request, void *argp)
 431 {
 432   long ret = g_ioctl_raw(fd, request, argp);
 433   return g_syscall_error(ret);
 434 }
 435
 436 int real_close(int fd)
 437 {
 438   long ret = g_close_raw(fd);
 439   return g_syscall_error(ret);
 440 }
 441
 442 int real_sigaction(int signum, const sigaction_t *act, sigaction_t *oldact)
 443 {
 444   return sigaction(signum, act, oldact);
 445 }
 446
 447 int real_tcgetattr(int fd, struct termios *termios_p)
 448 {
 449   return tcgetattr(fd, termios_p);
 450 }
 451
 452 int real_tcsetattr(int fd, int optional_actions,
 453                        const struct termios *termios_p)
 454 {
 455   return tcsetattr(fd, optional_actions, termios_p);
 456 }
 457
 458 int real_system(const char *command)
 459 {
 460   return system(command);
 461 }
 462
 463 // real_exec* is missing intentionally - we don't need them
 464
 465 int real_execve(const char *filename, char *const argv[],
 466                   char *const envp[])
 467 {
 468   long ret = g_execve_raw(filename, argv, envp);
 469   return g_syscall_error(ret);
 470 }
 471
 472 int real_chdir(const char *path)
 473 {
 474   long ret = g_chdir_raw(path);
 475   return g_syscall_error(ret);
 476 }
 477
 478 ssize_t real_readlink(const char *path, char *buf, size_t bufsiz)
 479 {
 480   long ret = g_readlink_raw(path, buf, bufsiz);
 481   return g_syscall_error(ret);
 482 }
 483
 484 void real_sleep(unsigned int seconds)
 485 {
 486   struct timespec ts = { seconds, 0 };
 487   g_nanosleep_raw(&ts, NULL);
 488 }
 489
 490 void real_usleep(unsigned int usec)
 491 {
 492   struct timespec ts = { usec / 1000000, usec % 1000000 };
 493   g_nanosleep_raw(&ts, NULL);
 494 }
 495
 496 void real_exit(int status)
 497 {
 498   g_exit_group_raw(status);
 499 }
 500
 501 // vim:shiftwidth=2:expandtab