[pcsx_rearmed.git] / frontend / plat_pollux.c

/*
 * (C) Gražvydas "notaz" Ignotas, 2009-2012
 *
 * This work is licensed under the terms of the GNU GPLv2 or later.
 * See the COPYING file in the top-level directory.
 *
 * GPH claims:
 *  Main Memory  : Wiz = 0       ~ 2A00000,      Caanoo = 0       ~ 5600000 (86M)
 *  Frame Buffer : Wiz = 2A00000 ~ 2E00000 (4M), Caanoo = 5600000 ~ 5700000 (1M)
 *  Sound Buffer : Wiz = 2E00000 ~ 3000000 (2M), Caanoo = 5700000 ~ 5800000 (1M)
 *  YUV Buffer   :                               Caanoo = 5800000 ~ 6000000 (8M)
 *  3D Buffer    : Wiz = 3000000 ~ 4000000 (16M),Caanoo = 6000000 ~ 8000000 (32M)
 *
 * Caanoo dram column (or row?) is 1024 bytes?
 *
 * pollux display array:
 * 27:24 |  23:18  |  17:11  |  10:6  |  5:0
 *  seg  | y[11:5] | x[11:6] | y[4:0] | x[5:0]
 *       |  blk_index[12:0]  |   block[10:0]
 */

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <sys/ioctl.h>
#include <unistd.h>
#include <linux/fb.h>
#include <sys/mman.h>
#include <linux/soundcard.h>
#include <linux/input.h>

#include "libpicofe/plat.h"
#include "libpicofe/input.h"
#include "libpicofe/gp2x/in_gp2x.h"
#include "libpicofe/gp2x/soc_pollux.h"
#include "libpicofe/linux/in_evdev.h"
#include "libpicofe/menu.h"
#include "warm/warm.h"
#include "plugin_lib.h"
#include "pl_gun_ts.h"
#include "blit320.h"
#include "in_tsbutton.h"
#include "main.h"
#include "menu.h"
#include "plat.h"
#include "cspace.h"
#include "../libpcsxcore/psxmem_map.h"


static int fbdev = -1;
static void *fb_vaddrs[2];
static unsigned int fb_paddrs[2];
static int fb_work_buf;
static int have_warm;
#define FB_VRAM_SIZE (320*240*2*2*2) // 2 buffers with space for 24bpp mode
static unsigned int uppermem_pbase, vram_pbase;

static unsigned short *psx_vram;
static int psx_step, psx_width, psx_height, psx_bpp;
static int psx_offset_x, psx_offset_y, psx_src_width, psx_src_height;
static int fb_offset_x, fb_offset_y;

static void caanoo_init(void);
static void wiz_init(void);


static const struct in_default_bind in_evdev_defbinds[] = {
	{ KEY_UP,	IN_BINDTYPE_PLAYER12, DKEY_UP },
	{ KEY_DOWN,	IN_BINDTYPE_PLAYER12, DKEY_DOWN },
	{ KEY_LEFT,	IN_BINDTYPE_PLAYER12, DKEY_LEFT },
	{ KEY_RIGHT,	IN_BINDTYPE_PLAYER12, DKEY_RIGHT },
	{ BTN_TOP,	IN_BINDTYPE_PLAYER12, DKEY_TRIANGLE },
	{ BTN_THUMB,	IN_BINDTYPE_PLAYER12, DKEY_CROSS },
	{ BTN_THUMB2,	IN_BINDTYPE_PLAYER12, DKEY_CIRCLE },
	{ BTN_TRIGGER,	IN_BINDTYPE_PLAYER12, DKEY_SQUARE },
	{ BTN_BASE3,	IN_BINDTYPE_PLAYER12, DKEY_START },
	{ BTN_BASE4,	IN_BINDTYPE_PLAYER12, DKEY_SELECT },
	{ BTN_TOP2,	IN_BINDTYPE_PLAYER12, DKEY_L1 },
	{ BTN_PINKIE,	IN_BINDTYPE_PLAYER12, DKEY_R1 },
	{ BTN_BASE,	IN_BINDTYPE_EMU, SACTION_ENTER_MENU },
	{ 0, 0, 0 },
};

static void *fb_flip(void)
{
	memregl[0x406C>>2] = memregl[0x446C>>2] = fb_paddrs[fb_work_buf];
	memregl[0x4058>>2] |= 0x10;
	memregl[0x4458>>2] |= 0x10;
	fb_work_buf ^= 1;
	return fb_vaddrs[fb_work_buf];
}

static void pollux_changemode(int bpp, int is_bgr)
{
	int code = 0, bytes = 2;
	unsigned int r;

	printf("changemode: %dbpp %s\n", bpp, is_bgr ? "bgr" : "rgb");

	memregl[0x4004>>2] = 0x00ef013f;
	memregl[0x4000>>2] |= 1 << 3;

	switch (bpp)
	{
		case 8:
			code = 0x443a;
			bytes = 1;
			break;
		case 16:
			code = is_bgr ? 0xc342 : 0x4432;
			bytes = 2;
			break;
		case 24:
			code = is_bgr ? 0xc653 : 0x4653;
			bytes = 3;
			break;
		default:
			printf("unhandled bpp request: %d\n", bpp);
			return;
	}

	// program both MLCs so that TV-out works
	memregl[0x405c>>2] = memregl[0x445c>>2] = bytes;
	memregl[0x4060>>2] = memregl[0x4460>>2] = 320 * bytes;

	r = memregl[0x4058>>2];
	r = (r & 0xffff) | (code << 16) | 0x10;
	memregl[0x4058>>2] = r;

	r = memregl[0x4458>>2];
	r = (r & 0xffff) | (code << 16) | 0x10;
	memregl[0x4458>>2] = r;
}

static int cpu_clock_wrapper(int mhz)
{
	// stupid pll share hack - must restart audio
	int pollux_cpu_clock_set(int cpu_clock);
	extern long SPUopen(void);
	extern long SPUclose(void);

	pollux_cpu_clock_set(mhz);
	SPUclose();
	SPUopen();

	return 0;
}

#define TIMER_BASE3 0x1980
#define TIMER_REG(x) memregl[(TIMER_BASE3 + x) >> 2]

static __attribute__((unused)) unsigned int timer_get(void)
{
	TIMER_REG(0x08) |= 0x48;  /* run timer, latch value */
	return TIMER_REG(0);
}

