1 // vim:shiftwidth=2:expandtab
12 #include "sys_cacheflush.h"
20 // note: first mask must be always full for search algo
21 static const unsigned int sig_mask_all[] = {
22 0xffffffff, 0xffffffff, 0xffffffff, 0xffffffff,
23 0xffffffff, 0xffffffff, 0xffffffff, 0xffffffff
26 static const unsigned int sig_open[] = {
27 0xe59cc000, 0xe33c0000, 0x1a000003, 0xef900005
29 #define sig_mask_open sig_mask_all
31 static const unsigned int sig_mmap[] = {
32 0xe92d000f, 0xe1a0000d, 0xef90005a, 0xe28dd010
34 #define sig_mask_mmap sig_mask_all
36 static const unsigned int sig_mmap_[] = {
37 0xe52d5004, 0xe59d5008, 0xe52d4004, 0xe59d4008,
38 0xe1b0ca05, 0x1a000006, 0xe1a05625, 0xef9000c0
40 #define sig_mask_mmap_ sig_mask_all
42 static const unsigned int sig_read[] = {
43 0xe59fc080, 0xe59cc000, 0xe33c0000, 0x1a000003, 0xef900003
45 #define sig_mask_read sig_mask_all
47 static const unsigned int sig_ioctl[] = {
48 0xef900036, 0xe3700a01, 0x312fff1e
50 #define sig_mask_ioctl sig_mask_all
52 static const unsigned int sig_sigaction[] = {
53 0xe59f300c, 0xe3530000, 0x0a000000, 0xea000000, 0xea000000
55 static const unsigned int sig_mask_sigaction[] = {
56 0xffffffff, 0xffffffff, 0xffffffff, 0xff000000, 0xff000000
59 static const struct dev_fd_t takeover_devs[] = {
60 { "/dev/mem", FAKEDEV_MEM },
61 { "/dev/GPIO", FAKEDEV_GPIO },
62 { "/dev/fb0", FAKEDEV_FB0 },
63 { "/dev/fb/0", FAKEDEV_FB0 },
64 { "/dev/fb1", FAKEDEV_FB1 },
65 { "/dev/fb/1", FAKEDEV_FB1 },
66 { "/dev/mmuhack", FAKEDEV_MMUHACK },
69 static int w_open(const char *pathname, int flags, mode_t mode)
73 for (i = 0; i < ARRAY_SIZE(takeover_devs); i++) {
74 if (strcmp(pathname, takeover_devs[i].name) == 0) {
75 ret = takeover_devs[i].fd;
80 if (i == ARRAY_SIZE(takeover_devs))
81 ret = open(pathname, flags, mode);
84 for (i = 0; emu_interesting_fds[i].name != NULL; i++) {
85 if (strcmp(pathname, emu_interesting_fds[i].name) == 0) {
86 emu_interesting_fds[i].fd = ret;
92 strace("open(%s) = %d\n", pathname, ret);
96 static void *w_mmap(void *addr, size_t length, int prot, int flags, int fd, off_t offset)
99 if (FAKEDEV_MEM <= fd && fd < FAKEDEV_FD_BOUNDARY)
100 ret = emu_do_mmap(length, prot, flags, fd, offset);
102 ret = mmap(addr, length, prot, flags, fd, offset);
104 // threads are using heap before they mmap their stack
105 // printf needs valid stack for pthtead/errno
106 if (((long)&ret & 0xf0000000) == 0xb0000000)
107 strace("mmap(%p, %x, %x, %x, %d, %lx) = %p\n", addr, length, prot, flags, fd, (long)offset, ret);
110 #define w_mmap_ w_mmap
112 static ssize_t w_read(int fd, void *buf, size_t count)
115 if (fd != FAKEDEV_GPIO)
116 return read(fd, buf, count);
118 ret = emu_read_gpiodev(buf, count);
119 //strace("read(%d, %p, %d) = %d\n", fd, buf, count, ret);
123 static int w_ioctl(int fd, int request, void *argp)
127 if ((FAKEDEV_MEM <= fd && fd < FAKEDEV_FD_BOUNDARY) ||
128 fd == emu_interesting_fds[IFD_SOUND].fd)
129 ret = emu_do_ioctl(fd, request, argp);
131 ret = ioctl(fd, request, argp);
133 strace("ioctl(%d, %08x, %p) = %d\n", fd, request, argp, ret);
137 static int w_sigaction(int signum, const void *act, void *oldact)
139 strace("sigaction(%d, %p, %p) = %d\n", signum, act, oldact, 0);
143 #define PATCH(f) { sig_##f, sig_mask_##f, ARRAY_SIZE(sig_##f), w_##f }
145 static const struct {
146 const unsigned int *sig;
147 const unsigned int *sig_mask;
153 PATCH(mmap_), // mmap using mmap2 syscall
159 void do_patches(void *ptr, unsigned int size)
163 for (i = 0; i < ARRAY_SIZE(patches); i++) {
164 const unsigned int *sig = patches[i].sig;
165 const unsigned int *sig_mask = patches[i].sig_mask;
166 unsigned int *seg = (void *)(((long)ptr + 3) & ~3);
167 unsigned int *seg_end = seg + size / 4;
168 unsigned int sig0 = sig[0];
170 for (; seg < seg_end; seg++) {
174 for (s = 1; s < patches[i].sig_cnt; s++)
175 if ((seg[s] ^ sig[s]) & sig_mask[s])
178 if (s == patches[i].sig_cnt)
184 dbg(" patch #%i @ %08x\n", i, (int)seg);
185 seg[0] = 0xe59ff000; // ldr pc, [pc]
187 seg[2] = (unsigned int)patches[i].func;
190 sys_cacheflush(ptr, (char *)ptr + size);