X-Git-Url: https://notaz.gp2x.de/cgi-bin/gitweb.cgi?a=blobdiff_plain;f=gp2x%2Fgp2x.c;h=eeefcf68390efeb8255e600f968cdfbfeef2954a;hb=5cc8854bc94b22e52d747e67cc9b7ca310711181;hp=88f17313fe138ac0f6388e6b49c4063409649636;hpb=4742480dcabcbd9d23fd8cb9a655fc8c9c314513;p=gpsp.git

diff --git a/gp2x/gp2x.c b/gp2x/gp2x.c
index 88f1731..eeefcf6 100644
--- a/gp2x/gp2x.c
+++ b/gp2x/gp2x.c
@@ -19,16 +19,17 @@
 */
 
 
+#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/2;
 u32 gpsp_gp2x_dev_audio = 0;
 u32 gpsp_gp2x_dev = 0;
@@ -36,56 +37,151 @@ u32 gpsp_gp2x_gpiodev = 0;
 
 static volatile u16 *gpsp_gp2x_memregs;
 static volatile u32 *gpsp_gp2x_memregl;
-unsigned short *gp2x_memregs;
 
-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;
 
-  if(mmufd < 0)
-    return -1;
+  pollux_video_flip();
+  warm_change_cb_upper(WCB_C_BIT|WCB_B_BIT, 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_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
-  warm_init();
 
-  clear_screen(0);
-//  main_cpuspeed(0, NULL);
-  gp2x_memregs = (void *)gpsp_gp2x_memregs;
-  cpuctrl_init();
+  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);
+  }
+
   gp2x_sound_volume(1);
 }
 
+#include <errno.h>
 void gp2x_quit()
 {
-  munmap((void *)gpsp_gp2x_memregl, 0x10000);
-  close(gpsp_gp2x_dev_audio);
-  close(gpsp_gp2x_dev);
+  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);
 
+  fcloseall();
   //chdir("/usr/gp2x");
   //execl("gp2xmenu", "gp2xmenu", NULL);
   exit(0);
@@ -136,13 +232,29 @@ u32 gpsp_gp2x_joystick_read(void)
 #endif
 }
 
-#ifdef WIZ_BUILD
-void cpuctrl_init(void)
-{
-}
-
+// 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
+}