void plat_video_menu_enter(int is_rom_loaded)
{
	if (pl_vout_buf != NULL) {
		if (psx_bpp == 16)
			// have to do rgb conversion for menu bg
			bgr555_to_rgb565(pl_vout_buf, pl_vout_buf, 320*240*2);
		else
			memset(pl_vout_buf, 0, 320*240*2);
	}

	pollux_changemode(16, 0);
}

void plat_video_menu_begin(void)
{
}

void plat_video_menu_end(void)
{
	g_menuscreen_ptr = fb_flip();
}

void plat_video_menu_leave(void)
{
	if (psx_vram == NULL) {
		fprintf(stderr, "GPU plugin did not provide vram\n");
		exit(1);
	}

	if (gp2x_dev_id == GP2X_DEV_CAANOO)
		in_set_config_int(in_name_to_id("evdev:pollux-analog"),
			IN_CFG_ABS_DEAD_ZONE, analog_deadzone);

	memset(g_menuscreen_ptr, 0, 320*240 * psx_bpp/8);
	g_menuscreen_ptr = fb_flip();
	memset(g_menuscreen_ptr, 0, 320*240 * psx_bpp/8);
}

void *plat_prepare_screenshot(int *w, int *h, int *bpp)
{
	bgr555_to_rgb565(pl_vout_buf, pl_vout_buf, 320*240*2);
	*w = 320;
	*h = 240;
	*bpp = psx_bpp;
	return pl_vout_buf;
}

void plat_minimize(void)
{
}

static void spend_cycles(int loops)
{
	asm volatile (
		"   mov  r0,%0    ;\n"
		"0: subs r0,r0,#1 ;\n"
		"   bgt  0b"
		:: "r" (loops) : "cc", "r0");
}

#define DMA_BASE6 0x0300
#define DMA_REG(x) memregl[(DMA_BASE6 + x) >> 2]

/* this takes ~1.5ms, while ldm/stm ~1.95ms */
static void raw_blit_dma(int doffs, const void *vram, int w, int h,
			 int sstride, int bgr24)
{
	unsigned int pixel_offset = (unsigned short *)vram - psx_vram;
	unsigned int dst = fb_paddrs[fb_work_buf] +
			(fb_offset_y * 320 + fb_offset_x) * psx_bpp / 8;
	int spsx_line = pixel_offset / 1024 + psx_offset_y;
	int spsx_offset = (pixel_offset + psx_offset_x) & 0x3f8;
	unsigned int vram_byte_pos, vram_byte_step;
	int dst_stride = 320 * psx_bpp / 8;
	int len = psx_src_width * psx_bpp / 8;
	int i;

	//warm_cache_op_all(WOP_D_CLEAN);

	dst &= ~7;
	len &= ~7;

	if (DMA_REG(0x0c) & 0x90000) {
		printf("already runnig DMA?\n");
		DMA_REG(0x0c) = 0x100000;
	}
	if ((DMA_REG(0x2c) & 0x0f) < 5) {
		printf("DMA queue busy?\n");
		DMA_REG(0x24) = 1;
	}

	vram_byte_pos = vram_pbase;
	vram_byte_pos += (spsx_line & 511) * 2 * 1024 + spsx_offset * 2;
	vram_byte_step = psx_step * 2 * 1024;

	for (i = psx_src_height; i > 0;
	     i--, vram_byte_pos += vram_byte_step, dst += dst_stride)
	{
		while ((DMA_REG(0x2c) & 0x0f) < 4)
			spend_cycles(10);

		// XXX: it seems we must always set all regs, what is autoincrement there for?
		DMA_REG(0x20) = 1;		// queue wait cmd
		DMA_REG(0x10) = vram_byte_pos;	// DMA src
		DMA_REG(0x14) = dst;		// DMA dst
		DMA_REG(0x18) = len - 1;	// len
		DMA_REG(0x1c) = 0x80000;	// go
	}
}

#define make_flip_func(name, blitfunc)                                                  \
static void name(int doffs, const void *vram_, int w, int h, int sstride, int bgr24)    \
{                                                                                       \
        const unsigned short *vram = vram_;                                             \
        unsigned char *dst = (unsigned char *)g_menuscreen_ptr +                        \
                        (fb_offset_y * 320 + fb_offset_x) * psx_bpp / 8;                \
        int dst_stride = 320 * psx_bpp / 8;                                             \
        int len = psx_src_width * psx_bpp / 8;                                          \
        int i;                                                                          \
                                                                                        \
        vram += psx_offset_y * 1024 + psx_offset_x;                                     \
        for (i = psx_src_height; i > 0; i--, vram += psx_step * 1024, dst += dst_stride)\
                blitfunc(dst, vram, len);                                               \
}

make_flip_func(raw_blit_soft, memcpy)
make_flip_func(raw_blit_soft_368, blit320_368)
make_flip_func(raw_blit_soft_512, blit320_512)
make_flip_func(raw_blit_soft_640, blit320_640)

void *plat_gvideo_set_mode(int *w_, int *h_, int *bpp_)
{
	int poff_w, poff_h, w_max;
	int w = *w_, h = *h_, bpp = *bpp_;

	if (!w || !h || !bpp)
		return NULL;

	printf("psx mode: %dx%d@%d\n", w, h, bpp);
	psx_width = w;
	psx_height = h;
	psx_bpp = bpp;

	switch (w + (bpp != 16) + !soft_scaling) {
	case 640:
		pl_plat_blit = raw_blit_soft_640;
		w_max = 640;
		break;
	case 512:
		pl_plat_blit = raw_blit_soft_512;
		w_max = 512;
		break;
	case 384:
	case 368:
		pl_plat_blit = raw_blit_soft_368;
		w_max = 368;
		break;
	default:
		pl_plat_blit = have_warm ? raw_blit_dma : raw_blit_soft;
		w_max = 320;
		break;
	}

	psx_step = 1;
	if (h > 256) {
		psx_step = 2;
		h /= 2;
	}

	poff_w = poff_h = 0;
	if (w > w_max) {
		poff_w = w / 2 - w_max / 2;
		w = w_max;
	}
	fb_offset_x = 0;
	if (w < 320)
		fb_offset_x = 320/2 - w / 2;
	if (h > 240) {
		poff_h = h / 2 - 240/2;
		h = 240;
	}
	fb_offset_y = 240/2 - h / 2;

	psx_offset_x = poff_w * psx_bpp/8 / 2;
	psx_offset_y = poff_h;
	psx_src_width = w;
	psx_src_height = h;

	if (fb_offset_x || fb_offset_y) {
		// not fullscreen, must clear borders
		memset(g_menuscreen_ptr, 0, 320*240 * psx_bpp/8);
		g_menuscreen_ptr = fb_flip();
		memset(g_menuscreen_ptr, 0, 320*240 * psx_bpp/8);
	}

	pollux_changemode(bpp, 1);

	pl_set_gun_rect(fb_offset_x, fb_offset_y, w > 320 ? 320 : w, h);

	// adjust for hud
	*w_ = 320;
	*h_ = fb_offset_y + psx_src_height;

	return g_menuscreen_ptr;
}

