frontend: update libpicofe, fix missed callbacks
[pcsx_rearmed.git] / frontend / plat_pollux.c
CommitLineData
55b0eeea 1/*
c02c3b65 2 * (C) GraÅžvydas "notaz" Ignotas, 2009-2012
55b0eeea 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.
c02c3b65 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]
55b0eeea 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>
221be40d 32#include <linux/soundcard.h>
b07c18e8 33#include <linux/input.h>
55b0eeea 34
cc56203b 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"
55b0eeea 41#include "warm/warm.h"
42#include "plugin_lib.h"
221be40d 43#include "pl_gun_ts.h"
02ee7e24 44#include "blit320.h"
faf2b2aa 45#include "in_tsbutton.h"
55b0eeea 46#include "main.h"
47#include "menu.h"
48#include "plat.h"
c82f907a 49#include "cspace.h"
c02c3b65 50#include "../libpcsxcore/psxmem_map.h"
55b0eeea 51
221be40d 52
cc56203b 53static int fbdev = -1;
55b0eeea 54static void *fb_vaddrs[2];
55static unsigned int fb_paddrs[2];
56static int fb_work_buf;
cc56203b 57static int have_warm;
0b6c6da8 58#define FB_VRAM_SIZE (320*240*2*2*2) // 2 buffers with space for 24bpp mode
c02c3b65 59static unsigned int uppermem_pbase, vram_pbase;
55b0eeea 60
61static unsigned short *psx_vram;
02ee7e24 62static int psx_step, psx_width, psx_height, psx_bpp;
a72ac803 63static int psx_offset_x, psx_offset_y, psx_src_width, psx_src_height;
41f55c9f 64static int fb_offset_x, fb_offset_y;
55b0eeea 65
9b4bd105 66static void caanoo_init(void);
b07c18e8 67static void wiz_init(void);
68
9b4bd105 69
b07c18e8 70static 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};
9b4bd105 86
bcfc48e3 87static 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
111static 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
55b0eeea 117static void *fb_flip(void)
118{
0b6c6da8 119 memregl[0x406C>>2] = memregl[0x446C>>2] = fb_paddrs[fb_work_buf];
55b0eeea 120 memregl[0x4058>>2] |= 0x10;
0b6c6da8 121 memregl[0x4458>>2] |= 0x10;
55b0eeea 122 fb_work_buf ^= 1;
123 return fb_vaddrs[fb_work_buf];
124}
125
126static 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
0b6c6da8 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;
55b0eeea 158
159 r = memregl[0x4058>>2];
160 r = (r & 0xffff) | (code << 16) | 0x10;
161 memregl[0x4058>>2] = r;
0b6c6da8 162
163 r = memregl[0x4458>>2];
164 r = (r & 0xffff) | (code << 16) | 0x10;
165 memregl[0x4458>>2] = r;
55b0eeea 166}
167
cc56203b 168static int cpu_clock_wrapper(int mhz)
55b0eeea 169{
55b0eeea 170 // stupid pll share hack - must restart audio
cc56203b 171 int pollux_cpu_clock_set(int cpu_clock);
55b0eeea 172 extern long SPUopen(void);
173 extern long SPUclose(void);
cc56203b 174
175 pollux_cpu_clock_set(mhz);
55b0eeea 176 SPUclose();
177 SPUopen();
178
179 return 0;
180}
181
55b0eeea 182#define TIMER_BASE3 0x1980
183#define TIMER_REG(x) memregl[(TIMER_BASE3 + x) >> 2]
184
185static __attribute__((unused)) unsigned int timer_get(void)
186{
187 TIMER_REG(0x08) |= 0x48; /* run timer, latch value */
188 return TIMER_REG(0);
189}
190
55b0eeea 191void 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
204void plat_video_menu_begin(void)
205{
206}
207
208void plat_video_menu_end(void)
209{
210 g_menuscreen_ptr = fb_flip();
211}
212
213void plat_video_menu_leave(void)
214{
55b0eeea 215 if (psx_vram == NULL) {
216 fprintf(stderr, "GPU plugin did not provide vram\n");
217 exit(1);
218 }
219
221be40d 220 if (gp2x_dev_id == GP2X_DEV_CAANOO)
221 in_set_config_int(in_name_to_id("evdev:pollux-analog"),
55b0eeea 222 IN_CFG_ABS_DEAD_ZONE, analog_deadzone);
41f55c9f 223
224 memset(g_menuscreen_ptr, 0, 320*240 * psx_bpp/8);
225 g_menuscreen_ptr = fb_flip();
ddc0a02a 226 memset(g_menuscreen_ptr, 0, 320*240 * psx_bpp/8);
55b0eeea 227}
228
47821672 229void *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
a805c855 238void plat_minimize(void)
239{
240}
241
55b0eeea 242static 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 */
02783d0b 255static void raw_blit_dma(int doffs, const void *vram, int w, int h,
256 int sstride, int bgr24)
55b0eeea 257{
02783d0b 258 unsigned int pixel_offset = (unsigned short *)vram - psx_vram;
41f55c9f 259 unsigned int dst = fb_paddrs[fb_work_buf] +
260 (fb_offset_y * 320 + fb_offset_x) * psx_bpp / 8;
fa56d360 261 int spsx_line = pixel_offset / 1024 + psx_offset_y;
262 int spsx_offset = (pixel_offset + psx_offset_x) & 0x3f8;
c02c3b65 263 unsigned int vram_byte_pos, vram_byte_step;
55b0eeea 264 int dst_stride = 320 * psx_bpp / 8;
a72ac803 265 int len = psx_src_width * psx_bpp / 8;
55b0eeea 266 int i;
267
c02c3b65 268 //warm_cache_op_all(WOP_D_CLEAN);
55b0eeea 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
c02c3b65 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 {
55b0eeea 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
c02c3b65 294 DMA_REG(0x10) = vram_byte_pos; // DMA src
55b0eeea 295 DMA_REG(0x14) = dst; // DMA dst
296 DMA_REG(0x18) = len - 1; // len
297 DMA_REG(0x1c) = 0x80000; // go
298 }
55b0eeea 299}
300
02ee7e24 301#define make_flip_func(name, blitfunc) \
02783d0b 302static void name(int doffs, const void *vram_, int w, int h, int sstride, int bgr24) \
02ee7e24 303{ \
fa56d360 304 const unsigned short *vram = vram_; \
02ee7e24 305 unsigned char *dst = (unsigned char *)g_menuscreen_ptr + \
306 (fb_offset_y * 320 + fb_offset_x) * psx_bpp / 8; \
02ee7e24 307 int dst_stride = 320 * psx_bpp / 8; \
a72ac803 308 int len = psx_src_width * psx_bpp / 8; \
02ee7e24 309 int i; \
310 \
fa56d360 311 vram += psx_offset_y * 1024 + psx_offset_x; \
2391c1b4 312 vram = (void *)((long)vram & ~3); \
fa56d360 313 for (i = psx_src_height; i > 0; i--, vram += psx_step * 1024, dst += dst_stride)\
314 blitfunc(dst, vram, len); \
02ee7e24 315}
316
02783d0b 317make_flip_func(raw_blit_soft, memcpy)
318make_flip_func(raw_blit_soft_368, blit320_368)
319make_flip_func(raw_blit_soft_512, blit320_512)
320make_flip_func(raw_blit_soft_640, blit320_640)
02ee7e24 321
6469a8c4 322void *plat_gvideo_set_mode(int *w_, int *h_, int *bpp_)
55b0eeea 323{
02ee7e24 324 int poff_w, poff_h, w_max;
6469a8c4 325 int w = *w_, h = *h_, bpp = *bpp_;
55b0eeea 326
a72ac803 327 if (!w || !h || !bpp)
02ee7e24 328 return NULL;
55b0eeea 329
02ee7e24 330 printf("psx mode: %dx%d@%d\n", w, h, bpp);
a72ac803 331 psx_width = w;
332 psx_height = h;
333 psx_bpp = bpp;
55b0eeea 334
a72ac803 335 switch (w + (bpp != 16) + !soft_scaling) {
02ee7e24 336 case 640:
02783d0b 337 pl_plat_blit = raw_blit_soft_640;
02ee7e24 338 w_max = 640;
339 break;
340 case 512:
02783d0b 341 pl_plat_blit = raw_blit_soft_512;
02ee7e24 342 w_max = 512;
343 break;
344 case 384:
345 case 368:
02783d0b 346 pl_plat_blit = raw_blit_soft_368;
02ee7e24 347 w_max = 368;
348 break;
349 default:
02783d0b 350 pl_plat_blit = have_warm ? raw_blit_dma : raw_blit_soft;
02ee7e24 351 w_max = 320;
352 break;
55b0eeea 353 }
354
02ee7e24 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
6983a9ae 375 psx_offset_x = poff_w * psx_bpp/8 / 2;
02ee7e24 376 psx_offset_y = poff_h;
a72ac803 377 psx_src_width = w;
378 psx_src_height = h;
02ee7e24 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
221be40d 389 pl_set_gun_rect(fb_offset_x, fb_offset_y, w > 320 ? 320 : w, h);
390
6469a8c4 391 // adjust for hud
392 *w_ = 320;
393 *h_ = fb_offset_y + psx_src_height;
394
02783d0b 395 return g_menuscreen_ptr;
55b0eeea 396}
397
6469a8c4 398/* not really used, we do raw_flip */
ab423939 399void plat_gvideo_open(int is_pal)
6469a8c4 400{
401}
402
403void *plat_gvideo_flip(void)
41f55c9f 404{
02783d0b 405 g_menuscreen_ptr = fb_flip();
406 return g_menuscreen_ptr;
41f55c9f 407}
408
6469a8c4 409void plat_gvideo_close(void)
410{
411}
412
4284a818 413static void *pl_emu_mmap(unsigned long addr, size_t size,
414 enum psxMapTag tag, int *can_retry_addr)
c02c3b65 415{
416 unsigned int pbase;
417 void *retval;
418 int ret;
419
4284a818 420 *can_retry_addr = 1;
c02c3b65 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
477basic_map:
7e9c3060 478 retval = plat_mmap(addr, size, 0, 0);
c02c3b65 479
480out:
7e9c3060 481 if (tag == MAP_TAG_VRAM && retval)
c02c3b65 482 psx_vram = retval;
7e9c3060 483 return retval ? retval : MAP_FAILED;
c02c3b65 484}
485
486static 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
55b0eeea 500void plat_init(void)
501{
502 const char *main_fb_name = "/dev/fb0";
503 struct fb_fix_screeninfo fbfix;
cc56203b 504 int ret;
55b0eeea 505
cc56203b 506 plat_target_init();
0b6c6da8 507
55b0eeea 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 }
c02c3b65 520 uppermem_pbase = fbfix.smem_start;
521
55b0eeea 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
c02c3b65 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,
55b0eeea 544 MAP_SHARED, memdev, fb_paddrs[0]);
c02c3b65 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);
55b0eeea 552 }
c02c3b65 553 printf(" mapped @%p\n", fb_vaddrs[0]);
554
55b0eeea 555 fb_vaddrs[1] = (char *)fb_vaddrs[0] + 320*240*4;
556
a72ac803 557 memset(fb_vaddrs[0], 0, FB_VRAM_SIZE);
cc56203b 558
55b0eeea 559 pollux_changemode(16, 0);
a4da039c 560 g_menuscreen_w = g_menuscreen_pp = 320;
55b0eeea 561 g_menuscreen_h = 240;
562 g_menuscreen_ptr = fb_flip();
563
55b0eeea 564 /* setup DMA */
565 DMA_REG(0x0c) = 0x20000; // pending IRQ clear
566
9b4bd105 567 in_tsbutton_init();
bcfc48e3 568 in_evdev_init(&gp2x_evdev_pdata);
9b4bd105 569 if (gp2x_dev_id == GP2X_DEV_CAANOO)
570 caanoo_init();
b07c18e8 571 else
572 wiz_init();
9b4bd105 573
02783d0b 574 pl_plat_blit = have_warm ? raw_blit_dma : raw_blit_soft;
55b0eeea 575
a72ac803 576 psx_src_width = 320;
577 psx_src_height = 240;
55b0eeea 578 psx_bpp = 16;
bb88ec28 579
580 pl_rearmed_cbs.screen_w = 320;
581 pl_rearmed_cbs.screen_h = 240;
cc56203b 582
583 plat_target_setup_input();
584
585 plat_target.cpu_clock_set = cpu_clock_wrapper;
c02c3b65 586
587 psxMapHook = pl_emu_mmap;
588 psxUnmapHook = pl_emu_munmap;
55b0eeea 589}
590
591void plat_finish(void)
592{
593 warm_finish();
0b6c6da8 594 memset(fb_vaddrs[0], 0, FB_VRAM_SIZE);
0b6c6da8 595 munmap(fb_vaddrs[0], FB_VRAM_SIZE);
596 close(fbdev);
cc56203b 597 plat_target_finish();
55b0eeea 598}
599
55b0eeea 600/* Caanoo stuff, perhaps move later */
55b0eeea 601static 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
b944a30e 620struct 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
632static int hapticdev = -1;
3a40ff14 633static struct haptic_data haptic_seq[2];
b944a30e 634
3a40ff14 635static int haptic_read(const char *fname, struct haptic_data *data)
b944a30e 636{
637 int i, ret, v1, v2;
638 char buf[128], *p;
639 FILE *f;
640
3a40ff14 641 f = fopen(fname, "r");
b944a30e 642 if (f == NULL) {
6469a8c4 643 fprintf(stderr, "fopen(%s)", fname);
3a40ff14 644 perror("");
b944a30e 645 return -1;
646 }
647
3a40ff14 648 for (i = 0; i < sizeof(data->actions) / sizeof(data->actions[0]); ) {
b944a30e 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
3a40ff14 663 data->actions[i].time = v1;
664 data->actions[i].strength = v2;
b944a30e 665 i++;
666 }
667 fclose(f);
668
669 if (i == 0) {
3a40ff14 670 fprintf(stderr, "bad haptic file: %s\n", fname);
b944a30e 671 return -1;
672 }
3a40ff14 673 data->count = i;
674
675 return 0;
676}
677
678static 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;
b944a30e 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
d71c7095 709void plat_trigger_vibrate(int pad, int low, int high)
b944a30e 710{
d71c7095 711 int is_strong;
b944a30e 712 int ret;
713
d71c7095 714 if (low == 0 && high == 0)
715 return;
716 is_strong = (high >= 0xf0);
717
b944a30e 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
3a40ff14 728 ioctl(hapticdev, HAPTIC_PLAY_PATTERN, &haptic_seq[!!is_strong]);
b944a30e 729}
730
b07c18e8 731static 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
221be40d 738/* Wiz stuff */
b07c18e8 739static const struct in_default_bind in_gp2x_defbinds[] =
221be40d 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
221be40d 759// unused dummy for in_gp2x
760volatile unsigned short *gp2x_memregs;
761
b07c18e8 762static void wiz_init(void)
55b0eeea 763{
b07c18e8 764 in_gp2x_init(in_gp2x_defbinds);
765 in_probe();
55b0eeea 766}