ABC turbo
[libpicofe.git] / gp2x / gp2x.c
index f138be6..80b0486 100644 (file)
@@ -22,6 +22,7 @@
 \r
 #include <stdio.h>\r
 #include <stdlib.h>\r
+#include <stdarg.h>\r
 #include <string.h>\r
 #include <unistd.h>\r
 #include <sys/mman.h>\r
@@ -34,6 +35,7 @@
 \r
 #include "gp2x.h"\r
 #include "usbjoy.h"\r
+#include "../common/arm_utils.h"\r
 \r
 volatile unsigned short *gp2x_memregs;\r
 //static\r
@@ -42,7 +44,8 @@ static void *gp2x_screens[4];
 static int screensel = 0;\r
 //static\r
 int memdev = 0;\r
-static int sounddev = 0, mixerdev = 0;\r
+static int sounddev = -1, mixerdev = -1, touchdev = -1;\r
+static int touchcal[7] = { 6203, 0, -1501397, 0, -4200, 16132680, 65536 };\r
 \r
 void *gp2x_screen;\r
 \r
@@ -149,20 +152,29 @@ void gp2x_video_RGB_setscaling(int ln_offs, int W, int H)
 }\r
 \r
 \r
-/* LCD updates @ 80Hz? */\r
 void gp2x_video_wait_vsync(void)\r
 {\r
-       gp2x_memregs[0x2846>>1] = 0x20|2; //(gp2x_memregs[0x2846>>1] | 0x20) & ~2;\r
-       while(!(gp2x_memregs[0x2846>>1] & 2));// usleep(1);\r
+       unsigned short v = gp2x_memregs[0x1182>>1];\r
+       while (!((v ^ gp2x_memregs[0x1182>>1]) & 0x10)) spend_cycles(1024);\r
+}\r
+\r
+\r
+void gp2x_video_flush_cache(void)\r
+{\r
+       // since we are using the mmu hack, we must flush the cache first\r
+       // (the params are most likely wrong, but they seem to work somehow)\r
+       //flushcache(addr, addr + 320*240*2, 0);\r
+       flushcache(gp2x_screen, (char *)gp2x_screen + 320*240*2, 0);\r
 }\r
 \r
 \r
 void gp2x_memcpy_buffers(int buffers, void *data, int offset, int len)\r
 {\r
-       if (buffers & (1<<0)) memcpy((char *)gp2x_screens[0] + offset, data, len);\r
-       if (buffers & (1<<1)) memcpy((char *)gp2x_screens[1] + offset, data, len);\r
-       if (buffers & (1<<2)) memcpy((char *)gp2x_screens[2] + offset, data, len);\r
-       if (buffers & (1<<3)) memcpy((char *)gp2x_screens[3] + offset, data, len);\r
+       char *dst;\r
+       if (buffers & (1<<0)) { dst = (char *)gp2x_screens[0] + offset; if (dst != data) memcpy(dst, data, len); }\r
+       if (buffers & (1<<1)) { dst = (char *)gp2x_screens[1] + offset; if (dst != data) memcpy(dst, data, len); }\r
+       if (buffers & (1<<2)) { dst = (char *)gp2x_screens[2] + offset; if (dst != data) memcpy(dst, data, len); }\r
+       if (buffers & (1<<3)) { dst = (char *)gp2x_screens[3] + offset; if (dst != data) memcpy(dst, data, len); }\r
 }\r
 \r
 \r
@@ -183,21 +195,19 @@ void gp2x_memset_all_buffers(int offset, int byte, int len)
 \r
 void gp2x_pd_clone_buffer2(void)\r
 {\r
-       memcpy(gp2x_screen, gp2x_screens[2], 320*240);\r
-       memset(gp2x_screen, 0xe0, 320*8);\r
-       memset(gp2x_screen + 320*232, 0xe0, 320*8);\r
+       memcpy(gp2x_screen, gp2x_screens[2], 320*240*2);\r
 }\r
 \r
 \r
 unsigned long gp2x_joystick_read(int allow_usb_joy)\r
 {\r
        int i;\r
-       unsigned long value=(gp2x_memregs[0x1198>>1] & 0x00FF);\r
+       unsigned long value=(gp2x_memregs[0x1198>>1] & 0x00FF); // GPIO M\r
        if(value==0xFD) value=0xFA;\r
        if(value==0xF7) value=0xEB;\r
        if(value==0xDF) value=0xAF;\r
        if(value==0x7F) value=0xBE;\r
-       value = ~((gp2x_memregs[0x1184>>1] & 0xFF00) | value | (gp2x_memregs[0x1186>>1] << 16));\r
+       value = ~((gp2x_memregs[0x1184>>1] & 0xFF00) | value | (gp2x_memregs[0x1186>>1] << 16)); // C D\r
 \r
        if (allow_usb_joy && num_of_joys > 0) {\r
                // check the usb joy as well..\r
@@ -209,6 +219,39 @@ unsigned long gp2x_joystick_read(int allow_usb_joy)
        return value;\r
 }\r
 \r
+typedef struct ucb1x00_ts_event\r
+{\r
+       unsigned short pressure;\r
+       unsigned short x;\r
+       unsigned short y;\r
+       unsigned short pad;\r
+       struct timeval stamp;\r
+} UCB1X00_TS_EVENT;\r
+\r
+int gp2x_touchpad_read(int *x, int *y)\r
+{\r
+       UCB1X00_TS_EVENT event;\r
+       static int zero_seen = 0;\r
+       int retval;\r
+\r
+       if (touchdev < 0) return -1;\r
+\r
+       retval = read(touchdev, &event, sizeof(event));\r
+       if (retval < 0) {\r
+               printf("touch read failed %i %i\n", retval, errno);\r
+               return -1;\r
+       }\r
+       // this is to ignore the messed-up 4.1.x driver\r
+       if (retval == 0) zero_seen = 1;\r
+\r
+       if (x) *x = (event.x * touchcal[0] + touchcal[2]) >> 16;\r
+       if (y) *y = (event.y * touchcal[4] + touchcal[5]) >> 16;\r
+       // printf("read %i %i %i\n", event.pressure, *x, *y);\r
+\r
+       return zero_seen ? event.pressure : 0;\r
+}\r
+\r
+\r
 static int s_oldrate = 0, s_oldbits = 0, s_oldstereo = 0;\r
 \r
 void gp2x_start_sound(int rate, int bits, int stereo)\r
@@ -223,8 +266,8 @@ void gp2x_start_sound(int rate, int bits, int stereo)
        if (sounddev == -1)\r
                printf("open(\"/dev/dsp\") failed with %i\n", errno);\r
 \r
-       ioctl(sounddev, SNDCTL_DSP_SPEED,  &rate);\r
        ioctl(sounddev, SNDCTL_DSP_SETFMT, &bits);\r
+       ioctl(sounddev, SNDCTL_DSP_SPEED,  &rate);\r
        ioctl(sounddev, SNDCTL_DSP_STEREO, &stereo);\r
        // calculate buffer size\r
        buffers = 16;\r
@@ -233,11 +276,12 @@ void gp2x_start_sound(int rate, int bits, int stereo)
        while ((bsize>>=1)) frag++;\r
        frag |= buffers<<16; // 16 buffers\r
        ioctl(sounddev, SNDCTL_DSP_SETFRAGMENT, &frag);\r
+       usleep(192*1024);\r
+\r
        printf("gp2x_set_sound: %i/%ibit/%s, %i buffers of %i bytes\n",\r
                rate, bits, stereo?"stereo":"mono", frag>>16, 1<<(frag&0xffff));\r
 \r
        s_oldrate = rate; s_oldbits = bits; s_oldstereo = stereo;\r
-       usleep(100000);\r
 }\r
 \r
 \r