/* not really used, we do raw_flip */
void plat_gvideo_open(int is_pal)
{
}

void *plat_gvideo_flip(void)
{
	g_menuscreen_ptr = fb_flip();
	return g_menuscreen_ptr;
}

void plat_gvideo_close(void)
{
}

static void *pl_emu_mmap(unsigned long addr, size_t size, int is_fixed,
	enum psxMapTag tag)
{
	unsigned int pbase;
	void *retval;
	int ret;

	if (!have_warm)
		goto basic_map;

	switch (tag) {
	case MAP_TAG_RAM:
		if (size > 0x400000) {
			fprintf(stderr, "unexpected ram map request: %08lx %x\n",
				addr, size);
			exit(1);
		}
		pbase = (uppermem_pbase + 0xffffff) & ~0xffffff;
		pbase += 0x400000;
		retval = (void *)addr;
		ret = warm_mmap_section(retval, pbase, size, WCB_C_BIT);
		if (ret != 0) {
			fprintf(stderr, "ram section map failed\n");
			exit(1);
		}
		goto out;
	case MAP_TAG_VRAM:
		if (size > 0x400000) {
			fprintf(stderr, "unexpected vram map request: %08lx %x\n",
				addr, size);
			exit(1);
		}
		if (addr == 0)
			addr = 0x60000000;
		vram_pbase = (uppermem_pbase + 0xffffff) & ~0xffffff;
		retval = (void *)addr;

		ret = warm_mmap_section(retval, vram_pbase, size, WCB_C_BIT);
		if (ret != 0) {
			fprintf(stderr, "vram section map failed\n");
			exit(1);
		}
		goto out;
	case MAP_TAG_LUTS:
		// mostly for Wiz to not run out of RAM
		if (size > 0x800000) {
			fprintf(stderr, "unexpected LUT map request: %08lx %x\n",
				addr, size);
			exit(1);
		}
		pbase = (uppermem_pbase + 0xffffff) & ~0xffffff;
		pbase += 0x800000;
		retval = (void *)addr;
		ret = warm_mmap_section(retval, pbase, size, WCB_C_BIT);
		if (ret != 0) {
			fprintf(stderr, "LUT section map failed\n");
			exit(1);
		}
		goto out;
	default:
		break;
	}

basic_map:
	retval = plat_mmap(addr, size, 0, is_fixed);

out:
	if (tag == MAP_TAG_VRAM)
		psx_vram = retval;
	return retval;
}

static void pl_emu_munmap(void *ptr, size_t size, enum psxMapTag tag)
{
	switch (tag) {
	case MAP_TAG_RAM:
	case MAP_TAG_VRAM:
	case MAP_TAG_LUTS:
		warm_munmap_section(ptr, size);
		break;
	default:
		plat_munmap(ptr, size);
		break;
	}
}

void plat_init(void)
{
	const char *main_fb_name = "/dev/fb0";
	struct fb_fix_screeninfo fbfix;
	int ret;

	plat_target_init();

	fbdev = open(main_fb_name, O_RDWR);
	if (fbdev == -1) {
		fprintf(stderr, "%s: ", main_fb_name);
		perror("open");
		exit(1);
	}

	ret = ioctl(fbdev, FBIOGET_FSCREENINFO, &fbfix);
	if (ret == -1) {
		perror("ioctl(fbdev) failed");
		exit(1);
	}
	uppermem_pbase = fbfix.smem_start;

	printf("framebuffer: \"%s\" @ %08lx\n", fbfix.id, fbfix.smem_start);
	fb_paddrs[0] = fbfix.smem_start;
	fb_paddrs[1] = fb_paddrs[0] + 320*240*4; // leave space for 24bpp

	ret = warm_init();
	have_warm = (ret == 0);

	if (have_warm) {
		// map fb as write-through cached section
		fb_vaddrs[0] = (void *)0x7fe00000;
		ret = warm_mmap_section(fb_vaddrs[0], fb_paddrs[0],
			FB_VRAM_SIZE, WCB_C_BIT);
		if (ret != 0) {
			fprintf(stderr, "fb section map failed\n");
			fb_vaddrs[0] = NULL;

			// we could continue but it would just get messy
			exit(1);
		}
	}
	if (fb_vaddrs[0] == NULL) {
		fb_vaddrs[0] = mmap(0, FB_VRAM_SIZE, PROT_READ|PROT_WRITE,
				MAP_SHARED, memdev, fb_paddrs[0]);
		if (fb_vaddrs[0] == MAP_FAILED) {
			perror("mmap(fb_vaddrs) failed");
			exit(1);
		}

		memset(fb_vaddrs[0], 0, FB_VRAM_SIZE);
		warm_change_cb_range(WCB_C_BIT, 1, fb_vaddrs[0], FB_VRAM_SIZE);
	}
	printf("  mapped @%p\n", fb_vaddrs[0]);

	fb_vaddrs[1] = (char *)fb_vaddrs[0] + 320*240*4;

	memset(fb_vaddrs[0], 0, FB_VRAM_SIZE);

	pollux_changemode(16, 0);
	g_menuscreen_w = 320;
	g_menuscreen_h = 240;
	g_menuscreen_ptr = fb_flip();

	/* setup DMA */
	DMA_REG(0x0c) = 0x20000; // pending IRQ clear

	in_tsbutton_init();
	in_evdev_init(in_evdev_defbinds);
	if (gp2x_dev_id == GP2X_DEV_CAANOO)
		caanoo_init();
	else
		wiz_init();

	pl_plat_blit = have_warm ? raw_blit_dma : raw_blit_soft;

	psx_src_width = 320;
	psx_src_height = 240;
	psx_bpp = 16;

	pl_rearmed_cbs.screen_w = 320;
	pl_rearmed_cbs.screen_h = 240;

	plat_target_setup_input();

	plat_target.cpu_clock_set = cpu_clock_wrapper;

	psxMapHook = pl_emu_mmap;
	psxUnmapHook = pl_emu_munmap;
}

