gp2x/soc_mmsp2.c

   1 #include <stdio.h>
   2 #include <stdlib.h>
   3 #include <string.h>
   4 #include <sys/types.h>
   5 #include <sys/stat.h>
   6 #include <fcntl.h>
   7 #include <sys/mman.h>
   8 #include <unistd.h>
   9
  10 #include "soc.h"
  11 #include "soc_mmsp2.h"
  12 #include "gp2x.h"
  13 #include "../common/emu.h"
  14 #include "../common/arm_utils.h"
  15
  16 volatile unsigned short *gp2x_memregs;
  17 volatile unsigned long  *gp2x_memregl;
  18 extern void *gp2x_screens[4];
  19 static int screensel = 0;
  20
  21 int memdev = 0; /* used by code940 */
  22 static int touchdev = -1;
  23 static int touchcal[7] = { 6203, 0, -1501397, 0, -4200, 16132680, 65536 };
  24
  25 #define FRAMEBUFF_SIZE  0x30000
  26 #define FRAMEBUFF_WHOLESIZE (FRAMEBUFF_SIZE*4) // 320*240*2 + some more
  27 #define FRAMEBUFF_ADDR0 (0x4000000 - FRAMEBUFF_WHOLESIZE)
  28 #define FRAMEBUFF_ADDR1 (FRAMEBUFF_ADDR0 + FRAMEBUFF_SIZE)
  29 #define FRAMEBUFF_ADDR2 (FRAMEBUFF_ADDR1 + FRAMEBUFF_SIZE)
  30 #define FRAMEBUFF_ADDR3 (FRAMEBUFF_ADDR2 + FRAMEBUFF_SIZE)
  31
  32 static const int gp2x_screenaddrs[4] = { FRAMEBUFF_ADDR0, FRAMEBUFF_ADDR1, FRAMEBUFF_ADDR2, FRAMEBUFF_ADDR3 };
  33 static int gp2x_screenaddrs_use[4];
  34 static unsigned short gp2x_screenaddr_old[4];
  35
  36
  37 /* video stuff */
  38 void gp2x_video_flip(void)
  39 {
  40         unsigned short lsw = (unsigned short) gp2x_screenaddrs_use[screensel&3];
  41         unsigned short msw = (unsigned short)(gp2x_screenaddrs_use[screensel&3] >> 16);
  42
  43         gp2x_memregs[0x2910>>1] = msw;
  44         gp2x_memregs[0x2914>>1] = msw;
  45         gp2x_memregs[0x290E>>1] = lsw;
  46         gp2x_memregs[0x2912>>1] = lsw;
  47
  48         // jump to other buffer:
  49         g_screen_ptr = gp2x_screens[++screensel&3];
  50 }
  51
  52 /* doulblebuffered flip */
  53 void gp2x_video_flip2(void)
  54 {
  55         unsigned short msw = (unsigned short)(gp2x_screenaddrs_use[screensel&1] >> 16);
  56
  57         gp2x_memregs[0x2910>>1] = msw;
  58         gp2x_memregs[0x2914>>1] = msw;
  59         gp2x_memregs[0x290E>>1] = 0;
  60         gp2x_memregs[0x2912>>1] = 0;
  61
  62         // jump to other buffer:
  63         g_screen_ptr = gp2x_screens[++screensel&1];
  64 }
  65
  66 void gp2x_video_changemode_ll(int bpp)
  67 {
  68         gp2x_memregs[0x28DA>>1] = (((bpp+1)/8)<<9)|0xAB; /*8/15/16/24bpp...*/
  69         gp2x_memregs[0x290C>>1] = 320*((bpp+1)/8); /*line width in bytes*/
  70 }
  71
  72 void gp2x_video_setpalette(int *pal, int len)
  73 {
  74         unsigned short *g = (unsigned short *)pal;
  75         volatile unsigned short *memreg = &gp2x_memregs[0x295A>>1];
  76
  77         gp2x_memregs[0x2958>>1] = 0;
  78
  79         len *= 2;
  80         while (len--)
  81                 *memreg = *g++;
  82 }
  83
  84 // TV Compatible function //
  85 void gp2x_video_RGB_setscaling(int ln_offs, int W, int H)
  86 {
  87         float escalaw, escalah;
  88         int bpp = (gp2x_memregs[0x28DA>>1]>>9)&0x3;
  89         unsigned short scalw;
  90
  91         // set offset
  92         gp2x_screenaddrs_use[0] = gp2x_screenaddrs[0] + ln_offs * 320 * bpp;
  93         gp2x_screenaddrs_use[1] = gp2x_screenaddrs[1] + ln_offs * 320 * bpp;
  94         gp2x_screenaddrs_use[2] = gp2x_screenaddrs[2] + ln_offs * 320 * bpp;
  95         gp2x_screenaddrs_use[3] = gp2x_screenaddrs[3] + ln_offs * 320 * bpp;
  96
  97         escalaw = 1024.0; // RGB Horiz LCD
  98         escalah = 320.0; // RGB Vert LCD
  99
 100         if(gp2x_memregs[0x2800>>1]&0x100) //TV-Out
 101         {
 102                 escalaw=489.0; // RGB Horiz TV (PAL, NTSC)
 103                 if (gp2x_memregs[0x2818>>1]  == 287) //PAL
 104                         escalah=274.0; // RGB Vert TV PAL
 105                 else if (gp2x_memregs[0x2818>>1]  == 239) //NTSC
 106                         escalah=331.0; // RGB Vert TV NTSC
 107         }
 108
 109         // scale horizontal
 110         scalw = (unsigned short)((float)escalaw *(W/320.0));
 111         /* if there is no horizontal scaling, vertical doesn't work. Here is a nasty wrokaround... */
 112         if (H != 240 && W == 320) scalw--;
 113         gp2x_memregs[0x2906>>1]=scalw;
 114         // scale vertical
 115         gp2x_memregl[0x2908>>2]=(unsigned long)((float)escalah *bpp *(H/240.0));
 116 }
 117
 118 void gp2x_video_wait_vsync(void)
 119 {
 120         unsigned short v = gp2x_memregs[0x1182>>1];
 121         while (!((v ^ gp2x_memregs[0x1182>>1]) & 0x10))
 122                 spend_cycles(1024);
 123 }
 124
 125 /* 940 */
 126 void pause940(int yes)
 127 {
 128         if (yes)
 129                 gp2x_memregs[0x0904>>1] &= 0xFFFE;
 130         else
 131                 gp2x_memregs[0x0904>>1] |= 1;
 132 }
 133
 134 void reset940(int yes, int bank)
 135 {
 136         gp2x_memregs[0x3B48>>1] = ((yes&1) << 7) | (bank & 0x03);
 137 }
 138
 139
 140 /* these are not quite MMSP2 related,
 141  * more to GP2X F100/F200 consoles themselves. */
 142 typedef struct ucb1x00_ts_event
 143 {
 144         unsigned short pressure;
 145         unsigned short x;
 146         unsigned short y;
 147         unsigned short pad;
 148         struct timeval stamp;
 149 } UCB1X00_TS_EVENT;
 150
 151 int gp2x_touchpad_read(int *x, int *y)
 152 {
 153         UCB1X00_TS_EVENT event;
 154         static int zero_seen = 0;
 155         int retval;
 156
 157         if (touchdev < 0) return -1;
 158
 159         retval = read(touchdev, &event, sizeof(event));
 160         if (retval <= 0) {
 161                 perror("touch read failed");
 162                 return -1;
 163         }
 164         // this is to ignore the messed-up 4.1.x driver
 165         if (event.pressure == 0) zero_seen = 1;
 166
 167         if (x) *x = (event.x * touchcal[0] + touchcal[2]) >> 16;
 168         if (y) *y = (event.y * touchcal[4] + touchcal[5]) >> 16;
 169         // printf("read %i %i %i\n", event.pressure, *x, *y);
 170
 171         return zero_seen ? event.pressure : 0;
 172 }
 173
 174 static void proc_set(const char *path, const char *val)
 175 {
 176         FILE *f;
 177         char tmp[16];
 178
 179         f = fopen(path, "w");
 180         if (f == NULL) {
 181                 printf("failed to open: %s\n", path);
 182                 return;
 183         }
 184
 185         fprintf(f, "0\n");
 186         fclose(f);
 187
 188         printf("\"%s\" is set to: ", path);
 189         f = fopen(path, "r");
 190         if (f == NULL) {
 191                 printf("(open failed)\n");
 192                 return;
 193         }
 194
 195         fgets(tmp, sizeof(tmp), f);
 196         printf("%s", tmp);
 197         fclose(f);
 198 }
 199
 200
 201 void mmsp2_init(void)
 202 {
 203         int i;
 204
 205         memdev = open("/dev/mem", O_RDWR);
 206         if (memdev == -1)
 207         {
 208                 perror("open(\"/dev/mem\")");
 209                 exit(1);
 210         }
 211
 212         gp2x_memregs = mmap(0, 0x10000, PROT_READ|PROT_WRITE, MAP_SHARED, memdev, 0xc0000000);
 213         if (gp2x_memregs == MAP_FAILED)
 214         {
 215                 perror("mmap(memregs)");
 216                 exit(1);
 217         }
 218         gp2x_memregl = (unsigned long *) gp2x_memregs;
 219
 220         gp2x_memregs[0x2880>>1] &= ~0x383; // disable cursor, subpict, osd, video layers
 221
 222         gp2x_screens[0] = mmap(0, FRAMEBUFF_WHOLESIZE, PROT_WRITE, MAP_SHARED,
 223                 memdev, gp2x_screenaddrs[0]);
 224         if (gp2x_screens[0] == MAP_FAILED)
 225         {
 226                 perror("mmap(g_screen_ptr)");
 227                 exit(1);
 228         }
 229         printf("framebuffers:\n");
 230         printf("  %08x -> %p\n", gp2x_screenaddrs[0], gp2x_screens[0]);
 231         for (i = 1; i < 4; i++)
 232         {
 233                 gp2x_screens[i] = (char *) gp2x_screens[i - 1] + FRAMEBUFF_SIZE;
 234                 printf("  %08x -> %p\n", gp2x_screenaddrs[i], gp2x_screens[i]);
 235         }
 236
 237         g_screen_ptr = gp2x_screens[0];
 238         screensel = 0;
 239
 240         gp2x_screenaddr_old[0] = gp2x_memregs[0x290E>>1];
 241         gp2x_screenaddr_old[1] = gp2x_memregs[0x2910>>1];
 242         gp2x_screenaddr_old[2] = gp2x_memregs[0x2912>>1];
 243         gp2x_screenaddr_old[3] = gp2x_memregs[0x2914>>1];
 244
 245         memcpy(gp2x_screenaddrs_use, gp2x_screenaddrs, sizeof(gp2x_screenaddrs));
 246
 247         // touchscreen
 248         touchdev = open("/dev/touchscreen/wm97xx", O_RDONLY);
 249         if (touchdev >= 0) {
 250                 FILE *pcf = fopen("/etc/pointercal", "r");
 251                 if (pcf) {
 252                         fscanf(pcf, "%d %d %d %d %d %d %d", &touchcal[0], &touchcal[1],
 253                                 &touchcal[2], &touchcal[3], &touchcal[4], &touchcal[5], &touchcal[6]);
 254                         fclose(pcf);
 255                 }
 256                 printf("found touchscreen/wm97xx\n");
 257         }
 258
 259         /* disable Linux read-ahead */
 260         proc_set("/proc/sys/vm/max-readahead", "0\n");
 261         proc_set("/proc/sys/vm/min-readahead", "0\n");
 262 }
 263
 264 void mmsp2_finish(void)
 265 {
 266         reset940(1, 3);
 267         pause940(1);
 268
 269         gp2x_memregs[0x290E>>1] = gp2x_screenaddr_old[0];
 270         gp2x_memregs[0x2910>>1] = gp2x_screenaddr_old[1];
 271         gp2x_memregs[0x2912>>1] = gp2x_screenaddr_old[2];
 272         gp2x_memregs[0x2914>>1] = gp2x_screenaddr_old[3];
 273
 274         munmap(gp2x_screens[0], FRAMEBUFF_WHOLESIZE);
 275         munmap((void *)gp2x_memregs, 0x10000);
 276         close(memdev);
 277         if (touchdev >= 0)
 278                 close(touchdev);
 279 }
 280