@@ -274,6 +318,31 @@ void Reset940(int yes, int bank)
        gp2x_memregs[0x3B48>>1] = ((yes&1) << 7) | (bank & 0x03);\r
 }\r
 \r
+static void proc_set(const char *path, const char *val)\r
+{\r
+       FILE *f;\r
+       char tmp[16];\r
+\r
+       f = fopen(path, "w");\r
+       if (f == NULL) {\r
+               printf("failed to open: %s\n", path);\r
+               return;\r
+       }\r
+\r
+       fprintf(f, "0\n");\r
+       fclose(f);\r
+\r
+       printf("\"%s\" is set to: ", path);\r
+       f = fopen(path, "r");\r
+       if (f == NULL) {\r
+               printf("(open failed)\n");\r
+               return;\r
+       }\r
+\r
+       fgets(tmp, sizeof(tmp), f);\r
+       printf("%s", tmp);\r
+       fclose(f);\r
+}\r
 \r
 \r
 /* common */\r
@@ -297,6 +366,8 @@ void gp2x_init(void)
        }\r
        gp2x_memregl = (unsigned long *) gp2x_memregs;\r
 \r
+       gp2x_memregs[0x2880>>1] &= ~0x383; // disable cursor, subpict, osd, video layers\r
+\r
        gp2x_screens[0] = mmap(0, FRAMEBUFF_WHOLESIZE, PROT_WRITE, MAP_SHARED, memdev, FRAMEBUFF_ADDR0);\r
        if(gp2x_screens[0] == MAP_FAILED)\r
        {\r
@@ -327,6 +398,22 @@ void gp2x_init(void)
        /* init usb joys -GnoStiC */\r
        gp2x_usbjoy_init();\r
 \r
+       // touchscreen\r
+       touchdev = open("/dev/touchscreen/wm97xx", O_RDONLY);\r
+       if (touchdev >= 0) {\r
+               FILE *pcf = fopen("/etc/pointercal", "r");\r
+               if (pcf) {\r
+                       fscanf(pcf, "%d %d %d %d %d %d %d", &touchcal[0], &touchcal[1],\r
+                               &touchcal[2], &touchcal[3], &touchcal[4], &touchcal[5], &touchcal[6]);\r
+                       fclose(pcf);\r
+               }\r
+               printf("found touchscreen/wm97xx\n");\r
+       }\r
+\r
+       /* disable Linux read-ahead */\r
+       proc_set("/proc/sys/vm/max-readahead", "0\n");\r
+       proc_set("/proc/sys/vm/min-readahead", "0\n");\r
+\r
        printf("exitting init()\n"); fflush(stdout);\r
 }\r
 \r
@@ -347,7 +434,8 @@ void gp2x_deinit(void)
        munmap((void *)gp2x_memregs, 0x10000);\r
        close(memdev);\r
        close(mixerdev);\r
-       if (sounddev > 0) close(sounddev);\r
+       if (sounddev >= 0) close(sounddev);\r
+       if (touchdev >= 0) close(touchdev);\r
 \r
        gp2x_usbjoy_deinit();\r
 \r
@@ -367,4 +455,13 @@ void gp2x_deinit(void)
        }\r
 }\r
 \r
+/* lprintf */\r
+void lprintf(const char *fmt, ...)\r
+{\r
+       va_list vl;\r
+\r
+       va_start(vl, fmt);\r
+       vprintf(fmt, vl);\r
+       va_end(vl);\r
+}\r
 \r