void plat_finish(void)
{
	warm_finish();
	memset(fb_vaddrs[0], 0, FB_VRAM_SIZE);
	munmap(fb_vaddrs[0], FB_VRAM_SIZE);
	close(fbdev);
	plat_target_finish();
}

/* Caanoo stuff, perhaps move later */
static const char * const caanoo_keys[KEY_MAX + 1] = {
	[0 ... KEY_MAX] = NULL,
	[KEY_UP]        = "Up",
	[KEY_LEFT]      = "Left",
	[KEY_RIGHT]     = "Right",
	[KEY_DOWN]      = "Down",
	[BTN_TRIGGER]   = "A",
	[BTN_THUMB]     = "X",
	[BTN_THUMB2]    = "B",
	[BTN_TOP]       = "Y",
	[BTN_TOP2]      = "L",
	[BTN_PINKIE]    = "R",
	[BTN_BASE]      = "Home",
	[BTN_BASE2]     = "Lock",
	[BTN_BASE3]     = "I",
	[BTN_BASE4]     = "II",
	[BTN_BASE5]     = "Push",
};

struct haptic_data {
	int count;
	struct {
		short time, strength;
	} actions[120];
};

#define HAPTIC_IOCTL_MAGIC	'I'
#define HAPTIC_PLAY_PATTERN	_IOW(HAPTIC_IOCTL_MAGIC, 4, struct haptic_data)
#define HAPTIC_INDIVIDUAL_MODE	_IOW(HAPTIC_IOCTL_MAGIC, 5, unsigned int)
#define HAPTIC_SET_VIB_LEVEL	_IOW(HAPTIC_IOCTL_MAGIC, 9, unsigned int)

static int hapticdev = -1;
static struct haptic_data haptic_seq[2];

static int haptic_read(const char *fname, struct haptic_data *data)
{
	int i, ret, v1, v2;
	char buf[128], *p;
	FILE *f;

	f = fopen(fname, "r");
	if (f == NULL) {
		fprintf(stderr, "fopen(%s)", fname);
		perror("");
		return -1;
	}

	for (i = 0; i < sizeof(data->actions) / sizeof(data->actions[0]); ) {
		p = fgets(buf, sizeof(buf), f);
		if (p == NULL)
			break;
		while (*p != 0 && *p == ' ')
			p++;
		if (*p == 0 || *p == ';' || *p == '#')
			continue;

		ret = sscanf(buf, "%d %d", &v1, &v2);
		if (ret != 2) {
			fprintf(stderr, "can't parse: %s", buf);
			continue;
		}

		data->actions[i].time = v1;
		data->actions[i].strength = v2;
		i++;
	}
	fclose(f);

	if (i == 0) {
		fprintf(stderr, "bad haptic file: %s\n", fname);
		return -1;
	}
	data->count = i;

	return 0;
}

static int haptic_init(void)
{
	int ret, i;

	ret = haptic_read("haptic_w.cfg", &haptic_seq[0]);
	if (ret != 0)
		return -1;
	ret = haptic_read("haptic_s.cfg", &haptic_seq[1]);
	if (ret != 0)
		return -1;

	hapticdev = open("/dev/isa1200", O_RDWR | O_NONBLOCK);
	if (hapticdev == -1) {
		perror("open(/dev/isa1200)");
		return -1;
	}

	i = 0;
	ret  = ioctl(hapticdev, HAPTIC_INDIVIDUAL_MODE, &i);	/* use 2 of them */
	i = 3;
	ret |= ioctl(hapticdev, HAPTIC_SET_VIB_LEVEL, &i);	/* max */
	if (ret != 0) {
		fprintf(stderr, "haptic ioctls failed\n");
		close(hapticdev);
		hapticdev = -1;
		return -1;
	}

	return 0;
}

void plat_trigger_vibrate(int is_strong)
{
	int ret;

	if (hapticdev == -2)
		return; // it's broken
	if (hapticdev < 0) {
		ret = haptic_init();
		if (ret < 0) {
			hapticdev = -2;
			return;
		}
	}

	ioctl(hapticdev, HAPTIC_PLAY_PATTERN, &haptic_seq[!!is_strong]);
}

static void caanoo_init(void)
{
	in_probe();
	in_set_config(in_name_to_id("evdev:pollux-analog"), IN_CFG_KEY_NAMES,
		      caanoo_keys, sizeof(caanoo_keys));
}

/* Wiz stuff */
static const struct in_default_bind in_gp2x_defbinds[] =
{
	/* MXYZ SACB RLDU */
	{ GP2X_BTN_UP,		IN_BINDTYPE_PLAYER12, DKEY_UP },
	{ GP2X_BTN_DOWN,	IN_BINDTYPE_PLAYER12, DKEY_DOWN },
	{ GP2X_BTN_LEFT,	IN_BINDTYPE_PLAYER12, DKEY_LEFT },
	{ GP2X_BTN_RIGHT,	IN_BINDTYPE_PLAYER12, DKEY_RIGHT },
	{ GP2X_BTN_X,		IN_BINDTYPE_PLAYER12, DKEY_CROSS },
	{ GP2X_BTN_B,		IN_BINDTYPE_PLAYER12, DKEY_CIRCLE },
	{ GP2X_BTN_A,		IN_BINDTYPE_PLAYER12, DKEY_SQUARE },
	{ GP2X_BTN_Y,		IN_BINDTYPE_PLAYER12, DKEY_TRIANGLE },
	{ GP2X_BTN_L,		IN_BINDTYPE_PLAYER12, DKEY_L1 },
	{ GP2X_BTN_R,		IN_BINDTYPE_PLAYER12, DKEY_R1 },
	{ GP2X_BTN_START,	IN_BINDTYPE_PLAYER12, DKEY_START },
	{ GP2X_BTN_SELECT,	IN_BINDTYPE_EMU, SACTION_ENTER_MENU },
	{ GP2X_BTN_VOL_UP,	IN_BINDTYPE_EMU, SACTION_VOLUME_UP },
	{ GP2X_BTN_VOL_DOWN,	IN_BINDTYPE_EMU, SACTION_VOLUME_DOWN },
	{ 0, 0, 0 },
};

