wip, fb sync thread

[ginge.git] / loader / patches.c

diff --git a/loader/patches.c b/loader/patches.c
index 9354d2f..402de84 100644 (file)
--- a/loader/patches.c
+++ b/loader/patches.c
@@ -5,10 +5,14 @@
 #include <sys/stat.h>
 #include <fcntl.h>
 #include <sys/mman.h>
+#include <unistd.h>
 
 #include "header.h"
 #include "sys_cacheflush.h"
 
+#define strace(...)
+//#define strace printf
+
 static const unsigned int sig_open[] = {
   0xe59cc000, 0xe33c0000, 0x1a000003, 0xef900005
 };
@@ -22,33 +26,76 @@ static const unsigned int sig_mmap_[] = {
   0xe1b0ca05, 0x1a000006, 0xe1a05625, 0xef9000c0
 };
 
-#define FAKE_DEVMEM_DEVICE 10001
+static const unsigned int sig_read[] = {
+  0xe59fc080, 0xe59cc000, 0xe33c0000, 0x1a000003, 0xef900003
+};
+
+enum {
+  FAKEDEV_MEM = 10001,
+  FAKEDEV_GPIO,
+  FAKEDEV_FB0,
+  FAKEDEV_FB1,
+  FAKEDEV_MMUHACK,
+};
+
+static const struct {
+  const char *name;
+  int fd;
+} takeover_devs[] = {
+  { "/dev/mem",     FAKEDEV_MEM },
+  { "/dev/GPIO",    FAKEDEV_GPIO },
+  { "/dev/fb0",     FAKEDEV_FB0 },
+  { "/dev/fb/0",    FAKEDEV_FB0 },
+  { "/dev/fb1",     FAKEDEV_FB1 },
+  { "/dev/fb/1",    FAKEDEV_FB1 },
+  { "/dev/mmuhack", FAKEDEV_MMUHACK },
+};
 
 static int w_open(const char *pathname, int flags, mode_t mode)
 {
-  int ret;
-  if (strcmp(pathname, "/dev/mem") != 0)
+  int i, ret;
+
+  for (i = 0; i < ARRAY_SIZE(takeover_devs); i++) {
+    if (strcmp(pathname, takeover_devs[i].name) == 0) {
+      ret = takeover_devs[i].fd;
+      break;
+    }
+  }
+
+  if (i == ARRAY_SIZE(takeover_devs))
     ret = open(pathname, flags, mode);
-  else
-    ret = FAKE_DEVMEM_DEVICE;
 
-  printf("open(%s) = %d\n", pathname, ret);
+  strace("open(%s) = %d\n", pathname, ret);
   return ret;
 }
 
 static void *w_mmap(void *addr, size_t length, int prot, int flags, int fd, off_t offset)
 {
   void *ret;
-  if (fd != FAKE_DEVMEM_DEVICE)
+  if (fd != FAKEDEV_MEM)
     ret = mmap(addr, length, prot, flags, fd, offset);
   else
     ret = emu_mmap_dev(length, prot, flags, offset);
 
-  printf("mmap(%p, %x, %x, %x, %d, %lx) = %p\n", addr, length, prot, flags, fd, (long)offset, ret);
+  // threads are using heap before they mmap their stack
+  // printf needs valid stack for pthtead/errno
+  if (((long)&ret & 0xf0000000) == 0xb0000000)
+    strace("mmap(%p, %x, %x, %x, %d, %lx) = %p\n", addr, length, prot, flags, fd, (long)offset, ret);
   return ret;
 }
 #define w_mmap_ w_mmap
 
+ssize_t w_read(int fd, void *buf, size_t count)
+{
+  ssize_t ret;
+  if (fd != FAKEDEV_GPIO)
+    return read(fd, buf, count);
+
+  ret = emu_read_gpiodev(buf, count);
+  //printf("read(%d, %p, %d) = %d\n", fd, buf, count, ret);
+  return ret;
+}
+
 #define PATCH(f) { sig_##f, ARRAY_SIZE(sig_##f), w_##f }
 
 static const struct {
@@ -59,6 +106,7 @@ static const struct {
   PATCH(open),
   PATCH(mmap),
   PATCH(mmap_), // mmap using mmap2 syscall
+  PATCH(read),
 };
 
 void do_patches(void *ptr, unsigned int size)