1 /* Parts used from cpuctrl */
3 Copyright (C) 2005 Hermes/PS2Reality
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.
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.
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
23 #include <sys/ioctl.h>
24 #include <sys/soundcard.h>
25 #include "../common.h"
29 extern int main_cpuspeed(int argc, char *argv[]);
30 extern SDL_Surface* screen;
32 u32 gp2x_audio_volume = 74/2;
33 u32 gpsp_gp2x_dev_audio = 0;
34 u32 gpsp_gp2x_dev = 0;
35 u32 gpsp_gp2x_gpiodev = 0;
37 static volatile u16 *gpsp_gp2x_memregs;
38 static volatile u32 *gpsp_gp2x_memregl;
39 unsigned short *gp2x_memregs;
41 s32 gp2x_load_mmuhack()
43 s32 mmufd = open("/dev/mmuhack", O_RDWR);
47 system("/sbin/insmod mmuhack.o");
48 mmufd = open("/dev/mmuhack", O_RDWR);
60 void *gpsp_gp2x_screen;
61 static u32 fb_paddr[3];
62 static void *fb_vaddr[3];
63 static u32 fb_work_buf;
64 const int fb_buf_count = 3;
65 static int fb_buf_use = 3;
67 static void fb_video_init()
69 struct fb_fix_screeninfo fbfix;
73 fbdev = open("/dev/fb0", O_RDWR);
75 perror("can't open fbdev");
79 ret = ioctl(fbdev, FBIOGET_FSCREENINFO, &fbfix);
82 perror("ioctl(fbdev) failed");
86 printf("framebuffer: \"%s\" @ %08lx\n", fbfix.id, fbfix.smem_start);
87 fb_paddr[0] = fbfix.smem_start;
90 fb_vaddr[0] = mmap(0, 320*240*2*fb_buf_count, PROT_READ|PROT_WRITE,
91 MAP_SHARED, gpsp_gp2x_dev, fb_paddr[0]);
92 if (fb_vaddr[0] == MAP_FAILED)
94 perror("mmap(fb_vaddr) failed");
97 memset(fb_vaddr[0], 0, 320*240*2*fb_buf_count);
99 printf(" %p -> %08x\n", fb_vaddr[0], fb_paddr[0]);
100 for (i = 1; i < fb_buf_count; i++)
102 fb_paddr[i] = fb_paddr[i-1] + 320*240*2;
103 fb_vaddr[i] = (char *)fb_vaddr[i-1] + 320*240*2;
104 printf(" %p -> %08x\n", fb_vaddr[i], fb_paddr[i]);
107 fb_buf_use = fb_buf_count;
110 warm_change_cb_upper(WCB_C_BIT|WCB_B_BIT, 1);
113 void pollux_video_flip()
115 warm_cache_op_all(WOP_D_CLEAN);
116 gpsp_gp2x_memregl[0x406C>>2] = fb_paddr[fb_work_buf];
117 gpsp_gp2x_memregl[0x4058>>2] |= 0x10;
119 if (fb_work_buf >= fb_buf_use)
121 gpsp_gp2x_screen = fb_vaddr[fb_work_buf];
124 void fb_use_buffers(int count)
128 else if (count > fb_buf_count)
129 count = fb_buf_count;
133 static void fb_video_exit()
135 /* switch to default fb mem */
136 gpsp_gp2x_memregl[0x406C>>2] = fb_paddr[0];
137 gpsp_gp2x_memregl[0x4058>>2] |= 0x10;
143 gpsp_gp2x_dev = open("/dev/mem", O_RDWR);
144 gpsp_gp2x_dev_audio = open("/dev/mixer", O_RDWR);
146 (unsigned long *)mmap(0, 0x10000, PROT_READ|PROT_WRITE, MAP_SHARED,
147 gpsp_gp2x_dev, 0xc0000000);
148 gpsp_gp2x_memregs = (unsigned short *)gpsp_gp2x_memregl;
150 gpsp_gp2x_gpiodev = open("/dev/GPIO", O_RDONLY);
156 // main_cpuspeed(0, NULL);
157 gp2x_memregs = (void *)gpsp_gp2x_memregs;
159 gp2x_sound_volume(1);
165 close(gpsp_gp2x_gpiodev);
168 munmap((void *)gpsp_gp2x_memregl, 0x10000);
169 close(gpsp_gp2x_dev_audio);
170 close(gpsp_gp2x_dev);
172 //chdir("/usr/gp2x");
173 //execl("gp2xmenu", "gp2xmenu", NULL);
177 void gp2x_sound_volume(u32 volume_up)
180 if((volume_up == 0) && (gp2x_audio_volume > 0))
183 if((volume_up != 0) && (gp2x_audio_volume < 100))
186 volume = (gp2x_audio_volume * 0x50) / 100;
187 volume = (gp2x_audio_volume << 8) | gp2x_audio_volume;
188 ioctl(gpsp_gp2x_dev_audio, SOUND_MIXER_WRITE_PCM, &volume);
191 u32 gpsp_gp2x_joystick_read(void)
195 read(gpsp_gp2x_gpiodev, &value, 4);
206 u32 value = (gpsp_gp2x_memregs[0x1198 >> 1] & 0x00FF);
217 return ~((gpsp_gp2x_memregs[0x1184 >> 1] & 0xFF00) | value |
218 (gpsp_gp2x_memregs[0x1186 >> 1] << 16));
223 void cpuctrl_init(void)
227 void set_FCLK(u32 MHZ)