// unused dummy for in_gp2x
volatile unsigned short *gp2x_memregs;

static void wiz_init(void)
{
	in_gp2x_init(in_gp2x_defbinds);
	in_probe();
}
Commit	Line	Data
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"
55b0eeea	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	53	static int fbdev = -1;
55b0eeea	54	static void *fb_vaddrs[2];
	55	static unsigned int fb_paddrs[2];
	56	static int fb_work_buf;
cc56203b	57	static int have_warm;
0b6c6da8	58	#define FB_VRAM_SIZE (320240222) // 2 buffers with space for 24bpp mode
c02c3b65	59	static unsigned int uppermem_pbase, vram_pbase;
55b0eeea	60
55b0eeea	61	static unsigned short *psx_vram;
02ee7e24	62	static int psx_step, psx_width, psx_height, psx_bpp;
a72ac803	63	static int psx_offset_x, psx_offset_y, psx_src_width, psx_src_height;
41f55c9f	64	static int fb_offset_x, fb_offset_y;
55b0eeea	65
9b4bd105	66	static void caanoo_init(void);
b07c18e8	67	static void wiz_init(void);
b07c18e8	68
9b4bd105	69
b07c18e8	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	};
9b4bd105	86
55b0eeea	87	static void *fb_flip(void)
55b0eeea	88	{
0b6c6da8	89	memregl[0x406C>>2] = memregl[0x446C>>2] = fb_paddrs[fb_work_buf];
55b0eeea	90	memregl[0x4058>>2] \|= 0x10;
0b6c6da8	91	memregl[0x4458>>2] \|= 0x10;
55b0eeea	92	fb_work_buf ^= 1;
	93	return fb_vaddrs[fb_work_buf];
	94	}
	95
	96	static void pollux_changemode(int bpp, int is_bgr)
	97	{
	98	int code = 0, bytes = 2;
	99	unsigned int r;
	100
	101	printf("changemode: %dbpp %s\n", bpp, is_bgr ? "bgr" : "rgb");
	102
	103	memregl[0x4004>>2] = 0x00ef013f;
	104	memregl[0x4000>>2] \|= 1 << 3;
	105
	106	switch (bpp)
	107	{
	108	case 8:
	109	code = 0x443a;
	110	bytes = 1;
	111	break;
	112	case 16:
	113	code = is_bgr ? 0xc342 : 0x4432;
	114	bytes = 2;
	115	break;
	116	case 24:
	117	code = is_bgr ? 0xc653 : 0x4653;
	118	bytes = 3;
	119	break;
	120	default:
	121	printf("unhandled bpp request: %d\n", bpp);
	122	return;
	123	}
	124
0b6c6da8	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;
55b0eeea	128
	129	r = memregl[0x4058>>2];
	130	r = (r & 0xffff) \| (code << 16) \| 0x10;
	131	memregl[0x4058>>2] = r;
0b6c6da8	132
	133	r = memregl[0x4458>>2];
	134	r = (r & 0xffff) \| (code << 16) \| 0x10;
	135	memregl[0x4458>>2] = r;
55b0eeea	136	}
55b0eeea	137
cc56203b	138	static int cpu_clock_wrapper(int mhz)
55b0eeea	139	{
55b0eeea	140	// stupid pll share hack - must restart audio
cc56203b	141	int pollux_cpu_clock_set(int cpu_clock);
55b0eeea	142	extern long SPUopen(void);
55b0eeea	143	extern long SPUclose(void);
cc56203b	144
cc56203b	145	pollux_cpu_clock_set(mhz);
55b0eeea	146	SPUclose();
	147	SPUopen();
	148
	149	return 0;
	150	}
	151
55b0eeea	152	#define TIMER_BASE3 0x1980
	153	#define TIMER_REG(x) memregl[(TIMER_BASE3 + x) >> 2]
	154
	155	static __attribute__((unused)) unsigned int timer_get(void)
	156	{
	157	TIMER_REG(0x08) \|= 0x48; /* run timer, latch value */
	158	return TIMER_REG(0);
	159	}
	160
55b0eeea	161	void plat_video_menu_enter(int is_rom_loaded)
	162	{
	163	if (pl_vout_buf != NULL) {
	164	if (psx_bpp == 16)
	165	// have to do rgb conversion for menu bg
	166	bgr555_to_rgb565(pl_vout_buf, pl_vout_buf, 3202402);
	167	else
	168	memset(pl_vout_buf, 0, 3202402);
	169	}
	170
	171	pollux_changemode(16, 0);
	172	}
	173
	174	void plat_video_menu_begin(void)
	175	{
	176	}
	177
	178	void plat_video_menu_end(void)
	179	{
	180	g_menuscreen_ptr = fb_flip();
	181	}
	182
	183	void plat_video_menu_leave(void)
	184	{
55b0eeea	185	if (psx_vram == NULL) {
	186	fprintf(stderr, "GPU plugin did not provide vram\n");
	187	exit(1);
	188	}
	189
221be40d	190	if (gp2x_dev_id == GP2X_DEV_CAANOO)
221be40d	191	in_set_config_int(in_name_to_id("evdev:pollux-analog"),
55b0eeea	192	IN_CFG_ABS_DEAD_ZONE, analog_deadzone);
41f55c9f	193
	194	memset(g_menuscreen_ptr, 0, 320240 psx_bpp/8);
	195	g_menuscreen_ptr = fb_flip();
ddc0a02a	196	memset(g_menuscreen_ptr, 0, 320240 psx_bpp/8);
55b0eeea	197	}
55b0eeea	198
47821672	199	void plat_prepare_screenshot(int w, int h, int bpp)
	200	{
	201	bgr555_to_rgb565(pl_vout_buf, pl_vout_buf, 3202402);
	202	*w = 320;
	203	*h = 240;
	204	*bpp = psx_bpp;
	205	return pl_vout_buf;
	206	}
	207
a805c855	208	void plat_minimize(void)
	209	{
	210	}
	211
55b0eeea	212	static void spend_cycles(int loops)
	213	{
	214	asm volatile (
	215	" mov r0,%0 ;\n"
	216	"0: subs r0,r0,#1 ;\n"
	217	" bgt 0b"
	218	:: "r" (loops) : "cc", "r0");
	219	}
	220
	221	#define DMA_BASE6 0x0300
	222	#define DMA_REG(x) memregl[(DMA_BASE6 + x) >> 2]
	223
	224	/* this takes ~1.5ms, while ldm/stm ~1.95ms */
