frontend/plat_pollux.c

   1 /*
   2  * (C) Gražvydas "notaz" Ignotas, 2009-2012
   3  *
   4  * This work is licensed under the terms of the GNU GPLv2 or later.
   5  * See the COPYING file in the top-level directory.
   6  *
   7  * GPH claims:
   8  *  Main Memory  : Wiz = 0       ~ 2A00000,      Caanoo = 0       ~ 5600000 (86M)
   9  *  Frame Buffer : Wiz = 2A00000 ~ 2E00000 (4M), Caanoo = 5600000 ~ 5700000 (1M)
  10  *  Sound Buffer : Wiz = 2E00000 ~ 3000000 (2M), Caanoo = 5700000 ~ 5800000 (1M)
  11  *  YUV Buffer   :                               Caanoo = 5800000 ~ 6000000 (8M)
  12  *  3D Buffer    : Wiz = 3000000 ~ 4000000 (16M),Caanoo = 6000000 ~ 8000000 (32M)
  13  *
  14  * Caanoo dram column (or row?) is 1024 bytes?
  15  *
  16  * pollux display array:
  17  * 27:24 |  23:18  |  17:11  |  10:6  |  5:0
  18  *  seg  | y[11:5] | x[11:6] | y[4:0] | x[5:0]
  19  *       |  blk_index[12:0]  |   block[10:0]
  20  */
  21
  22 #include <stdio.h>
  23 #include <stdlib.h>
  24 #include <string.h>
  25 #include <sys/types.h>
  26 #include <sys/stat.h>
  27 #include <fcntl.h>
  28 #include <sys/ioctl.h>
  29 #include <unistd.h>
  30 #include <linux/fb.h>
  31 #include <sys/mman.h>
  32 #include <linux/soundcard.h>
  33 #include <linux/input.h>
  34
  35 #include "libpicofe/plat.h"
  36 #include "libpicofe/input.h"
  37 #include "libpicofe/gp2x/in_gp2x.h"
  38 #include "libpicofe/gp2x/soc_pollux.h"
  39 #include "libpicofe/linux/in_evdev.h"
  40 #include "libpicofe/menu.h"
  41 #include "warm/warm.h"
  42 #include "plugin_lib.h"
  43 #include "pl_gun_ts.h"
  44 #include "blit320.h"
  45 #include "in_tsbutton.h"
  46 #include "main.h"
  47 #include "menu.h"
  48 #include "plat.h"
  49 #include "cspace.h"
  50 #include "../libpcsxcore/psxmem_map.h"
  51
  52
  53 static int fbdev = -1;
  54 static void *fb_vaddrs[2];
  55 static unsigned int fb_paddrs[2];
  56 static int fb_work_buf;
  57 static int have_warm;
  58 #define FB_VRAM_SIZE (320*240*2*2*2) // 2 buffers with space for 24bpp mode
  59 static unsigned int uppermem_pbase, vram_pbase;
  60
  61 static unsigned short *psx_vram;
  62 static int psx_step, psx_width, psx_height, psx_bpp;
  63 static int psx_offset_x, psx_offset_y, psx_src_width, psx_src_height;
  64 static int fb_offset_x, fb_offset_y;
  65
  66 static void caanoo_init(void);
  67 static void wiz_init(void);
  68
  69
  70 static const struct in_default_bind in_evdev_defbinds[] = {
  71         { KEY_UP,       IN_BINDTYPE_PLAYER12, DKEY_UP },
  72         { KEY_DOWN,     IN_BINDTYPE_PLAYER12, DKEY_DOWN },
  73         { KEY_LEFT,     IN_BINDTYPE_PLAYER12, DKEY_LEFT },
  74         { KEY_RIGHT,    IN_BINDTYPE_PLAYER12, DKEY_RIGHT },
  75         { BTN_TOP,      IN_BINDTYPE_PLAYER12, DKEY_TRIANGLE },
  76         { BTN_THUMB,    IN_BINDTYPE_PLAYER12, DKEY_CROSS },
  77         { BTN_THUMB2,   IN_BINDTYPE_PLAYER12, DKEY_CIRCLE },
  78         { BTN_TRIGGER,  IN_BINDTYPE_PLAYER12, DKEY_SQUARE },
  79         { BTN_BASE3,    IN_BINDTYPE_PLAYER12, DKEY_START },
  80         { BTN_BASE4,    IN_BINDTYPE_PLAYER12, DKEY_SELECT },
  81         { BTN_TOP2,     IN_BINDTYPE_PLAYER12, DKEY_L1 },
  82         { BTN_PINKIE,   IN_BINDTYPE_PLAYER12, DKEY_R1 },
  83         { BTN_BASE,     IN_BINDTYPE_EMU, SACTION_ENTER_MENU },
  84         { 0, 0, 0 },
  85 };
  86
  87 static const struct menu_keymap key_pbtn_map[] =
  88 {
  89         { KEY_UP,       PBTN_UP },
  90         { KEY_DOWN,     PBTN_DOWN },
  91         { KEY_LEFT,     PBTN_LEFT },
  92         { KEY_RIGHT,    PBTN_RIGHT },
  93         /* Caanoo */
  94         { BTN_THUMB2,   PBTN_MOK },
  95         { BTN_THUMB,    PBTN_MBACK },
  96         { BTN_TRIGGER,  PBTN_MA2 },
  97         { BTN_TOP,      PBTN_MA3 },
  98         { BTN_BASE,     PBTN_MENU },
  99         { BTN_TOP2,     PBTN_L },
 100         { BTN_PINKIE,   PBTN_R },
 101         /* "normal" keyboards */
 102         { KEY_ENTER,    PBTN_MOK },
 103         { KEY_ESC,      PBTN_MBACK },
 104         { KEY_SEMICOLON,  PBTN_MA2 },
 105         { KEY_APOSTROPHE, PBTN_MA3 },
 106         { KEY_BACKSLASH,  PBTN_MENU },
 107         { KEY_LEFTBRACE,  PBTN_L },
 108         { KEY_RIGHTBRACE, PBTN_R },
 109 };
 110
 111 static const struct in_pdata gp2x_evdev_pdata = {
 112         .defbinds = in_evdev_defbinds,
 113         .key_map = key_pbtn_map,
 114         .kmap_size = sizeof(key_pbtn_map) / sizeof(key_pbtn_map[0]),
 115 };
 116
 117 static void *fb_flip(void)
 118 {
 119         memregl[0x406C>>2] = memregl[0x446C>>2] = fb_paddrs[fb_work_buf];
 120         memregl[0x4058>>2] |= 0x10;
 121         memregl[0x4458>>2] |= 0x10;
 122         fb_work_buf ^= 1;
 123         return fb_vaddrs[fb_work_buf];
 124 }
 125
 126 static void pollux_changemode(int bpp, int is_bgr)
 127 {
 128         int code = 0, bytes = 2;
 129         unsigned int r;
 130
 131         printf("changemode: %dbpp %s\n", bpp, is_bgr ? "bgr" : "rgb");
 132
 133         memregl[0x4004>>2] = 0x00ef013f;
 134         memregl[0x4000>>2] |= 1 << 3;
 135
 136         switch (bpp)
 137         {
 138                 case 8:
 139                         code = 0x443a;
 140                         bytes = 1;
 141                         break;
 142                 case 16:
 143                         code = is_bgr ? 0xc342 : 0x4432;
 144                         bytes = 2;
 145                         break;
 146                 case 24:
 147                         code = is_bgr ? 0xc653 : 0x4653;
 148                         bytes = 3;
 149                         break;
 150                 default:
 151                         printf("unhandled bpp request: %d\n", bpp);
 152                         return;
 153         }
 154
 155         // program both MLCs so that TV-out works
 156         memregl[0x405c>>2] = memregl[0x445c>>2] = bytes;
 157         memregl[0x4060>>2] = memregl[0x4460>>2] = 320 * bytes;
 158
 159         r = memregl[0x4058>>2];
 160         r = (r & 0xffff) | (code << 16) | 0x10;
 161         memregl[0x4058>>2] = r;
 162
 163         r = memregl[0x4458>>2];
 164         r = (r & 0xffff) | (code << 16) | 0x10;
 165         memregl[0x4458>>2] = r;
 166 }
 167
 168 static int cpu_clock_wrapper(int mhz)
 169 {
 170         // stupid pll share hack - must restart audio
 171         int pollux_cpu_clock_set(int cpu_clock);
 172         extern long SPUopen(void);
 173         extern long SPUclose(void);
 174
 175         pollux_cpu_clock_set(mhz);
 176         SPUclose();
 177         SPUopen();
 178
 179         return 0;
 180 }
 181
 182 #define TIMER_BASE3 0x1980
 183 #define TIMER_REG(x) memregl[(TIMER_BASE3 + x) >> 2]
 184
 185 static __attribute__((unused)) unsigned int timer_get(void)
 186 {
 187         TIMER_REG(0x08) |= 0x48;  /* run timer, latch value */
 188         return TIMER_REG(0);
 189 }
 190
 191 void plat_video_menu_enter(int is_rom_loaded)
 192 {
 193         if (pl_vout_buf != NULL) {
 194                 if (psx_bpp == 16)
 195                         // have to do rgb conversion for menu bg
 196                         bgr555_to_rgb565(pl_vout_buf, pl_vout_buf, 320*240*2);
 197                 else
 198                         memset(pl_vout_buf, 0, 320*240*2);
 199         }
 200
 201         pollux_changemode(16, 0);
 202 }
 203
 204 void plat_video_menu_begin(void)
 205 {
 206 }
 207
 208 void plat_video_menu_end(void)
 209 {
 210         g_menuscreen_ptr = fb_flip();
 211 }
 212
 213 void plat_video_menu_leave(void)
 214 {
 215         if (psx_vram == NULL) {
 216                 fprintf(stderr, "GPU plugin did not provide vram\n");
 217                 exit(1);
 218         }
 219
 220         if (gp2x_dev_id == GP2X_DEV_CAANOO)
 221                 in_set_config_int(in_name_to_id("evdev:pollux-analog"),
 222                         IN_CFG_ABS_DEAD_ZONE, analog_deadzone);
 223
 224         memset(g_menuscreen_ptr, 0, 320*240 * psx_bpp/8);
 225         g_menuscreen_ptr = fb_flip();
 226         memset(g_menuscreen_ptr, 0, 320*240 * psx_bpp/8);
 227 }
 228
 229 void *plat_prepare_screenshot(int *w, int *h, int *bpp)
 230 {
 231         bgr555_to_rgb565(pl_vout_buf, pl_vout_buf, 320*240*2);
 232         *w = 320;
 233         *h = 240;
 234         *bpp = psx_bpp;
 235         return pl_vout_buf;
 236 }
 237
 238 void plat_minimize(void)
 239 {
 240 }
 241
 242 static void spend_cycles(int loops)
 243 {
 244         asm volatile (
 245                 "   mov  r0,%0    ;\n"
 246                 "0: subs r0,r0,#1 ;\n"
 247                 "   bgt  0b"
 248                 :: "r" (loops) : "cc", "r0");
 249 }
 250
 251 #define DMA_BASE6 0x0300
 252 #define DMA_REG(x) memregl[(DMA_BASE6 + x) >> 2]
 253
 254 /* this takes ~1.5ms, while ldm/stm ~1.95ms */
 255 static void raw_blit_dma(int doffs, const void *vram, int w, int h,
 256                          int sstride, int bgr24)
 257 {
 258         unsigned int pixel_offset = (unsigned short *)vram - psx_vram;
 259         unsigned int dst = fb_paddrs[fb_work_buf] +
 260                         (fb_offset_y * 320 + fb_offset_x) * psx_bpp / 8;
 261         int spsx_line = pixel_offset / 1024 + psx_offset_y;
 262         int spsx_offset = (pixel_offset + psx_offset_x) & 0x3f8;
 263         unsigned int vram_byte_pos, vram_byte_step;
 264         int dst_stride = 320 * psx_bpp / 8;
 265         int len = psx_src_width * psx_bpp / 8;
 266         int i;
 267
 268         //warm_cache_op_all(WOP_D_CLEAN);
 269
 270         dst &= ~7;
 271         len &= ~7;
 272
 273         if (DMA_REG(0x0c) & 0x90000) {
 274                 printf("already runnig DMA?\n");
 275                 DMA_REG(0x0c) = 0x100000;
 276         }
 277         if ((DMA_REG(0x2c) & 0x0f) < 5) {
 278                 printf("DMA queue busy?\n");
 279                 DMA_REG(0x24) = 1;
 280         }
 281
 282         vram_byte_pos = vram_pbase;
 283         vram_byte_pos += (spsx_line & 511) * 2 * 1024 + spsx_offset * 2;
 284         vram_byte_step = psx_step * 2 * 1024;
 285
 286         for (i = psx_src_height; i > 0;
 287              i--, vram_byte_pos += vram_byte_step, dst += dst_stride)
 288         {
 289                 while ((DMA_REG(0x2c) & 0x0f) < 4)
 290                         spend_cycles(10);
 291
 292                 // XXX: it seems we must always set all regs, what is autoincrement there for?
 293                 DMA_REG(0x20) = 1;              // queue wait cmd
 294                 DMA_REG(0x10) = vram_byte_pos;  // DMA src
 295                 DMA_REG(0x14) = dst;            // DMA dst
 296                 DMA_REG(0x18) = len - 1;        // len
 297                 DMA_REG(0x1c) = 0x80000;        // go
 298         }
 299 }
 300
 301 #define make_flip_func(name, blitfunc)                                                  \
 302 static void name(int doffs, const void *vram_, int w, int h, int sstride, int bgr24)    \
 303 {                                                                                       \
 304         const unsigned short *vram = vram_;                                             \
 305         unsigned char *dst = (unsigned char *)g_menuscreen_ptr +                        \
 306                         (fb_offset_y * 320 + fb_offset_x) * psx_bpp / 8;                \
 307         int dst_stride = 320 * psx_bpp / 8;                                             \
 308         int len = psx_src_width * psx_bpp / 8;                                          \
 309         int i;                                                                          \
 310                                                                                         \
 311         vram += psx_offset_y * 1024 + psx_offset_x;                                     \
 312         vram = (void *)((long)vram & ~3);                                               \
 313         for (i = psx_src_height; i > 0; i--, vram += psx_step * 1024, dst += dst_stride)\
 314                 blitfunc(dst, vram, len);                                               \
 315 }
 316
 317 make_flip_func(raw_blit_soft, memcpy)
 318 make_flip_func(raw_blit_soft_368, blit320_368)
 319 make_flip_func(raw_blit_soft_512, blit320_512)
 320 make_flip_func(raw_blit_soft_640, blit320_640)
 321
 322 void *plat_gvideo_set_mode(int *w_, int *h_, int *bpp_)
 323 {
 324         int poff_w, poff_h, w_max;
 325         int w = *w_, h = *h_, bpp = *bpp_;
 326
 327         if (!w || !h || !bpp)
 328                 return NULL;
 329
 330         printf("psx mode: %dx%d@%d\n", w, h, bpp);
 331         psx_width = w;
 332         psx_height = h;
 333         psx_bpp = bpp;
 334
 335         switch (w + (bpp != 16) + !soft_scaling) {
 336         case 640:
 337                 pl_plat_blit = raw_blit_soft_640;
 338                 w_max = 640;
 339                 break;
 340         case 512:
 341                 pl_plat_blit = raw_blit_soft_512;
 342                 w_max = 512;
 343                 break;
 344         case 384:
 345         case 368:
 346                 pl_plat_blit = raw_blit_soft_368;
 347                 w_max = 368;
 348                 break;
 349         default:
 350                 pl_plat_blit = have_warm ? raw_blit_dma : raw_blit_soft;
 351                 w_max = 320;
 352                 break;
 353         }
 354
 355         psx_step = 1;
 356         if (h > 256) {
 357                 psx_step = 2;
 358                 h /= 2;
 359         }
 360
 361         poff_w = poff_h = 0;
 362         if (w > w_max) {
 363                 poff_w = w / 2 - w_max / 2;
 364                 w = w_max;
 365         }
 366         fb_offset_x = 0;
 367         if (w < 320)
 368                 fb_offset_x = 320/2 - w / 2;
 369         if (h > 240) {
 370                 poff_h = h / 2 - 240/2;
 371                 h = 240;
 372         }
 373         fb_offset_y = 240/2 - h / 2;
 374
 375         psx_offset_x = poff_w * psx_bpp/8 / 2;
 376         psx_offset_y = poff_h;
 377         psx_src_width = w;
 378         psx_src_height = h;
 379
 380         if (fb_offset_x || fb_offset_y) {
 381                 // not fullscreen, must clear borders
 382                 memset(g_menuscreen_ptr, 0, 320*240 * psx_bpp/8);
 383                 g_menuscreen_ptr = fb_flip();
 384                 memset(g_menuscreen_ptr, 0, 320*240 * psx_bpp/8);
 385         }
 386
 387         pollux_changemode(bpp, 1);
 388
 389         pl_set_gun_rect(fb_offset_x, fb_offset_y, w > 320 ? 320 : w, h);
 390
 391         // adjust for hud
 392         *w_ = 320;
 393         *h_ = fb_offset_y + psx_src_height;
 394
 395         return g_menuscreen_ptr;
 396 }
 397
 398 /* not really used, we do raw_flip */
 399 void plat_gvideo_open(int is_pal)
 400 {
 401 }
 402
 403 void *plat_gvideo_flip(void)
 404 {
 405         g_menuscreen_ptr = fb_flip();
 406         return g_menuscreen_ptr;
 407 }
 408
 409 void plat_gvideo_close(void)
 410 {
 411 }
 412
 413 static void *pl_emu_mmap(unsigned long addr, size_t size,
 414         enum psxMapTag tag, int *can_retry_addr)
 415 {
 416         unsigned int pbase;
 417         void *retval;
 418         int ret;
 419
 420         *can_retry_addr = 1;
 421         if (!have_warm)
 422                 goto basic_map;
 423
 424         switch (tag) {
 425         case MAP_TAG_RAM:
 426                 if (size > 0x400000) {
 427                         fprintf(stderr, "unexpected ram map request: %08lx %x\n",
 428                                 addr, size);
 429                         exit(1);
 430                 }
 431                 pbase = (uppermem_pbase + 0xffffff) & ~0xffffff;
 432                 pbase += 0x400000;
 433                 retval = (void *)addr;
 434                 ret = warm_mmap_section(retval, pbase, size, WCB_C_BIT);
 435                 if (ret != 0) {
 436                         fprintf(stderr, "ram section map failed\n");
 437                         exit(1);
 438                 }
 439                 goto out;
 440         case MAP_TAG_VRAM:
 441                 if (size > 0x400000) {
 442                         fprintf(stderr, "unexpected vram map request: %08lx %x\n",
 443                                 addr, size);
 444                         exit(1);
 445                 }
 446                 if (addr == 0)
 447                         addr = 0x60000000;
 448                 vram_pbase = (uppermem_pbase + 0xffffff) & ~0xffffff;
 449                 retval = (void *)addr;
 450
 451                 ret = warm_mmap_section(retval, vram_pbase, size, WCB_C_BIT);
 452                 if (ret != 0) {
 453                         fprintf(stderr, "vram section map failed\n");
 454                         exit(1);
 455                 }
 456                 goto out;
 457         case MAP_TAG_LUTS:
 458                 // mostly for Wiz to not run out of RAM
 459                 if (size > 0x800000) {
 460                         fprintf(stderr, "unexpected LUT map request: %08lx %x\n",
 461                                 addr, size);
 462                         exit(1);
 463                 }
 464                 pbase = (uppermem_pbase + 0xffffff) & ~0xffffff;
 465                 pbase += 0x800000;
 466                 retval = (void *)addr;
 467                 ret = warm_mmap_section(retval, pbase, size, WCB_C_BIT);
 468                 if (ret != 0) {
 469                         fprintf(stderr, "LUT section map failed\n");
 470                         exit(1);
 471                 }
 472                 goto out;
 473         default:
 474                 break;
 475         }
 476
 477 basic_map:
 478         retval = plat_mmap(addr, size, 0, 0);
 479
 480 out:
 481         if (tag == MAP_TAG_VRAM && retval)
 482                 psx_vram = retval;
 483         return retval ? retval : MAP_FAILED;
 484 }
 485
 486 static void pl_emu_munmap(void *ptr, size_t size, enum psxMapTag tag)
 487 {
 488         switch (tag) {
 489         case MAP_TAG_RAM:
 490         case MAP_TAG_VRAM:
 491         case MAP_TAG_LUTS:
 492                 warm_munmap_section(ptr, size);
 493                 break;
 494         default:
 495                 plat_munmap(ptr, size);
 496                 break;
 497         }
 498 }
 499
 500 void plat_init(void)
 501 {
 502         const char *main_fb_name = "/dev/fb0";
 503         struct fb_fix_screeninfo fbfix;
 504         int ret;
 505
 506         plat_target_init();
 507
 508         fbdev = open(main_fb_name, O_RDWR);
 509         if (fbdev == -1) {
 510                 fprintf(stderr, "%s: ", main_fb_name);
 511                 perror("open");
 512                 exit(1);
 513         }
 514
 515         ret = ioctl(fbdev, FBIOGET_FSCREENINFO, &fbfix);
 516         if (ret == -1) {
 517                 perror("ioctl(fbdev) failed");
 518                 exit(1);
 519         }
 520         uppermem_pbase = fbfix.smem_start;
 521
 522         printf("framebuffer: \"%s\" @ %08lx\n", fbfix.id, fbfix.smem_start);
 523         fb_paddrs[0] = fbfix.smem_start;
 524         fb_paddrs[1] = fb_paddrs[0] + 320*240*4; // leave space for 24bpp
 525
 526         ret = warm_init();
 527         have_warm = (ret == 0);
 528
 529         if (have_warm) {
 530                 // map fb as write-through cached section
 531                 fb_vaddrs[0] = (void *)0x7fe00000;
 532                 ret = warm_mmap_section(fb_vaddrs[0], fb_paddrs[0],
 533                         FB_VRAM_SIZE, WCB_C_BIT);
 534                 if (ret != 0) {
 535                         fprintf(stderr, "fb section map failed\n");
 536                         fb_vaddrs[0] = NULL;
 537
 538                         // we could continue but it would just get messy
 539                         exit(1);
 540                 }
 541         }
 542         if (fb_vaddrs[0] == NULL) {
 543                 fb_vaddrs[0] = mmap(0, FB_VRAM_SIZE, PROT_READ|PROT_WRITE,
 544                                 MAP_SHARED, memdev, fb_paddrs[0]);
 545                 if (fb_vaddrs[0] == MAP_FAILED) {
 546                         perror("mmap(fb_vaddrs) failed");
 547                         exit(1);
 548                 }
 549
 550                 memset(fb_vaddrs[0], 0, FB_VRAM_SIZE);
 551                 warm_change_cb_range(WCB_C_BIT, 1, fb_vaddrs[0], FB_VRAM_SIZE);
 552         }
 553         printf("  mapped @%p\n", fb_vaddrs[0]);
 554
 555         fb_vaddrs[1] = (char *)fb_vaddrs[0] + 320*240*4;
 556
 557         memset(fb_vaddrs[0], 0, FB_VRAM_SIZE);
 558
 559         pollux_changemode(16, 0);
 560         g_menuscreen_w = g_menuscreen_pp = 320;
 561         g_menuscreen_h = 240;
 562         g_menuscreen_ptr = fb_flip();
 563
 564         /* setup DMA */
 565         DMA_REG(0x0c) = 0x20000; // pending IRQ clear
 566
 567         in_tsbutton_init();
 568         in_evdev_init(&gp2x_evdev_pdata);
 569         if (gp2x_dev_id == GP2X_DEV_CAANOO)
 570                 caanoo_init();
 571         else
 572                 wiz_init();
 573
 574         pl_plat_blit = have_warm ? raw_blit_dma : raw_blit_soft;
 575
 576         psx_src_width = 320;
 577         psx_src_height = 240;
 578         psx_bpp = 16;
 579
 580         pl_rearmed_cbs.screen_w = 320;
 581         pl_rearmed_cbs.screen_h = 240;
 582
 583         plat_target_setup_input();
 584
 585         plat_target.cpu_clock_set = cpu_clock_wrapper;
 586
 587         psxMapHook = pl_emu_mmap;
 588         psxUnmapHook = pl_emu_munmap;
 589 }
 590
 591 void plat_finish(void)
 592 {
 593         warm_finish();
 594         memset(fb_vaddrs[0], 0, FB_VRAM_SIZE);
 595         munmap(fb_vaddrs[0], FB_VRAM_SIZE);
 596         close(fbdev);
 597         plat_target_finish();
 598 }
 599
 600 /* Caanoo stuff, perhaps move later */
 601 static const char * const caanoo_keys[KEY_MAX + 1] = {
 602         [0 ... KEY_MAX] = NULL,
 603         [KEY_UP]        = "Up",
 604         [KEY_LEFT]      = "Left",
 605         [KEY_RIGHT]     = "Right",
 606         [KEY_DOWN]      = "Down",
 607         [BTN_TRIGGER]   = "A",
 608         [BTN_THUMB]     = "X",
 609         [BTN_THUMB2]    = "B",
 610         [BTN_TOP]       = "Y",
 611         [BTN_TOP2]      = "L",
 612         [BTN_PINKIE]    = "R",
 613         [BTN_BASE]      = "Home",
 614         [BTN_BASE2]     = "Lock",
 615         [BTN_BASE3]     = "I",
 616         [BTN_BASE4]     = "II",
 617         [BTN_BASE5]     = "Push",
 618 };
 619
 620 struct haptic_data {
 621         int count;
 622         struct {
 623                 short time, strength;
 624         } actions[120];
 625 };
 626
 627 #define HAPTIC_IOCTL_MAGIC      'I'
 628 #define HAPTIC_PLAY_PATTERN     _IOW(HAPTIC_IOCTL_MAGIC, 4, struct haptic_data)
 629 #define HAPTIC_INDIVIDUAL_MODE  _IOW(HAPTIC_IOCTL_MAGIC, 5, unsigned int)
 630 #define HAPTIC_SET_VIB_LEVEL    _IOW(HAPTIC_IOCTL_MAGIC, 9, unsigned int)
 631
 632 static int hapticdev = -1;
 633 static struct haptic_data haptic_seq[2];
 634
 635 static int haptic_read(const char *fname, struct haptic_data *data)
 636 {
 637         int i, ret, v1, v2;
 638         char buf[128], *p;
 639         FILE *f;
 640
 641         f = fopen(fname, "r");
 642         if (f == NULL) {
 643                 fprintf(stderr, "fopen(%s)", fname);
 644                 perror("");
 645                 return -1;
 646         }
 647
 648         for (i = 0; i < sizeof(data->actions) / sizeof(data->actions[0]); ) {
 649                 p = fgets(buf, sizeof(buf), f);
 650                 if (p == NULL)
 651                         break;
 652                 while (*p != 0 && *p == ' ')
 653                         p++;
 654                 if (*p == 0 || *p == ';' || *p == '#')
 655                         continue;
 656
 657                 ret = sscanf(buf, "%d %d", &v1, &v2);
 658                 if (ret != 2) {
 659                         fprintf(stderr, "can't parse: %s", buf);
 660                         continue;
 661                 }
 662
 663                 data->actions[i].time = v1;
 664                 data->actions[i].strength = v2;
 665                 i++;
 666         }
 667         fclose(f);
 668
 669         if (i == 0) {
 670                 fprintf(stderr, "bad haptic file: %s\n", fname);
 671                 return -1;
 672         }
 673         data->count = i;
 674
 675         return 0;
 676 }
 677
 678 static int haptic_init(void)
 679 {
 680         int ret, i;
 681
 682         ret = haptic_read("haptic_w.cfg", &haptic_seq[0]);
 683         if (ret != 0)
 684                 return -1;
 685         ret = haptic_read("haptic_s.cfg", &haptic_seq[1]);
 686         if (ret != 0)
 687                 return -1;
 688
 689         hapticdev = open("/dev/isa1200", O_RDWR | O_NONBLOCK);
 690         if (hapticdev == -1) {
 691                 perror("open(/dev/isa1200)");
 692                 return -1;
 693         }
 694
 695         i = 0;
 696         ret  = ioctl(hapticdev, HAPTIC_INDIVIDUAL_MODE, &i);    /* use 2 of them */
 697         i = 3;
 698         ret |= ioctl(hapticdev, HAPTIC_SET_VIB_LEVEL, &i);      /* max */
 699         if (ret != 0) {
 700                 fprintf(stderr, "haptic ioctls failed\n");
 701                 close(hapticdev);
 702                 hapticdev = -1;
 703                 return -1;
 704         }
 705
 706         return 0;
 707 }
 708
 709 void plat_trigger_vibrate(int pad, int low, int high)
 710 {
 711         int is_strong;
 712         int ret;
 713
 714         if (low == 0 && high == 0)
 715                 return;
 716         is_strong = (high >= 0xf0);
 717
 718         if (hapticdev == -2)
 719                 return; // it's broken
 720         if (hapticdev < 0) {
 721                 ret = haptic_init();
 722                 if (ret < 0) {
 723                         hapticdev = -2;
 724                         return;
 725                 }
 726         }
 727
 728         ioctl(hapticdev, HAPTIC_PLAY_PATTERN, &haptic_seq[!!is_strong]);
 729 }
 730
 731 static void caanoo_init(void)
 732 {
 733         in_probe();
 734         in_set_config(in_name_to_id("evdev:pollux-analog"), IN_CFG_KEY_NAMES,
 735                       caanoo_keys, sizeof(caanoo_keys));
 736 }
 737
 738 /* Wiz stuff */
 739 static const struct in_default_bind in_gp2x_defbinds[] =
 740 {
 741         /* MXYZ SACB RLDU */
 742         { GP2X_BTN_UP,          IN_BINDTYPE_PLAYER12, DKEY_UP },
 743         { GP2X_BTN_DOWN,        IN_BINDTYPE_PLAYER12, DKEY_DOWN },
 744         { GP2X_BTN_LEFT,        IN_BINDTYPE_PLAYER12, DKEY_LEFT },
 745         { GP2X_BTN_RIGHT,       IN_BINDTYPE_PLAYER12, DKEY_RIGHT },
 746         { GP2X_BTN_X,           IN_BINDTYPE_PLAYER12, DKEY_CROSS },
 747         { GP2X_BTN_B,           IN_BINDTYPE_PLAYER12, DKEY_CIRCLE },
 748         { GP2X_BTN_A,           IN_BINDTYPE_PLAYER12, DKEY_SQUARE },
 749         { GP2X_BTN_Y,           IN_BINDTYPE_PLAYER12, DKEY_TRIANGLE },
 750         { GP2X_BTN_L,           IN_BINDTYPE_PLAYER12, DKEY_L1 },
 751         { GP2X_BTN_R,           IN_BINDTYPE_PLAYER12, DKEY_R1 },
 752         { GP2X_BTN_START,       IN_BINDTYPE_PLAYER12, DKEY_START },
 753         { GP2X_BTN_SELECT,      IN_BINDTYPE_EMU, SACTION_ENTER_MENU },
 754         { GP2X_BTN_VOL_UP,      IN_BINDTYPE_EMU, SACTION_VOLUME_UP },
 755         { GP2X_BTN_VOL_DOWN,    IN_BINDTYPE_EMU, SACTION_VOLUME_DOWN },
 756         { 0, 0, 0 },
 757 };
 758
 759 // unused dummy for in_gp2x
 760 volatile unsigned short *gp2x_memregs;
 761
 762 static void wiz_init(void)
 763 {
 764         in_gp2x_init(in_gp2x_defbinds);
 765         in_probe();
 766 }