2 * (C) GraÅžvydas "notaz" Ignotas, 2009-2012
4 * This work is licensed under the terms of the GNU GPLv2 or later.
5 * See the COPYING file in the top-level directory.
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)
14 * Caanoo dram column (or row?) is 1024 bytes?
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]
25 #include <sys/types.h>
28 #include <sys/ioctl.h>
32 #include <linux/soundcard.h>
33 #include <linux/input.h>
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"
45 #include "in_tsbutton.h"
49 #include "../libpcsxcore/psxmem_map.h"
50 #include "../plugins/gpulib/cspace.h"
53 static int fbdev = -1;
54 static void *fb_vaddrs[2];
55 static unsigned int fb_paddrs[2];
56 static int fb_work_buf;
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;
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;
66 static void caanoo_init(void);
67 static void wiz_init(void);
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 },
87 static void *fb_flip(void)
89 memregl[0x406C>>2] = memregl[0x446C>>2] = fb_paddrs[fb_work_buf];
90 memregl[0x4058>>2] |= 0x10;
91 memregl[0x4458>>2] |= 0x10;
93 return fb_vaddrs[fb_work_buf];
96 static void pollux_changemode(int bpp, int is_bgr)
98 int code = 0, bytes = 2;
101 printf("changemode: %dbpp %s\n", bpp, is_bgr ? "bgr" : "rgb");
103 memregl[0x4004>>2] = 0x00ef013f;
104 memregl[0x4000>>2] |= 1 << 3;
113 code = is_bgr ? 0xc342 : 0x4432;
117 code = is_bgr ? 0xc653 : 0x4653;
121 printf("unhandled bpp request: %d\n", bpp);
125 // program both MLCs so that TV-out works
126 memregl[0x405c>>2] = memregl[0x445c>>2] = bytes;
127 memregl[0x4060>>2] = memregl[0x4460>>2] = 320 * bytes;
129 r = memregl[0x4058>>2];
130 r = (r & 0xffff) | (code << 16) | 0x10;
131 memregl[0x4058>>2] = r;
133 r = memregl[0x4458>>2];
134 r = (r & 0xffff) | (code << 16) | 0x10;
135 memregl[0x4458>>2] = r;
138 static int cpu_clock_wrapper(int mhz)
140 // stupid pll share hack - must restart audio
141 int pollux_cpu_clock_set(int cpu_clock);
142 extern long SPUopen(void);
143 extern long SPUclose(void);
145 pollux_cpu_clock_set(mhz);
152 #define TIMER_BASE3 0x1980
153 #define TIMER_REG(x) memregl[(TIMER_BASE3 + x) >> 2]
155 static __attribute__((unused)) unsigned int timer_get(void)
157 TIMER_REG(0x08) |= 0x48; /* run timer, latch value */
161 void plat_video_menu_enter(int is_rom_loaded)
163 if (pl_vout_buf != NULL) {
165 // have to do rgb conversion for menu bg
166 bgr555_to_rgb565(pl_vout_buf, pl_vout_buf, 320*240*2);
168 memset(pl_vout_buf, 0, 320*240*2);
171 pollux_changemode(16, 0);
174 void plat_video_menu_begin(void)
178 void plat_video_menu_end(void)
180 g_menuscreen_ptr = fb_flip();
183 void plat_video_menu_leave(void)
185 if (psx_vram == NULL) {
186 fprintf(stderr, "GPU plugin did not provide vram\n");
190 if (gp2x_dev_id == GP2X_DEV_CAANOO)
191 in_set_config_int(in_name_to_id("evdev:pollux-analog"),
192 IN_CFG_ABS_DEAD_ZONE, analog_deadzone);
194 memset(g_menuscreen_ptr, 0, 320*240 * psx_bpp/8);
195 g_menuscreen_ptr = fb_flip();
196 memset(g_menuscreen_ptr, 0, 320*240 * psx_bpp/8);
199 void *plat_prepare_screenshot(int *w, int *h, int *bpp)
201 bgr555_to_rgb565(pl_vout_buf, pl_vout_buf, 320*240*2);
208 void plat_minimize(void)
212 static void spend_cycles(int loops)
216 "0: subs r0,r0,#1 ;\n"
218 :: "r" (loops) : "cc", "r0");
221 #define DMA_BASE6 0x0300
222 #define DMA_REG(x) memregl[(DMA_BASE6 + x) >> 2]
224 /* this takes ~1.5ms, while ldm/stm ~1.95ms */
225 static void raw_blit_dma(int doffs, const void *vram, int w, int h,
226 int sstride, int bgr24)
228 unsigned int pixel_offset = (unsigned short *)vram - psx_vram;
229 unsigned int dst = fb_paddrs[fb_work_buf] +
230 (fb_offset_y * 320 + fb_offset_x) * psx_bpp / 8;
231 int spsx_line = pixel_offset / 1024 + psx_offset_y;
232 int spsx_offset = (pixel_offset + psx_offset_x) & 0x3f8;
233 unsigned int vram_byte_pos, vram_byte_step;
234 int dst_stride = 320 * psx_bpp / 8;
235 int len = psx_src_width * psx_bpp / 8;
238 //warm_cache_op_all(WOP_D_CLEAN);
243 if (DMA_REG(0x0c) & 0x90000) {
244 printf("already runnig DMA?\n");
245 DMA_REG(0x0c) = 0x100000;
247 if ((DMA_REG(0x2c) & 0x0f) < 5) {
248 printf("DMA queue busy?\n");
252 vram_byte_pos = vram_pbase;
253 vram_byte_pos += (spsx_line & 511) * 2 * 1024 + spsx_offset * 2;
254 vram_byte_step = psx_step * 2 * 1024;
256 for (i = psx_src_height; i > 0;
257 i--, vram_byte_pos += vram_byte_step, dst += dst_stride)
259 while ((DMA_REG(0x2c) & 0x0f) < 4)
262 // XXX: it seems we must always set all regs, what is autoincrement there for?
263 DMA_REG(0x20) = 1; // queue wait cmd
264 DMA_REG(0x10) = vram_byte_pos; // DMA src
265 DMA_REG(0x14) = dst; // DMA dst
266 DMA_REG(0x18) = len - 1; // len
267 DMA_REG(0x1c) = 0x80000; // go
271 #define make_flip_func(name, blitfunc) \
272 static void name(int doffs, const void *vram_, int w, int h, int sstride, int bgr24) \
274 const unsigned short *vram = vram_; \
275 unsigned char *dst = (unsigned char *)g_menuscreen_ptr + \
276 (fb_offset_y * 320 + fb_offset_x) * psx_bpp / 8; \
277 int dst_stride = 320 * psx_bpp / 8; \
278 int len = psx_src_width * psx_bpp / 8; \
281 vram += psx_offset_y * 1024 + psx_offset_x; \
282 for (i = psx_src_height; i > 0; i--, vram += psx_step * 1024, dst += dst_stride)\
283 blitfunc(dst, vram, len); \
286 make_flip_func(raw_blit_soft, memcpy)
287 make_flip_func(raw_blit_soft_368, blit320_368)
288 make_flip_func(raw_blit_soft_512, blit320_512)
289 make_flip_func(raw_blit_soft_640, blit320_640)
291 void *plat_gvideo_set_mode(int *w_, int *h_, int *bpp_)
293 int poff_w, poff_h, w_max;
294 int w = *w_, h = *h_, bpp = *bpp_;
296 if (!w || !h || !bpp)
299 printf("psx mode: %dx%d@%d\n", w, h, bpp);
304 switch (w + (bpp != 16) + !soft_scaling) {
306 pl_plat_blit = raw_blit_soft_640;
310 pl_plat_blit = raw_blit_soft_512;
315 pl_plat_blit = raw_blit_soft_368;
319 pl_plat_blit = have_warm ? raw_blit_dma : raw_blit_soft;
332 poff_w = w / 2 - w_max / 2;
337 fb_offset_x = 320/2 - w / 2;
339 poff_h = h / 2 - 240/2;
342 fb_offset_y = 240/2 - h / 2;
344 psx_offset_x = poff_w * psx_bpp/8 / 2;
345 psx_offset_y = poff_h;
349 if (fb_offset_x || fb_offset_y) {
350 // not fullscreen, must clear borders
351 memset(g_menuscreen_ptr, 0, 320*240 * psx_bpp/8);
352 g_menuscreen_ptr = fb_flip();
353 memset(g_menuscreen_ptr, 0, 320*240 * psx_bpp/8);
356 pollux_changemode(bpp, 1);
358 pl_set_gun_rect(fb_offset_x, fb_offset_y, w > 320 ? 320 : w, h);
362 *h_ = fb_offset_y + psx_src_height;
364 return g_menuscreen_ptr;
367 /* not really used, we do raw_flip */
368 void plat_gvideo_open(int is_pal)
372 void *plat_gvideo_flip(void)
374 g_menuscreen_ptr = fb_flip();
375 return g_menuscreen_ptr;
378 void plat_gvideo_close(void)
382 static void *pl_emu_mmap(unsigned long addr, size_t size, int is_fixed,
394 if (size > 0x400000) {
395 fprintf(stderr, "unexpected ram map request: %08lx %x\n",
399 pbase = (uppermem_pbase + 0xffffff) & ~0xffffff;
401 retval = (void *)addr;
402 ret = warm_mmap_section(retval, pbase, size, WCB_C_BIT);
404 fprintf(stderr, "ram section map failed\n");
409 if (size > 0x400000) {
410 fprintf(stderr, "unexpected vram map request: %08lx %x\n",
416 vram_pbase = (uppermem_pbase + 0xffffff) & ~0xffffff;
417 retval = (void *)addr;
419 ret = warm_mmap_section(retval, vram_pbase, size, WCB_C_BIT);
421 fprintf(stderr, "vram section map failed\n");
426 // mostly for Wiz to not run out of RAM
427 if (size > 0x800000) {
428 fprintf(stderr, "unexpected LUT map request: %08lx %x\n",
432 pbase = (uppermem_pbase + 0xffffff) & ~0xffffff;
434 retval = (void *)addr;
435 ret = warm_mmap_section(retval, pbase, size, WCB_C_BIT);
437 fprintf(stderr, "LUT section map failed\n");
446 retval = plat_mmap(addr, size, 0, is_fixed);
449 if (tag == MAP_TAG_VRAM)
454 static void pl_emu_munmap(void *ptr, size_t size, enum psxMapTag tag)
460 warm_munmap_section(ptr, size);
463 plat_munmap(ptr, size);
470 const char *main_fb_name = "/dev/fb0";
471 struct fb_fix_screeninfo fbfix;
476 fbdev = open(main_fb_name, O_RDWR);
478 fprintf(stderr, "%s: ", main_fb_name);
483 ret = ioctl(fbdev, FBIOGET_FSCREENINFO, &fbfix);
485 perror("ioctl(fbdev) failed");
488 uppermem_pbase = fbfix.smem_start;
490 printf("framebuffer: \"%s\" @ %08lx\n", fbfix.id, fbfix.smem_start);
491 fb_paddrs[0] = fbfix.smem_start;
492 fb_paddrs[1] = fb_paddrs[0] + 320*240*4; // leave space for 24bpp
495 have_warm = (ret == 0);
498 // map fb as write-through cached section
499 fb_vaddrs[0] = (void *)0x7fe00000;
500 ret = warm_mmap_section(fb_vaddrs[0], fb_paddrs[0],
501 FB_VRAM_SIZE, WCB_C_BIT);
503 fprintf(stderr, "fb section map failed\n");
506 // we could continue but it would just get messy
510 if (fb_vaddrs[0] == NULL) {
511 fb_vaddrs[0] = mmap(0, FB_VRAM_SIZE, PROT_READ|PROT_WRITE,
512 MAP_SHARED, memdev, fb_paddrs[0]);
513 if (fb_vaddrs[0] == MAP_FAILED) {
514 perror("mmap(fb_vaddrs) failed");
518 memset(fb_vaddrs[0], 0, FB_VRAM_SIZE);
519 warm_change_cb_range(WCB_C_BIT, 1, fb_vaddrs[0], FB_VRAM_SIZE);
521 printf(" mapped @%p\n", fb_vaddrs[0]);
523 fb_vaddrs[1] = (char *)fb_vaddrs[0] + 320*240*4;
525 memset(fb_vaddrs[0], 0, FB_VRAM_SIZE);
527 pollux_changemode(16, 0);
528 g_menuscreen_w = 320;
529 g_menuscreen_h = 240;
530 g_menuscreen_ptr = fb_flip();
533 DMA_REG(0x0c) = 0x20000; // pending IRQ clear
536 in_evdev_init(in_evdev_defbinds);
537 if (gp2x_dev_id == GP2X_DEV_CAANOO)
542 pl_plat_blit = have_warm ? raw_blit_dma : raw_blit_soft;
545 psx_src_height = 240;
548 pl_rearmed_cbs.screen_w = 320;
549 pl_rearmed_cbs.screen_h = 240;
551 plat_target_setup_input();
553 plat_target.cpu_clock_set = cpu_clock_wrapper;
555 psxMapHook = pl_emu_mmap;
556 psxUnmapHook = pl_emu_munmap;
559 void plat_finish(void)
562 memset(fb_vaddrs[0], 0, FB_VRAM_SIZE);
563 munmap(fb_vaddrs[0], FB_VRAM_SIZE);
565 plat_target_finish();
568 /* Caanoo stuff, perhaps move later */
569 static const char * const caanoo_keys[KEY_MAX + 1] = {
570 [0 ... KEY_MAX] = NULL,
573 [KEY_RIGHT] = "Right",
582 [BTN_BASE2] = "Lock",
585 [BTN_BASE5] = "Push",
591 short time, strength;
595 #define HAPTIC_IOCTL_MAGIC 'I'
596 #define HAPTIC_PLAY_PATTERN _IOW(HAPTIC_IOCTL_MAGIC, 4, struct haptic_data)
597 #define HAPTIC_INDIVIDUAL_MODE _IOW(HAPTIC_IOCTL_MAGIC, 5, unsigned int)
598 #define HAPTIC_SET_VIB_LEVEL _IOW(HAPTIC_IOCTL_MAGIC, 9, unsigned int)
600 static int hapticdev = -1;
601 static struct haptic_data haptic_seq[2];
603 static int haptic_read(const char *fname, struct haptic_data *data)
609 f = fopen(fname, "r");
611 fprintf(stderr, "fopen(%s)", fname);
616 for (i = 0; i < sizeof(data->actions) / sizeof(data->actions[0]); ) {
617 p = fgets(buf, sizeof(buf), f);
620 while (*p != 0 && *p == ' ')
622 if (*p == 0 || *p == ';' || *p == '#')
625 ret = sscanf(buf, "%d %d", &v1, &v2);
627 fprintf(stderr, "can't parse: %s", buf);
631 data->actions[i].time = v1;
632 data->actions[i].strength = v2;
638 fprintf(stderr, "bad haptic file: %s\n", fname);
646 static int haptic_init(void)
650 ret = haptic_read("haptic_w.cfg", &haptic_seq[0]);
653 ret = haptic_read("haptic_s.cfg", &haptic_seq[1]);
657 hapticdev = open("/dev/isa1200", O_RDWR | O_NONBLOCK);
658 if (hapticdev == -1) {
659 perror("open(/dev/isa1200)");
664 ret = ioctl(hapticdev, HAPTIC_INDIVIDUAL_MODE, &i); /* use 2 of them */
666 ret |= ioctl(hapticdev, HAPTIC_SET_VIB_LEVEL, &i); /* max */
668 fprintf(stderr, "haptic ioctls failed\n");
677 void plat_trigger_vibrate(int is_strong)
682 return; // it's broken
691 ioctl(hapticdev, HAPTIC_PLAY_PATTERN, &haptic_seq[!!is_strong]);
694 static void caanoo_init(void)
697 in_set_config(in_name_to_id("evdev:pollux-analog"), IN_CFG_KEY_NAMES,
698 caanoo_keys, sizeof(caanoo_keys));
702 static const struct in_default_bind in_gp2x_defbinds[] =
705 { GP2X_BTN_UP, IN_BINDTYPE_PLAYER12, DKEY_UP },
706 { GP2X_BTN_DOWN, IN_BINDTYPE_PLAYER12, DKEY_DOWN },
707 { GP2X_BTN_LEFT, IN_BINDTYPE_PLAYER12, DKEY_LEFT },
708 { GP2X_BTN_RIGHT, IN_BINDTYPE_PLAYER12, DKEY_RIGHT },
709 { GP2X_BTN_X, IN_BINDTYPE_PLAYER12, DKEY_CROSS },
710 { GP2X_BTN_B, IN_BINDTYPE_PLAYER12, DKEY_CIRCLE },
711 { GP2X_BTN_A, IN_BINDTYPE_PLAYER12, DKEY_SQUARE },
712 { GP2X_BTN_Y, IN_BINDTYPE_PLAYER12, DKEY_TRIANGLE },
713 { GP2X_BTN_L, IN_BINDTYPE_PLAYER12, DKEY_L1 },
714 { GP2X_BTN_R, IN_BINDTYPE_PLAYER12, DKEY_R1 },
715 { GP2X_BTN_START, IN_BINDTYPE_PLAYER12, DKEY_START },
716 { GP2X_BTN_SELECT, IN_BINDTYPE_EMU, SACTION_ENTER_MENU },
717 { GP2X_BTN_VOL_UP, IN_BINDTYPE_EMU, SACTION_VOLUME_UP },
718 { GP2X_BTN_VOL_DOWN, IN_BINDTYPE_EMU, SACTION_VOLUME_DOWN },
722 // unused dummy for in_gp2x
723 volatile unsigned short *gp2x_memregs;
725 static void wiz_init(void)
727 in_gp2x_init(in_gp2x_defbinds);