02783d0b	225	static void raw_blit_dma(int doffs, const void *vram, int w, int h,
02783d0b	226	int sstride, int bgr24)
55b0eeea	227	{
02783d0b	228	unsigned int pixel_offset = (unsigned short *)vram - psx_vram;
41f55c9f	229	unsigned int dst = fb_paddrs[fb_work_buf] +
41f55c9f	230	(fb_offset_y * 320 + fb_offset_x) * psx_bpp / 8;
fa56d360	231	int spsx_line = pixel_offset / 1024 + psx_offset_y;
fa56d360	232	int spsx_offset = (pixel_offset + psx_offset_x) & 0x3f8;
c02c3b65	233	unsigned int vram_byte_pos, vram_byte_step;
55b0eeea	234	int dst_stride = 320 * psx_bpp / 8;
a72ac803	235	int len = psx_src_width * psx_bpp / 8;
55b0eeea	236	int i;
55b0eeea	237
c02c3b65	238	//warm_cache_op_all(WOP_D_CLEAN);
55b0eeea	239
	240	dst &= ~7;
	241	len &= ~7;
	242
	243	if (DMA_REG(0x0c) & 0x90000) {
	244	printf("already runnig DMA?\n");
	245	DMA_REG(0x0c) = 0x100000;
	246	}
	247	if ((DMA_REG(0x2c) & 0x0f) < 5) {
	248	printf("DMA queue busy?\n");
	249	DMA_REG(0x24) = 1;
	250	}
	251
c02c3b65	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;
	255
	256	for (i = psx_src_height; i > 0;
	257	i--, vram_byte_pos += vram_byte_step, dst += dst_stride)
	258	{
55b0eeea	259	while ((DMA_REG(0x2c) & 0x0f) < 4)
	260	spend_cycles(10);
	261
	262	// XXX: it seems we must always set all regs, what is autoincrement there for?
	263	DMA_REG(0x20) = 1; // queue wait cmd
c02c3b65	264	DMA_REG(0x10) = vram_byte_pos; // DMA src
55b0eeea	265	DMA_REG(0x14) = dst; // DMA dst
	266	DMA_REG(0x18) = len - 1; // len
	267	DMA_REG(0x1c) = 0x80000; // go
	268	}
55b0eeea	269	}
55b0eeea	270
02ee7e24	271	#define make_flip_func(name, blitfunc) \
02783d0b	272	static void name(int doffs, const void *vram_, int w, int h, int sstride, int bgr24) \
02ee7e24	273	{ \
fa56d360	274	const unsigned short *vram = vram_; \
02ee7e24	275	unsigned char dst = (unsigned char )g_menuscreen_ptr + \
02ee7e24	276	(fb_offset_y * 320 + fb_offset_x) * psx_bpp / 8; \
02ee7e24	277	int dst_stride = 320 * psx_bpp / 8; \
a72ac803	278	int len = psx_src_width * psx_bpp / 8; \
02ee7e24	279	int i; \
02ee7e24	280	\
fa56d360	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); \
02ee7e24	284	}
02ee7e24	285
02783d0b	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)
02ee7e24	290
6469a8c4	291	void plat_gvideo_set_mode(int w_, int h_, int bpp_)
55b0eeea	292	{
02ee7e24	293	int poff_w, poff_h, w_max;
6469a8c4	294	int w = w_, h = h_, bpp = *bpp_;
55b0eeea	295
a72ac803	296	if (!w \|\| !h \|\| !bpp)
02ee7e24	297	return NULL;
55b0eeea	298
02ee7e24	299	printf("psx mode: %dx%d@%d\n", w, h, bpp);
a72ac803	300	psx_width = w;
	301	psx_height = h;
	302	psx_bpp = bpp;
55b0eeea	303
a72ac803	304	switch (w + (bpp != 16) + !soft_scaling) {
02ee7e24	305	case 640:
02783d0b	306	pl_plat_blit = raw_blit_soft_640;
02ee7e24	307	w_max = 640;
	308	break;
	309	case 512:
02783d0b	310	pl_plat_blit = raw_blit_soft_512;
02ee7e24	311	w_max = 512;
	312	break;
	313	case 384:
	314	case 368:
02783d0b	315	pl_plat_blit = raw_blit_soft_368;
02ee7e24	316	w_max = 368;
	317	break;
	318	default:
02783d0b	319	pl_plat_blit = have_warm ? raw_blit_dma : raw_blit_soft;
02ee7e24	320	w_max = 320;
02ee7e24	321	break;
55b0eeea	322	}
55b0eeea	323
02ee7e24	324	psx_step = 1;
	325	if (h > 256) {
	326	psx_step = 2;
	327	h /= 2;
	328	}
	329
	330	poff_w = poff_h = 0;
	331	if (w > w_max) {
	332	poff_w = w / 2 - w_max / 2;
	333	w = w_max;
	334	}
	335	fb_offset_x = 0;
	336	if (w < 320)
	337	fb_offset_x = 320/2 - w / 2;
	338	if (h > 240) {
	339	poff_h = h / 2 - 240/2;
	340	h = 240;
	341	}
	342	fb_offset_y = 240/2 - h / 2;
	343
6983a9ae	344	psx_offset_x = poff_w * psx_bpp/8 / 2;
02ee7e24	345	psx_offset_y = poff_h;
a72ac803	346	psx_src_width = w;
a72ac803	347	psx_src_height = h;
02ee7e24	348
	349	if (fb_offset_x \|\| fb_offset_y) {
	350	// not fullscreen, must clear borders
	351	memset(g_menuscreen_ptr, 0, 320240 psx_bpp/8);
	352	g_menuscreen_ptr = fb_flip();
	353	memset(g_menuscreen_ptr, 0, 320240 psx_bpp/8);
	354	}
	355
	356	pollux_changemode(bpp, 1);
	357
221be40d	358	pl_set_gun_rect(fb_offset_x, fb_offset_y, w > 320 ? 320 : w, h);
221be40d	359
6469a8c4	360	// adjust for hud
	361	*w_ = 320;
	362	*h_ = fb_offset_y + psx_src_height;
	363
02783d0b	364	return g_menuscreen_ptr;
55b0eeea	365	}
55b0eeea	366
6469a8c4	367	/* not really used, we do raw_flip */
ab423939	368	void plat_gvideo_open(int is_pal)
6469a8c4	369	{
	370	}
	371
	372	void *plat_gvideo_flip(void)
