1 // vim:shiftwidth=2:expandtab
11 #include "sys_cacheflush.h"
14 //#define strace printf
16 static const unsigned int sig_open[] = {
17 0xe59cc000, 0xe33c0000, 0x1a000003, 0xef900005
20 static const unsigned int sig_mmap[] = {
21 0xe92d000f, 0xe1a0000d, 0xef90005a, 0xe28dd010
24 static const unsigned int sig_mmap_[] = {
25 0xe52d5004, 0xe59d5008, 0xe52d4004, 0xe59d4008,
26 0xe1b0ca05, 0x1a000006, 0xe1a05625, 0xef9000c0
29 static const unsigned int sig_read[] = {
30 0xe59fc080, 0xe59cc000, 0xe33c0000, 0x1a000003, 0xef900003
45 { "/dev/mem", FAKEDEV_MEM },
46 { "/dev/GPIO", FAKEDEV_GPIO },
47 { "/dev/fb0", FAKEDEV_FB0 },
48 { "/dev/fb/0", FAKEDEV_FB0 },
49 { "/dev/fb1", FAKEDEV_FB1 },
50 { "/dev/fb/1", FAKEDEV_FB1 },
51 { "/dev/mmuhack", FAKEDEV_MMUHACK },
54 static int w_open(const char *pathname, int flags, mode_t mode)
58 for (i = 0; i < ARRAY_SIZE(takeover_devs); i++) {
59 if (strcmp(pathname, takeover_devs[i].name) == 0) {
60 ret = takeover_devs[i].fd;
65 if (i == ARRAY_SIZE(takeover_devs))
66 ret = open(pathname, flags, mode);
68 strace("open(%s) = %d\n", pathname, ret);
72 static void *w_mmap(void *addr, size_t length, int prot, int flags, int fd, off_t offset)
75 if (fd != FAKEDEV_MEM)
76 ret = mmap(addr, length, prot, flags, fd, offset);
78 ret = emu_mmap_dev(length, prot, flags, offset);
80 // threads are using heap before they mmap their stack
81 // printf needs valid stack for pthtead/errno
82 if (((long)&ret & 0xf0000000) == 0xb0000000)
83 strace("mmap(%p, %x, %x, %x, %d, %lx) = %p\n", addr, length, prot, flags, fd, (long)offset, ret);
86 #define w_mmap_ w_mmap
88 ssize_t w_read(int fd, void *buf, size_t count)
91 if (fd != FAKEDEV_GPIO)
92 return read(fd, buf, count);
94 ret = emu_read_gpiodev(buf, count);
95 //printf("read(%d, %p, %d) = %d\n", fd, buf, count, ret);
99 #define PATCH(f) { sig_##f, ARRAY_SIZE(sig_##f), w_##f }
101 static const struct {
102 const unsigned int *sig;
108 PATCH(mmap_), // mmap using mmap2 syscall
112 void do_patches(void *ptr, unsigned int size)
116 for (i = 0; i < ARRAY_SIZE(patches); i++) {
117 const unsigned int *sig = patches[i].sig;
118 unsigned int *seg = (void *)(((long)ptr + 3) & ~3);
119 unsigned int *seg_end = seg + size / 4;
120 unsigned int sig0 = sig[0];
122 for (; seg < seg_end; seg++) {
126 for (s = 1; s < patches[i].sig_cnt; s++)
127 if (seg[s] != sig[s])
130 if (s == patches[i].sig_cnt)
136 printf(" patch #%i @ %08x\n", i, (int)seg);
137 seg[0] = 0xe59ff000; // ldr pc, [pc]
139 seg[2] = (unsigned int)patches[i].func;
142 sys_cacheflush(ptr, (char *)ptr + size);