[libpicofe.git] / gp2x / soc_pollux.c

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

#include "soc.h"
#include "plat_gp2x.h"
#include "../common/emu.h"
#include "../common/arm_utils.h"
#include "pollux_set.h"

static volatile unsigned short *memregs;
static volatile unsigned long  *memregl;
static int memdev = -1;
static int battdev = -1;

extern void *gp2x_screens[4];

#define fb_buf_count 4
static unsigned int fb_paddr[fb_buf_count];
static int fb_work_buf;
static int fbdev = -1;

static char cpuclk_was_changed = 0;
static unsigned short memtimex_old[2];
static unsigned int pllsetreg0;
static int last_pal_setting = 0;


/* video stuff */
static void pollux_video_flip(int buf_count)
{
	memregl[0x406C>>2] = fb_paddr[fb_work_buf];
	memregl[0x4058>>2] |= 0x10;
	fb_work_buf++;
	if (fb_work_buf >= buf_count)
		fb_work_buf = 0;
	g_screen_ptr = gp2x_screens[fb_work_buf];
}

static void gp2x_video_flip_(void)
{
	pollux_video_flip(fb_buf_count);
}

/* doulblebuffered flip */
static void gp2x_video_flip2_(void)
{
	pollux_video_flip(2);
}

static void gp2x_video_changemode_ll_(int bpp)
{
	static int prev_bpp = 0;
	int code = 0, bytes = 2;
	int rot_cmd[2] = { 0, 0 };
	unsigned int r;
	int ret;

	if (bpp == prev_bpp)
		return;
	prev_bpp = bpp;

	printf("changemode: %dbpp rot=%d\n", abs(bpp), bpp < 0);

	/* negative bpp means rotated mode */
	rot_cmd[0] = (bpp < 0) ? 6 : 5;
	ret = ioctl(fbdev, _IOW('D', 90, int[2]), rot_cmd);
	if (ret < 0)
		perror("rot ioctl failed");
	memregl[0x4004>>2] = (bpp < 0) ? 0x013f00ef : 0x00ef013f;
	memregl[0x4000>>2] |= 1 << 3;

	/* the above ioctl resets LCD timings, so set them here */
	set_lcd_custom_rate(last_pal_setting);

	switch (abs(bpp))
	{
		case 8:
			code = 0x443a;
			bytes = 1;
			break;

		case 15:
		case 16:
			code = 0x4432;
			bytes = 2;
			break;

		default:
			printf("unhandled bpp request: %d\n", abs(bpp));
			return;
	}

	memregl[0x405c>>2] = bytes;
	memregl[0x4060>>2] = bytes * (bpp < 0 ? 240 : 320);

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

static void gp2x_video_setpalette_(int *pal, int len)
{
	/* pollux palette is 16bpp only.. */
	int i;
	for (i = 0; i < len; i++)
	{
		int c = pal[i];
		c = ((c >> 8) & 0xf800) | ((c >> 5) & 0x07c0) | ((c >> 3) & 0x001f);
		memregl[0x4070>>2] = (i << 24) | c;
	}
}

static void gp2x_video_RGB_setscaling_(int ln_offs, int W, int H)
{
	/* maybe a job for 3d hardware? */
}

static void gp2x_video_wait_vsync_(void)
{
	while (!(memregl[0x308c>>2] & (1 << 10)));
		spend_cycles(128);
	memregl[0x308c>>2] |= 1 << 10;
}

/* CPU clock */
static void gp2x_set_cpuclk_(unsigned int mhz)
{
	char buff[24];
	snprintf(buff, sizeof(buff), "cpuclk=%u", mhz);
	pollux_set(memregs, buff);

	cpuclk_was_changed = 1;
}

/* misc */
static void pollux_set_fromenv(const char *env_var)
{
	const char *set_string;
	set_string = getenv(env_var);
	if (set_string)
		pollux_set(memregs, set_string);
	else
		printf("env var %s not defined.\n", env_var);
}

/* RAM timings */
static void set_ram_timings_(void)
{
	pollux_set_fromenv("POLLUX_RAM_TIMINGS");
}

static void unset_ram_timings_(void)
{
	int i;

	memregs[0x14802>>1] = memtimex_old[0];
	memregs[0x14804>>1] = memtimex_old[1] | 0x8000;

	for (i = 0; i < 0x100000; i++)
		if (!(memregs[0x14804>>1] & 0x8000))
			break;

	printf("RAM timings reset to startup values.\n");
}

/* LCD refresh */
static void set_lcd_custom_rate_(int is_pal)
{
	char buff[32];

	snprintf(buff, sizeof(buff), "POLLUX_LCD_TIMINGS_%s", is_pal ? "PAL" : "NTSC");
	pollux_set_fromenv(buff);
	last_pal_setting = is_pal;
}

static void unset_lcd_custom_rate_(void)
{
}

static void set_lcd_gamma_(int g100, int A_SNs_curve)
{
	/* hm, the LCD possibly can do it (but not POLLUX) */
}

static int gp2x_read_battery_(void)
{
	unsigned short magic_val = 0;

	if (battdev < 0)
		return -1;
	if (read(battdev, &magic_val, sizeof(magic_val)) != sizeof(magic_val))
		return -1;
	switch (magic_val) {
	default:
	case 1:	return 100;
	case 2: return 66;
	case 3: return 40;
	case 4: return 0;
	}
}

void pollux_init(void)
{
	struct fb_fix_screeninfo fbfix;
	int i, ret;

	memdev = open("/dev/mem", O_RDWR);
	if (memdev == -1) {
		perror("open(/dev/mem) failed");
		exit(1);
	}

	memregs	= mmap(0, 0x20000, PROT_READ|PROT_WRITE, MAP_SHARED, memdev, 0xc0000000);
	if (memregs == MAP_FAILED) {
		perror("mmap(memregs) failed");
		exit(1);
	}
	memregl = (volatile void *)memregs;

	fbdev = open("/dev/fb0", O_RDWR);
	if (fbdev < 0) {
		perror("can't open fbdev");
		exit(1);
	}

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

	printf("framebuffer: \"%s\" @ %08lx\n", fbfix.id, fbfix.smem_start);
	fb_paddr[0] = fbfix.smem_start;

	gp2x_screens[0] = mmap(0, 320*240*2*fb_buf_count, PROT_READ|PROT_WRITE,
			MAP_SHARED, memdev, fb_paddr[0]);
	if (gp2x_screens[0] == MAP_FAILED)
	{
		perror("mmap(gp2x_screens) failed");
		exit(1);
	}
	memset(gp2x_screens[0], 0, 320*240*2*fb_buf_count);

	printf("  %p -> %08x\n", gp2x_screens[0], fb_paddr[0]);
	for (i = 1; i < fb_buf_count; i++)
	{
		fb_paddr[i] = fb_paddr[i-1] + 320*240*2;
		gp2x_screens[i] = (char *)gp2x_screens[i-1] + 320*240*2;
		printf("  %p -> %08x\n", gp2x_screens[i], fb_paddr[i]);
	}
	fb_work_buf = 0;
	g_screen_ptr = gp2x_screens[0];

	battdev = open("/dev/pollux_batt", O_RDONLY);
	if (battdev < 0)
		perror("Warning: could't open pollux_batt");

	pllsetreg0 = memregl[0xf004>>2];
	memtimex_old[0] = memregs[0x14802>>1];
	memtimex_old[1] = memregs[0x14804>>1];

	gp2x_video_flip = gp2x_video_flip_;
	gp2x_video_flip2 = gp2x_video_flip2_;
	gp2x_video_changemode_ll = gp2x_video_changemode_ll_;
	gp2x_video_setpalette = gp2x_video_setpalette_;
	gp2x_video_RGB_setscaling = gp2x_video_RGB_setscaling_;
	gp2x_video_wait_vsync = gp2x_video_wait_vsync_;

	gp2x_set_cpuclk = gp2x_set_cpuclk_;

	set_lcd_custom_rate = set_lcd_custom_rate_;
	unset_lcd_custom_rate = unset_lcd_custom_rate_;
	set_lcd_gamma = set_lcd_gamma_;

	set_ram_timings = set_ram_timings_;
	unset_ram_timings = unset_ram_timings_;
	gp2x_read_battery = gp2x_read_battery_;
}

void pollux_finish(void)
{
	/* switch to default fb mem, turn portrait off */
	memregl[0x406C>>2] = fb_paddr[0];
	memregl[0x4058>>2] |= 0x10;
	close(fbdev);

	gp2x_video_changemode_ll_(16);
	unset_ram_timings_();
	if (cpuclk_was_changed) {
		memregl[0xf004>>2] = pllsetreg0;
		memregl[0xf07c>>2] |= 0x8000;
	}

	munmap((void *)memregs, 0x20000);
	close(memdev);
	if (battdev >= 0)
		close(battdev);
}
Commit	Line	Data
fa8d1331	1	#include <stdio.h>
	2	#include <stdlib.h>
	3	#include <string.h>
	4	#include <math.h>
	5	#include <sys/types.h>
	6	#include <sys/stat.h>
	7	#include <fcntl.h>
	8	#include <sys/mman.h>
	9	#include <unistd.h>
	10	#include <sys/ioctl.h>
	11	#include <linux/fb.h>
	12
	13	#include "soc.h"
	14	#include "plat_gp2x.h"
	15	#include "../common/emu.h"
	16	#include "../common/arm_utils.h"
	17	#include "pollux_set.h"
	18
	19	static volatile unsigned short *memregs;
	20	static volatile unsigned long *memregl;
	21	static int memdev = -1;
053bef76	22	static int battdev = -1;
fa8d1331	23
	24	extern void *gp2x_screens[4];
	25
	26	#define fb_buf_count 4
	27	static unsigned int fb_paddr[fb_buf_count];
	28	static int fb_work_buf;
	29	static int fbdev = -1;
	30
71769e27	31	static char cpuclk_was_changed = 0;
	32	static unsigned short memtimex_old[2];
	33	static unsigned int pllsetreg0;
b7911801	34	static int last_pal_setting = 0;
71769e27	35
fa8d1331	36
	37	/* video stuff */
	38	static void pollux_video_flip(int buf_count)
	39	{
	40	memregl[0x406C>>2] = fb_paddr[fb_work_buf];
	41	memregl[0x4058>>2] \|= 0x10;
	42	fb_work_buf++;
	43	if (fb_work_buf >= buf_count)
	44	fb_work_buf = 0;
	45	g_screen_ptr = gp2x_screens[fb_work_buf];
	46	}
	47
	48	static void gp2x_video_flip_(void)
	49	{
	50	pollux_video_flip(fb_buf_count);
	51	}
	52
	53	/* doulblebuffered flip */
	54	static void gp2x_video_flip2_(void)
	55	{
	56	pollux_video_flip(2);
	57	}
	58
	59	static void gp2x_video_changemode_ll_(int bpp)
	60	{
b7911801	61	static int prev_bpp = 0;
fa8d1331	62	int code = 0, bytes = 2;
b7911801	63	int rot_cmd[2] = { 0, 0 };
fa8d1331	64	unsigned int r;
b7911801	65	int ret;
	66
	67	if (bpp == prev_bpp)
	68	return;
	69	prev_bpp = bpp;
	70
	71	printf("changemode: %dbpp rot=%d\n", abs(bpp), bpp < 0);
	72
	73	/* negative bpp means rotated mode */
	74	rot_cmd[0] = (bpp < 0) ? 6 : 5;
	75	ret = ioctl(fbdev, _IOW('D', 90, int[2]), rot_cmd);
	76	if (ret < 0)
	77	perror("rot ioctl failed");
	78	memregl[0x4004>>2] = (bpp < 0) ? 0x013f00ef : 0x00ef013f;
	79	memregl[0x4000>>2] \|= 1 << 3;
	80
	81	/* the above ioctl resets LCD timings, so set them here */
	82	set_lcd_custom_rate(last_pal_setting);
	83
	84	switch (abs(bpp))
fa8d1331	85	{
	86	case 8:
	87	code = 0x443a;
	88	bytes = 1;
	89	break;
	90
	91	case 15:
	92	case 16:
	93	code = 0x4432;
	94	bytes = 2;
	95	break;
	96
	97	default:
b7911801	98	printf("unhandled bpp request: %d\n", abs(bpp));
fa8d1331	99	return;
	100	}
	101
	102	memregl[0x405c>>2] = bytes;
b7911801	103	memregl[0x4060>>2] = bytes * (bpp < 0 ? 240 : 320);
fa8d1331	104
	105	r = memregl[0x4058>>2];
	106	r = (r & 0xffff) \| (code << 16) \| 0x10;
	107	memregl[0x4058>>2] = r;
	108	}
	109
	110	static void gp2x_video_setpalette_(int *pal, int len)
	111	{
	112	/* pollux palette is 16bpp only.. */
	113	int i;
	114	for (i = 0; i < len; i++)
	115	{
	116	int c = pal[i];
	117	c = ((c >> 8) & 0xf800) \| ((c >> 5) & 0x07c0) \| ((c >> 3) & 0x001f);
	118	memregl[0x4070>>2] = (i << 24) \| c;
	119	}
	120	}
	121
	122	static void gp2x_video_RGB_setscaling_(int ln_offs, int W, int H)
	123	{
	124	/* maybe a job for 3d hardware? */
	125	}
	126
	127	static void gp2x_video_wait_vsync_(void)
	128	{
	129	while (!(memregl[0x308c>>2] & (1 << 10)));
	130	spend_cycles(128);
	131	memregl[0x308c>>2] \|= 1 << 10;
	132	}
	133
	134	/* CPU clock */
	135	static void gp2x_set_cpuclk_(unsigned int mhz)
	136	{
	137	char buff[24];
	138	snprintf(buff, sizeof(buff), "cpuclk=%u", mhz);
	139	pollux_set(memregs, buff);
71769e27	140
71769e27	141	cpuclk_was_changed = 1;
fa8d1331	142	}
	143
	144	/* misc */
	145	static void pollux_set_fromenv(const char *env_var)
	146	{
	147	const char *set_string;
	148	set_string = getenv(env_var);
	149	if (set_string)
	150	pollux_set(memregs, set_string);
	151	else
	152	printf("env var %s not defined.\n", env_var);
	153	}
	154
	155	/* RAM timings */
fa8d1331	156	static void set_ram_timings_(void)
	157	{
	158	pollux_set_fromenv("POLLUX_RAM_TIMINGS");
	159	}
	160
	161	static void unset_ram_timings_(void)
	162	{
	163	int i;
	164
71769e27	165	memregs[0x14802>>1] = memtimex_old[0];
71769e27	166	memregs[0x14804>>1] = memtimex_old[1] \| 0x8000;
fa8d1331	167
	168	for (i = 0; i < 0x100000; i++)
	169	if (!(memregs[0x14804>>1] & 0x8000))
	170	break;
	171
	172	printf("RAM timings reset to startup values.\n");
	173	}
	174
	175	/* LCD refresh */
	176	static void set_lcd_custom_rate_(int is_pal)
	177	{
	178	char buff[32];
	179
	180	snprintf(buff, sizeof(buff), "POLLUX_LCD_TIMINGS_%s", is_pal ? "PAL" : "NTSC");
	181	pollux_set_fromenv(buff);
b7911801	182	last_pal_setting = is_pal;
fa8d1331	183	}
	184
	185	static void unset_lcd_custom_rate_(void)
	186	{
	187	}
	188
	189	static void set_lcd_gamma_(int g100, int A_SNs_curve)
	190	{
	191	/* hm, the LCD possibly can do it (but not POLLUX) */
	192	}
d572cbad	193
053bef76	194	static int gp2x_read_battery_(void)
	195	{
	196	unsigned short magic_val = 0;
	197
	198	if (battdev < 0)
	199	return -1;
	200	if (read(battdev, &magic_val, sizeof(magic_val)) != sizeof(magic_val))
	201	return -1;
	202	switch (magic_val) {
	203	default:
	204	case 1: return 100;
	205	case 2: return 66;
	206	case 3: return 40;
	207	case 4: return 0;
	208	}
	209	}
	210
d572cbad	211	void pollux_init(void)
d572cbad	212	{
fa8d1331	213	struct fb_fix_screeninfo fbfix;
	214	int i, ret;
	215
	216	memdev = open("/dev/mem", O_RDWR);
	217	if (memdev == -1) {
	218	perror("open(/dev/mem) failed");
	219	exit(1);
	220	}
	221
	222	memregs = mmap(0, 0x20000, PROT_READ\|PROT_WRITE, MAP_SHARED, memdev, 0xc0000000);
	223	if (memregs == MAP_FAILED) {
	224	perror("mmap(memregs) failed");
	225	exit(1);
	226	}
	227	memregl = (volatile void *)memregs;
	228
	229	fbdev = open("/dev/fb0", O_RDWR);
	230	if (fbdev < 0) {
	231	perror("can't open fbdev");
	232	exit(1);
	233	}
	234
	235	ret = ioctl(fbdev, FBIOGET_FSCREENINFO, &fbfix);
	236	if (ret == -1) {
	237	perror("ioctl(fbdev) failed");
	238	exit(1);
	239	}
	240
	241	printf("framebuffer: \"%s\" @ %08lx\n", fbfix.id, fbfix.smem_start);
	242	fb_paddr[0] = fbfix.smem_start;
	243
	244	gp2x_screens[0] = mmap(0, 3202402*fb_buf_count, PROT_READ\|PROT_WRITE,
	245	MAP_SHARED, memdev, fb_paddr[0]);
	246	if (gp2x_screens[0] == MAP_FAILED)
	247	{
	248	perror("mmap(gp2x_screens) failed");
	249	exit(1);
	250	}
	251	memset(gp2x_screens[0], 0, 3202402*fb_buf_count);
	252
	253	printf(" %p -> %08x\n", gp2x_screens[0], fb_paddr[0]);
	254	for (i = 1; i < fb_buf_count; i++)
	255	{
	256	fb_paddr[i] = fb_paddr[i-1] + 3202402;
	257	gp2x_screens[i] = (char )gp2x_screens[i-1] + 320240*2;
	258	printf(" %p -> %08x\n", gp2x_screens[i], fb_paddr[i]);
	259	}
	260	fb_work_buf = 0;
	261	g_screen_ptr = gp2x_screens[0];
	262
053bef76	263	battdev = open("/dev/pollux_batt", O_RDONLY);
	264	if (battdev < 0)
	265	perror("Warning: could't open pollux_batt");
	266
	267	pllsetreg0 = memregl[0xf004>>2];
71769e27	268	memtimex_old[0] = memregs[0x14802>>1];
71769e27	269	memtimex_old[1] = memregs[0x14804>>1];
fa8d1331	270
	271	gp2x_video_flip = gp2x_video_flip_;
	272	gp2x_video_flip2 = gp2x_video_flip2_;
	273	gp2x_video_changemode_ll = gp2x_video_changemode_ll_;
	274	gp2x_video_setpalette = gp2x_video_setpalette_;
	275	gp2x_video_RGB_setscaling = gp2x_video_RGB_setscaling_;
	276	gp2x_video_wait_vsync = gp2x_video_wait_vsync_;
	277
	278	gp2x_set_cpuclk = gp2x_set_cpuclk_;
	279
	280	set_lcd_custom_rate = set_lcd_custom_rate_;
	281	unset_lcd_custom_rate = unset_lcd_custom_rate_;
	282	set_lcd_gamma = set_lcd_gamma_;
	283
	284	set_ram_timings = set_ram_timings_;
	285	unset_ram_timings = unset_ram_timings_;
053bef76	286	gp2x_read_battery = gp2x_read_battery_;
d572cbad	287	}
	288
	289	void pollux_finish(void)
	290	{
fa8d1331	291	/* switch to default fb mem, turn portrait off */
	292	memregl[0x406C>>2] = fb_paddr[0];
	293	memregl[0x4058>>2] \|= 0x10;
fa8d1331	294	close(fbdev);
fa8d1331	295
71769e27	296	gp2x_video_changemode_ll_(16);
	297	unset_ram_timings_();
	298	if (cpuclk_was_changed) {
	299	memregl[0xf004>>2] = pllsetreg0;
	300	memregl[0xf07c>>2] \|= 0x8000;
	301	}
	302
fa8d1331	303	munmap((void *)memregs, 0x20000);
fa8d1331	304	close(memdev);
053bef76	305	if (battdev >= 0)
053bef76	306	close(battdev);
d572cbad	307	}
d572cbad	308