gp2x/gp2x.c

   1 /*  Parts used from cpuctrl */
   2 /*  cpuctrl for GP2X
   3     Copyright (C) 2005  Hermes/PS2Reality
   4
   5     This program is free software; you can redistribute it and/or modify
   6     it under the terms of the GNU General Public License as published by
   7     the Free Software Foundation; either version 2 of the License, or
   8     (at your option) any later version.
   9
  10     This program is distributed in the hope that it will be useful,
  11     but WITHOUT ANY WARRANTY; without even the implied warranty of
  12     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13     GNU General Public License for more details.
  14
  15     You should have received a copy of the GNU General Public License
  16     along with this program; if not, write to the Free Software
  17     Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
  18
  19 */
  20
  21
  22 #define _BSD_SOURCE
  23 #define _GNU_SOURCE
  24 #include <sys/mman.h>
  25 #include <sys/ioctl.h>
  26 #include <sys/soundcard.h>
  27 #include <sys/types.h>
  28 #include <unistd.h>
  29 #include "../common.h"
  30 #include "gp2x.h"
  31 #include "warm.h"
  32
  33 u32 gp2x_audio_volume = 74/2;
  34 u32 gpsp_gp2x_dev_audio = 0;
  35 u32 gpsp_gp2x_dev = 0;
  36 u32 gpsp_gp2x_gpiodev = 0;
  37
  38 static volatile u16 *gpsp_gp2x_memregs;
  39 static volatile u32 *gpsp_gp2x_memregl;
  40
  41 #ifdef WIZ_BUILD
  42 #include <linux/fb.h>
  43 void *gpsp_gp2x_screen;
  44 #define fb_buf_count 4
  45 static u32 fb_paddr[fb_buf_count];
  46 static void *fb_vaddr[fb_buf_count];
  47 static u32 fb_work_buf;
  48 static int fb_buf_use;
  49
  50 static void fb_video_init()
  51 {
  52   struct fb_fix_screeninfo fbfix;
  53   int i, ret;
  54   int fbdev;
  55
  56   fbdev = open("/dev/fb0", O_RDWR);
  57   if (fbdev < 0) {
  58     perror("can't open fbdev");
  59     exit(1);
  60   }
  61
  62   ret = ioctl(fbdev, FBIOGET_FSCREENINFO, &fbfix);
  63   if (ret == -1)
  64   {
  65     perror("ioctl(fbdev) failed");
  66     exit(1);
  67   }
  68
  69   printf("framebuffer: \"%s\" @ %08lx\n", fbfix.id, fbfix.smem_start);
  70   fb_paddr[0] = fbfix.smem_start;
  71   close(fbdev);
  72
  73   fb_vaddr[0] = mmap(0, 320*240*2*fb_buf_count, PROT_READ|PROT_WRITE,
  74     MAP_SHARED, gpsp_gp2x_dev, fb_paddr[0]);
  75   if (fb_vaddr[0] == MAP_FAILED)
  76   {
  77     perror("mmap(fb_vaddr) failed");
  78     exit(1);
  79   }
  80   memset(fb_vaddr[0], 0, 320*240*2*fb_buf_count);
  81
  82   printf("  %p -> %08x\n", fb_vaddr[0], fb_paddr[0]);
  83   for (i = 1; i < fb_buf_count; i++)
  84   {
  85     fb_paddr[i] = fb_paddr[i-1] + 320*240*2;
  86     fb_vaddr[i] = (char *)fb_vaddr[i-1] + 320*240*2;
  87     printf("  %p -> %08x\n", fb_vaddr[i], fb_paddr[i]);
  88   }
  89   fb_work_buf = 0;
  90   fb_buf_use = fb_buf_count;
  91
  92   pollux_video_flip();
  93   warm_change_cb_upper(WCB_C_BIT|WCB_B_BIT, 1);
  94 }
  95
  96 void pollux_video_flip()
  97 {
  98   warm_cache_op_all(WOP_D_CLEAN);
  99   gpsp_gp2x_memregl[0x406C>>2] = fb_paddr[fb_work_buf];
 100   gpsp_gp2x_memregl[0x4058>>2] |= 0x10;
 101   fb_work_buf++;
 102   if (fb_work_buf >= fb_buf_use)
 103     fb_work_buf = 0;
 104   gpsp_gp2x_screen = fb_vaddr[fb_work_buf];
 105 }
 106
 107 void fb_use_buffers(int count)
 108 {
 109   if (count < 1)
 110     count = 1;
 111   else if (count > fb_buf_count)
 112     count = fb_buf_count;
 113   fb_buf_use = count;
 114   memset(fb_vaddr[0], 0, 320*240*2*count);
 115 }
 116
 117 static void fb_video_exit()
 118 {
 119   /* switch to default fb mem */
 120   gpsp_gp2x_memregl[0x406C>>2] = fb_paddr[0];
 121   gpsp_gp2x_memregl[0x4058>>2] |= 0x10;
 122 }
 123 #endif
 124
 125 void gp2x_init()
 126 {
 127   FILE *f;
 128   gpsp_gp2x_dev = open("/dev/mem",   O_RDWR);
 129   gpsp_gp2x_dev_audio = open("/dev/mixer", O_RDWR);
 130   gpsp_gp2x_memregl =
 131    (unsigned long  *)mmap(0, 0x10000, PROT_READ|PROT_WRITE, MAP_SHARED,
 132    gpsp_gp2x_dev, 0xc0000000);
 133   gpsp_gp2x_memregs = (unsigned short *)gpsp_gp2x_memregl;
 134   warm_init();
 135 #ifdef WIZ_BUILD
 136   gpsp_gp2x_gpiodev = open("/dev/GPIO", O_RDONLY);
 137   fb_video_init();
 138 #endif
 139
 140   f = fopen("romdir.txt", "r");
 141   if (f != NULL)
 142   {
 143     char buff[256];
 144     char *s = fgets(buff, sizeof(buff) - 1, f);
 145     if (s)
 146     {
 147       int r = strlen(s);
 148       while (r > 0 && isspace(buff[r-1]))
 149         buff[--r] = 0;
 150       chdir(buff);
 151     }
 152     fclose(f);
 153   }
 154
 155   gp2x_sound_volume(1);
 156 }
 157
 158 #include <errno.h>
 159 void gp2x_quit()
 160 {
 161   char buff[256];
 162   FILE *f;
 163
 164   getcwd(buff, sizeof(buff));
 165   chdir(main_path);
 166   f = fopen("romdir.txt", "r+");
 167   if (f != NULL)
 168   {
 169     fprintf(f, "%s", buff);
 170     fclose(f);
 171     truncate("romdir.txt", strlen(buff));
 172     sync();
 173   }
 174
 175   warm_finish();
 176 #ifdef WIZ_BUILD
 177   close(gpsp_gp2x_gpiodev);
 178   fb_video_exit();
 179 #endif
 180   munmap((void *)gpsp_gp2x_memregl, 0x10000);
 181   close(gpsp_gp2x_dev_audio);
 182   close(gpsp_gp2x_dev);
 183
 184   fcloseall();
 185   //chdir("/usr/gp2x");
 186   //execl("gp2xmenu", "gp2xmenu", NULL);
 187   exit(0);
 188 }
 189
 190 void gp2x_sound_volume(u32 volume_up)
 191 {
 192   u32 volume;
 193   if((volume_up == 0) && (gp2x_audio_volume > 0))
 194     gp2x_audio_volume--;
 195
 196   if((volume_up != 0)  && (gp2x_audio_volume < 100))
 197     gp2x_audio_volume++;
 198
 199   volume = (gp2x_audio_volume * 0x50) / 100;
 200   volume = (gp2x_audio_volume << 8) | gp2x_audio_volume;
 201   ioctl(gpsp_gp2x_dev_audio, SOUND_MIXER_WRITE_PCM, &volume);
 202 }
 203
 204 u32 gpsp_gp2x_joystick_read(void)
 205 {
 206 #ifdef WIZ_BUILD
 207   u32 value = 0;
 208   read(gpsp_gp2x_gpiodev, &value, 4);
 209   if(value & 0x02)
 210    value |= 0x05;
 211   if(value & 0x08)
 212    value |= 0x14;
 213   if(value & 0x20)
 214    value |= 0x50;
 215   if(value & 0x80)
 216    value |= 0x41;
 217   return value;
 218 #else
 219   u32 value = (gpsp_gp2x_memregs[0x1198 >> 1] & 0x00FF);
 220
 221   if(value == 0xFD)
 222    value = 0xFA;
 223   if(value == 0xF7)
 224    value = 0xEB;
 225   if(value == 0xDF)
 226    value = 0xAF;
 227   if(value == 0x7F)
 228    value = 0xBE;
 229
 230   return ~((gpsp_gp2x_memregs[0x1184 >> 1] & 0xFF00) | value |
 231    (gpsp_gp2x_memregs[0x1186 >> 1] << 16));
 232 #endif
 233 }
 234
 235 // Fout = (m * Fin) / (p * 2^s)
 236 void set_FCLK(u32 MHZ)
 237 {
 238   u32 v;
 239   u32 mdiv, pdiv, sdiv = 0;
 240 #ifdef WIZ_BUILD
 241   #define SYS_CLK_FREQ 27
 242   // m = MDIV, p = PDIV, s = SDIV
 243   pdiv = 9;
 244   mdiv = (MHZ * pdiv) / SYS_CLK_FREQ;
 245   mdiv &= 0x3ff;
 246   v = (pdiv<<18) | (mdiv<<8) | sdiv;
 247
 248   gpsp_gp2x_memregl[0xf004>>2] = v;
 249   gpsp_gp2x_memregl[0xf07c>>2] |= 0x8000;
 250 #else
 251   #define SYS_CLK_FREQ 7372800
 252   // m = MDIV + 8, p = PDIV + 2, s = SDIV
 253   pdiv = 3;
 254   mdiv = (MHZ * pdiv * 1000000) / SYS_CLK_FREQ;
 255   mdiv &= 0xff;
 256   v = ((mdiv-8)<<8) | ((pdiv-2)<<2) | sdiv;
 257   gpsp_gp2x_memregs[0x910>>1] = v;
 258 #endif
 259 }
 260