*/
+#define _BSD_SOURCE
+#define _GNU_SOURCE
#include <sys/mman.h>
#include <sys/ioctl.h>
#include <sys/soundcard.h>
+#include <sys/types.h>
+#include <unistd.h>
#include "../common.h"
#include "gp2x.h"
+#include "warm.h"
-extern int main_cpuspeed(int argc, char *argv[]);
-extern SDL_Surface* screen;
-
-u32 gp2x_audio_volume = 74;
+u32 gp2x_audio_volume = 74/2;
u32 gpsp_gp2x_dev_audio = 0;
u32 gpsp_gp2x_dev = 0;
+u32 gpsp_gp2x_gpiodev = 0;
-volatile u16 *gpsp_gp2x_memregs;
-volatile u32 *gpsp_gp2x_memregl;
+static volatile u16 *gpsp_gp2x_memregs;
+static volatile u32 *gpsp_gp2x_memregl;
-static volatile u16 *MEM_REG;
+#ifdef WIZ_BUILD
+#include <linux/fb.h>
+void *gpsp_gp2x_screen;
+#define fb_buf_count 4
+static u32 fb_paddr[fb_buf_count];
+static void *fb_vaddr[fb_buf_count];
+static u32 fb_work_buf;
+static int fb_buf_use;
-s32 gp2x_load_mmuhack()
+static void fb_video_init()
{
- s32 mmufd = open("/dev/mmuhack", O_RDWR);
+ struct fb_fix_screeninfo fbfix;
+ int i, ret;
+ int fbdev;
+
+ 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;
+ close(fbdev);
+
+ fb_vaddr[0] = mmap(0, 320*240*2*fb_buf_count, PROT_READ|PROT_WRITE,
+ MAP_SHARED, gpsp_gp2x_dev, fb_paddr[0]);
+ if (fb_vaddr[0] == MAP_FAILED)
+ {
+ perror("mmap(fb_vaddr) failed");
+ exit(1);
+ }
+ memset(fb_vaddr[0], 0, 320*240*2*fb_buf_count);
- if(mmufd < 0)
+ printf(" %p -> %08x\n", fb_vaddr[0], fb_paddr[0]);
+ for (i = 1; i < fb_buf_count; i++)
{
- system("/sbin/insmod mmuhack.o");
- mmufd = open("/dev/mmuhack", O_RDWR);
+ fb_paddr[i] = fb_paddr[i-1] + 320*240*2;
+ fb_vaddr[i] = (char *)fb_vaddr[i-1] + 320*240*2;
+ printf(" %p -> %08x\n", fb_vaddr[i], fb_paddr[i]);
}
+ fb_work_buf = 0;
+ fb_buf_use = fb_buf_count;
+
+ pollux_video_flip();
+ warm_change_cb_upper(WCB_C_BIT|WCB_B_BIT, 1);
+}
- if(mmufd < 0)
- return -1;
+void pollux_video_flip()
+{
+ warm_cache_op_all(WOP_D_CLEAN);
+ gpsp_gp2x_memregl[0x406C>>2] = fb_paddr[fb_work_buf];
+ gpsp_gp2x_memregl[0x4058>>2] |= 0x10;
+ fb_work_buf++;
+ if (fb_work_buf >= fb_buf_use)
+ fb_work_buf = 0;
+ gpsp_gp2x_screen = fb_vaddr[fb_work_buf];
+}
- close(mmufd);
- return 0;
+void fb_use_buffers(int count)
+{
+ if (count < 1)
+ count = 1;
+ else if (count > fb_buf_count)
+ count = fb_buf_count;
+ fb_buf_use = count;
+ memset(fb_vaddr[0], 0, 320*240*2*count);
+}
+
+static void fb_video_exit()
+{
+ /* switch to default fb mem */
+ gpsp_gp2x_memregl[0x406C>>2] = fb_paddr[0];
+ gpsp_gp2x_memregl[0x4058>>2] |= 0x10;
}
+#endif
-void gp2x_overclock()
+void gp2x_init()
{
+ FILE *f;
gpsp_gp2x_dev = open("/dev/mem", O_RDWR);
gpsp_gp2x_dev_audio = open("/dev/mixer", O_RDWR);
gpsp_gp2x_memregl =
(unsigned long *)mmap(0, 0x10000, PROT_READ|PROT_WRITE, MAP_SHARED,
gpsp_gp2x_dev, 0xc0000000);
gpsp_gp2x_memregs = (unsigned short *)gpsp_gp2x_memregl;
+ warm_init();
+#ifdef WIZ_BUILD
+ gpsp_gp2x_gpiodev = open("/dev/GPIO", O_RDONLY);
+ fb_video_init();
+#endif
+
+ f = fopen("romdir.txt", "r");
+ if (f != NULL)
+ {
+ char buff[256];
+ char *s = fgets(buff, sizeof(buff) - 1, f);
+ if (s)
+ {
+ int r = strlen(s);
+ while (r > 0 && isspace(buff[r-1]))
+ buff[--r] = 0;
+ chdir(buff);
+ }
+ fclose(f);
+ }
- clear_screen(0);
- main_cpuspeed(0, NULL);
gp2x_sound_volume(1);
}
+#include <errno.h>
void gp2x_quit()
{
+ char buff[256];
+ FILE *f;
+
+ getcwd(buff, sizeof(buff));
+ chdir(main_path);
+ f = fopen("romdir.txt", "r+");
+ if (f != NULL)
+ {
+ fprintf(f, "%s", buff);
+ fclose(f);
+ truncate("romdir.txt", strlen(buff));
+ sync();
+ }
+
+ warm_finish();
+#ifdef WIZ_BUILD
+ close(gpsp_gp2x_gpiodev);
+ fb_video_exit();
+#endif
munmap((void *)gpsp_gp2x_memregl, 0x10000);
close(gpsp_gp2x_dev_audio);
close(gpsp_gp2x_dev);
- chdir("/usr/gp2x");
- execl("gp2xmenu", "gp2xmenu", NULL);
+
+ fcloseall();
+ //chdir("/usr/gp2x");
+ //execl("gp2xmenu", "gp2xmenu", NULL);
+ exit(0);
}
void gp2x_sound_volume(u32 volume_up)
ioctl(gpsp_gp2x_dev_audio, SOUND_MIXER_WRITE_PCM, &volume);
}
+u32 gpsp_gp2x_joystick_read(void)
+{
+#ifdef WIZ_BUILD
+ u32 value = 0;
+ read(gpsp_gp2x_gpiodev, &value, 4);
+ if(value & 0x02)
+ value |= 0x05;
+ if(value & 0x08)
+ value |= 0x14;
+ if(value & 0x20)
+ value |= 0x50;
+ if(value & 0x80)
+ value |= 0x41;
+ return value;
+#else
+ u32 value = (gpsp_gp2x_memregs[0x1198 >> 1] & 0x00FF);
+
+ if(value == 0xFD)
+ value = 0xFA;
+ if(value == 0xF7)
+ value = 0xEB;
+ if(value == 0xDF)
+ value = 0xAF;
+ if(value == 0x7F)
+ value = 0xBE;
+
+ return ~((gpsp_gp2x_memregs[0x1184 >> 1] & 0xFF00) | value |
+ (gpsp_gp2x_memregs[0x1186 >> 1] << 16));
+#endif
+}
+
+// Fout = (m * Fin) / (p * 2^s)
+void set_FCLK(u32 MHZ)
+{
+ u32 v;
+ u32 mdiv, pdiv, sdiv = 0;
+#ifdef WIZ_BUILD
+ #define SYS_CLK_FREQ 27
+ // m = MDIV, p = PDIV, s = SDIV
+ pdiv = 9;
+ mdiv = (MHZ * pdiv) / SYS_CLK_FREQ;
+ mdiv &= 0x3ff;
+ v = (pdiv<<18) | (mdiv<<8) | sdiv;
+
+ gpsp_gp2x_memregl[0xf004>>2] = v;
+ gpsp_gp2x_memregl[0xf07c>>2] |= 0x8000;
+#else
+ #define SYS_CLK_FREQ 7372800
+ // m = MDIV + 8, p = PDIV + 2, s = SDIV
+ pdiv = 3;
+ mdiv = (MHZ * pdiv * 1000000) / SYS_CLK_FREQ;
+ mdiv &= 0xff;
+ v = ((mdiv-8)<<8) | ((pdiv-2)<<2) | sdiv;
+ gpsp_gp2x_memregs[0x910>>1] = v;
+#endif
+}
+