41f55c9f	373	{
02783d0b	374	g_menuscreen_ptr = fb_flip();
02783d0b	375	return g_menuscreen_ptr;
41f55c9f	376	}
41f55c9f	377
6469a8c4	378	void plat_gvideo_close(void)
	379	{
	380	}
	381
c02c3b65	382	static void *pl_emu_mmap(unsigned long addr, size_t size, int is_fixed,
	383	enum psxMapTag tag)
	384	{
	385	unsigned int pbase;
	386	void *retval;
	387	int ret;
	388
	389	if (!have_warm)
	390	goto basic_map;
	391
	392	switch (tag) {
	393	case MAP_TAG_RAM:
	394	if (size > 0x400000) {
	395	fprintf(stderr, "unexpected ram map request: %08lx %x\n",
	396	addr, size);
	397	exit(1);
	398	}
	399	pbase = (uppermem_pbase + 0xffffff) & ~0xffffff;
	400	pbase += 0x400000;
	401	retval = (void *)addr;
	402	ret = warm_mmap_section(retval, pbase, size, WCB_C_BIT);
	403	if (ret != 0) {
	404	fprintf(stderr, "ram section map failed\n");
	405	exit(1);
	406	}
	407	goto out;
	408	case MAP_TAG_VRAM:
	409	if (size > 0x400000) {
	410	fprintf(stderr, "unexpected vram map request: %08lx %x\n",
	411	addr, size);
	412	exit(1);
	413	}
	414	if (addr == 0)
	415	addr = 0x60000000;
	416	vram_pbase = (uppermem_pbase + 0xffffff) & ~0xffffff;
	417	retval = (void *)addr;
	418
	419	ret = warm_mmap_section(retval, vram_pbase, size, WCB_C_BIT);
	420	if (ret != 0) {
	421	fprintf(stderr, "vram section map failed\n");
	422	exit(1);
	423	}
	424	goto out;
	425	case MAP_TAG_LUTS:
	426	// mostly for Wiz to not run out of RAM
	427	if (size > 0x800000) {
	428	fprintf(stderr, "unexpected LUT map request: %08lx %x\n",
	429	addr, size);
	430	exit(1);
	431	}
	432	pbase = (uppermem_pbase + 0xffffff) & ~0xffffff;
	433	pbase += 0x800000;
	434	retval = (void *)addr;
	435	ret = warm_mmap_section(retval, pbase, size, WCB_C_BIT);
	436	if (ret != 0) {
	437	fprintf(stderr, "LUT section map failed\n");
	438	exit(1);
	439	}
	440	goto out;
	441	default:
	442	break;
	443	}
	444
	445	basic_map:
446	retval = plat_mmap(addr, size, 0, is_fixed);
447
448	out:
449	if (tag == MAP_TAG_VRAM)
450	psx_vram = retval;
451	return retval;
452	}
453
454	static void pl_emu_munmap(void *ptr, size_t size, enum psxMapTag tag)
455	{
456	switch (tag) {
457	case MAP_TAG_RAM:
458	case MAP_TAG_VRAM:
459	case MAP_TAG_LUTS:
460	warm_munmap_section(ptr, size);
461	break;
462	default:
463	plat_munmap(ptr, size);
464	break;
465	}
466	}
467
55b0eeea	468	void plat_init(void)
	469	{
	470	const char *main_fb_name = "/dev/fb0";
	471	struct fb_fix_screeninfo fbfix;
cc56203b	472	int ret;
55b0eeea	473
cc56203b	474	plat_target_init();
0b6c6da8	475
55b0eeea	476	fbdev = open(main_fb_name, O_RDWR);
	477	if (fbdev == -1) {
	478	fprintf(stderr, "%s: ", main_fb_name);
	479	perror("open");
	480	exit(1);
	481	}
	482
	483	ret = ioctl(fbdev, FBIOGET_FSCREENINFO, &fbfix);
	484	if (ret == -1) {
	485	perror("ioctl(fbdev) failed");
	486	exit(1);
	487	}
c02c3b65	488	uppermem_pbase = fbfix.smem_start;
c02c3b65	489
55b0eeea	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] + 3202404; // leave space for 24bpp
	493
c02c3b65	494	ret = warm_init();
	495	have_warm = (ret == 0);
	496
	497	if (have_warm) {
	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);
	502	if (ret != 0) {
	503	fprintf(stderr, "fb section map failed\n");
	504	fb_vaddrs[0] = NULL;
	505
	506	// we could continue but it would just get messy
	507	exit(1);
	508	}
	509	}
	510	if (fb_vaddrs[0] == NULL) {
	511	fb_vaddrs[0] = mmap(0, FB_VRAM_SIZE, PROT_READ\|PROT_WRITE,
55b0eeea	512	MAP_SHARED, memdev, fb_paddrs[0]);
c02c3b65	513	if (fb_vaddrs[0] == MAP_FAILED) {
	514	perror("mmap(fb_vaddrs) failed");
	515	exit(1);
	516	}
	517
	518	memset(fb_vaddrs[0], 0, FB_VRAM_SIZE);
	519	warm_change_cb_range(WCB_C_BIT, 1, fb_vaddrs[0], FB_VRAM_SIZE);
55b0eeea	520	}
c02c3b65	521	printf(" mapped @%p\n", fb_vaddrs[0]);
c02c3b65	522
55b0eeea	523	fb_vaddrs[1] = (char )fb_vaddrs[0] + 320240*4;
55b0eeea	524
a72ac803	525	memset(fb_vaddrs[0], 0, FB_VRAM_SIZE);
cc56203b	526
55b0eeea	527	pollux_changemode(16, 0);
	528	g_menuscreen_w = 320;
	529	g_menuscreen_h = 240;
	530	g_menuscreen_ptr = fb_flip();
	531
55b0eeea	532	/* setup DMA */
	533	DMA_REG(0x0c) = 0x20000; // pending IRQ clear
	534
9b4bd105	535	in_tsbutton_init();
b07c18e8	536	in_evdev_init(in_evdev_defbinds);
9b4bd105	537	if (gp2x_dev_id == GP2X_DEV_CAANOO)
9b4bd105	538	caanoo_init();
b07c18e8	539	else
b07c18e8	540	wiz_init();
9b4bd105	541
02783d0b	542	pl_plat_blit = have_warm ? raw_blit_dma : raw_blit_soft;
55b0eeea	543
a72ac803	544	psx_src_width = 320;
a72ac803	545	psx_src_height = 240;
55b0eeea	546	psx_bpp = 16;
bb88ec28	547
	548	pl_rearmed_cbs.screen_w = 320;
	549	pl_rearmed_cbs.screen_h = 240;
cc56203b	550
	551	plat_target_setup_input();
	552
	553	plat_target.cpu_clock_set = cpu_clock_wrapper;
c02c3b65	554
	555	psxMapHook = pl_emu_mmap;
	556	psxUnmapHook = pl_emu_munmap;
55b0eeea	557	}
	558
	559	void plat_finish(void)
	560	{
	561	warm_finish();
0b6c6da8	562	memset(fb_vaddrs[0], 0, FB_VRAM_SIZE);
0b6c6da8	563	munmap(fb_vaddrs[0], FB_VRAM_SIZE);
0b6c6da8	564	close(fbdev);
cc56203b	565	plat_target_finish();
55b0eeea	566	}
55b0eeea	567
55b0eeea	568	/* Caanoo stuff, perhaps move later */
55b0eeea	569	static const char * const caanoo_keys[KEY_MAX + 1] = {
	570	[0 ... KEY_MAX] = NULL,
	571	[KEY_UP] = "Up",
	572	[KEY_LEFT] = "Left",
	573	[KEY_RIGHT] = "Right",
	574	[KEY_DOWN] = "Down",
	575	[BTN_TRIGGER] = "A",
	576	[BTN_THUMB] = "X",
	577	[BTN_THUMB2] = "B",
	578	[BTN_TOP] = "Y",
	579	[BTN_TOP2] = "L",
	580	[BTN_PINKIE] = "R",
	581	[BTN_BASE] = "Home",
	582	[BTN_BASE2] = "Lock",
	583	[BTN_BASE3] = "I",
	584	[BTN_BASE4] = "II",
	585	[BTN_BASE5] = "Push",
	586	};
	587
b944a30e	588	struct haptic_data {
	589	int count;
	590	struct {
	591	short time, strength;
	592	} actions[120];
	593	};
	594
	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)
	599
	600	static int hapticdev = -1;
3a40ff14	601	static struct haptic_data haptic_seq[2];
b944a30e	602
3a40ff14	603	static int haptic_read(const char fname, struct haptic_data data)
b944a30e	604	{
	605	int i, ret, v1, v2;
	606	char buf[128], *p;
	607	FILE *f;
	608
3a40ff14	609	f = fopen(fname, "r");
b944a30e	610	if (f == NULL) {
6469a8c4	611	fprintf(stderr, "fopen(%s)", fname);
3a40ff14	612	perror("");
b944a30e	613	return -1;
	614	}
	615
3a40ff14	616	for (i = 0; i < sizeof(data->actions) / sizeof(data->actions[0]); ) {
b944a30e	617	p = fgets(buf, sizeof(buf), f);
	618	if (p == NULL)
	619	break;
	620	while (p != 0 && p == ' ')
	621	p++;
	622	if (p == 0 \|\| p == ';' \|\| *p == '#')
	623	continue;
	624
	625	ret = sscanf(buf, "%d %d", &v1, &v2);
	626	if (ret != 2) {
	627	fprintf(stderr, "can't parse: %s", buf);
	628	continue;
	629	}
	630
3a40ff14	631	data->actions[i].time = v1;
3a40ff14	632	data->actions[i].strength = v2;
b944a30e	633	i++;
	634	}
	635	fclose(f);
	636
	637	if (i == 0) {
3a40ff14	638	fprintf(stderr, "bad haptic file: %s\n", fname);
b944a30e	639	return -1;
b944a30e	640	}
3a40ff14	641	data->count = i;
	642
	643	return 0;
	644	}
	645
	646	static int haptic_init(void)
	647	{
	648	int ret, i;
	649
	650	ret = haptic_read("haptic_w.cfg", &haptic_seq[0]);
	651	if (ret != 0)
	652	return -1;
	653	ret = haptic_read("haptic_s.cfg", &haptic_seq[1]);
	654	if (ret != 0)
	655	return -1;
b944a30e	656
	657	hapticdev = open("/dev/isa1200", O_RDWR \| O_NONBLOCK);
	658	if (hapticdev == -1) {
	659	perror("open(/dev/isa1200)");
	660	return -1;
	661	}
	662
	663	i = 0;
	664	ret = ioctl(hapticdev, HAPTIC_INDIVIDUAL_MODE, &i); /* use 2 of them */
	665	i = 3;
	666	ret \|= ioctl(hapticdev, HAPTIC_SET_VIB_LEVEL, &i); /* max */
	667	if (ret != 0) {
	668	fprintf(stderr, "haptic ioctls failed\n");
	669	close(hapticdev);
	670	hapticdev = -1;
	671	return -1;
	672	}
	673
	674	return 0;
	675	}
	676
3a40ff14	677	void plat_trigger_vibrate(int is_strong)
b944a30e	678	{
	679	int ret;
	680
	681	if (hapticdev == -2)
	682	return; // it's broken
	683	if (hapticdev < 0) {
	684	ret = haptic_init();
	685	if (ret < 0) {
	686	hapticdev = -2;
	687	return;
	688	}
	689	}
	690
3a40ff14	691	ioctl(hapticdev, HAPTIC_PLAY_PATTERN, &haptic_seq[!!is_strong]);
b944a30e	692	}
b944a30e	693
b07c18e8	694	static void caanoo_init(void)
	695	{
	696	in_probe();
	697	in_set_config(in_name_to_id("evdev:pollux-analog"), IN_CFG_KEY_NAMES,
	698	caanoo_keys, sizeof(caanoo_keys));
	699	}
	700
221be40d	701	/* Wiz stuff */
b07c18e8	702	static const struct in_default_bind in_gp2x_defbinds[] =
221be40d	703	{
	704	/* MXYZ SACB RLDU */
	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 },
	719	{ 0, 0, 0 },
	720	};
	721
221be40d	722	// unused dummy for in_gp2x
	723	volatile unsigned short *gp2x_memregs;
	724
b07c18e8	725	static void wiz_init(void)
55b0eeea	726	{
b07c18e8	727	in_gp2x_init(in_gp2x_defbinds);
b07c18e8	728	in_probe();
55b0eeea	729	}