rcnt: remove gate guess for cnt 0 and 1
[pcsx_rearmed.git] / libpcsxcore / psxmem.c
CommitLineData
ef79bbde
P
1/***************************************************************************
2 * Copyright (C) 2007 Ryan Schultz, PCSX-df Team, PCSX team *
3 * *
4 * This program is free software; you can redistribute it and/or modify *
5 * it under the terms of the GNU General Public License as published by *
6 * the Free Software Foundation; either version 2 of the License, or *
7 * (at your option) any later version. *
8 * *
9 * This program is distributed in the hope that it will be useful, *
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
12 * GNU General Public License for more details. *
13 * *
14 * You should have received a copy of the GNU General Public License *
15 * along with this program; if not, write to the *
16 * Free Software Foundation, Inc., *
17 * 51 Franklin Street, Fifth Floor, Boston, MA 02111-1307 USA. *
18 ***************************************************************************/
19
20/*
21* PSX memory functions.
22*/
23
24// TODO: Implement caches & cycle penalty.
25
26#include "psxmem.h"
27#include "r3000a.h"
28#include "psxhw.h"
fc8145b7 29#include "debug.h"
ef79bbde
P
30#include <sys/mman.h>
31
32#ifndef MAP_ANONYMOUS
33#define MAP_ANONYMOUS MAP_ANON
34#endif
35
36s8 *psxM = NULL; // Kernel & User Memory (2 Meg)
37s8 *psxP = NULL; // Parallel Port (64K)
38s8 *psxR = NULL; // BIOS ROM (512K)
39s8 *psxH = NULL; // Scratch Pad (1K) & Hardware Registers (8K)
40
41u8 **psxMemWLUT = NULL;
42u8 **psxMemRLUT = NULL;
43
44/* Playstation Memory Map (from Playstation doc by Joshua Walker)
450x0000_0000-0x0000_ffff Kernel (64K)
460x0001_0000-0x001f_ffff User Memory (1.9 Meg)
47
480x1f00_0000-0x1f00_ffff Parallel Port (64K)
49
500x1f80_0000-0x1f80_03ff Scratch Pad (1024 bytes)
51
520x1f80_1000-0x1f80_2fff Hardware Registers (8K)
53
540x1fc0_0000-0x1fc7_ffff BIOS (512K)
55
560x8000_0000-0x801f_ffff Kernel and User Memory Mirror (2 Meg) Cached
570x9fc0_0000-0x9fc7_ffff BIOS Mirror (512K) Cached
58
590xa000_0000-0xa01f_ffff Kernel and User Memory Mirror (2 Meg) Uncached
600xbfc0_0000-0xbfc7_ffff BIOS Mirror (512K) Uncached
61*/
62
63int psxMemInit() {
64 int i;
65
66 psxMemRLUT = (u8 **)malloc(0x10000 * sizeof(void *));
67 psxMemWLUT = (u8 **)malloc(0x10000 * sizeof(void *));
68 memset(psxMemRLUT, 0, 0x10000 * sizeof(void *));
69 memset(psxMemWLUT, 0, 0x10000 * sizeof(void *));
70
ffb0b9e0 71 psxM = mmap((void *)0x80000000, 0x00210000,
6e1a0c4d 72 PROT_WRITE | PROT_READ, MAP_PRIVATE | MAP_ANONYMOUS | MAP_FIXED, -1, 0);
ef79bbde
P
73
74 psxP = &psxM[0x200000];
ffb0b9e0 75 psxH = mmap((void *)0x1f800000, 0x00010000,
6e1a0c4d 76 PROT_WRITE | PROT_READ, MAP_PRIVATE | MAP_ANONYMOUS | MAP_FIXED, -1, 0);
ef79bbde 77
6e1a0c4d 78 psxR = mmap((void *)0x1fc00000, 0x80000,
a06c1d6e 79 PROT_WRITE | PROT_READ, MAP_PRIVATE | MAP_ANONYMOUS, -1, 0);
ef79bbde
P
80
81 if (psxMemRLUT == NULL || psxMemWLUT == NULL ||
6e1a0c4d 82 psxM != (void *)0x80000000 || psxR == MAP_FAILED ||
ffb0b9e0 83 psxP == NULL || psxH != (void *)0x1f800000) {
ef79bbde
P
84 SysMessage(_("Error allocating memory!"));
85 return -1;
86 }
87
88// MemR
89 for (i = 0; i < 0x80; i++) psxMemRLUT[i + 0x0000] = (u8 *)&psxM[(i & 0x1f) << 16];
90
91 memcpy(psxMemRLUT + 0x8000, psxMemRLUT, 0x80 * sizeof(void *));
92 memcpy(psxMemRLUT + 0xa000, psxMemRLUT, 0x80 * sizeof(void *));
93
94 psxMemRLUT[0x1f00] = (u8 *)psxP;
95 psxMemRLUT[0x1f80] = (u8 *)psxH;
96
97 for (i = 0; i < 0x08; i++) psxMemRLUT[i + 0x1fc0] = (u8 *)&psxR[i << 16];
98
99 memcpy(psxMemRLUT + 0x9fc0, psxMemRLUT + 0x1fc0, 0x08 * sizeof(void *));
100 memcpy(psxMemRLUT + 0xbfc0, psxMemRLUT + 0x1fc0, 0x08 * sizeof(void *));
101
102// MemW
103 for (i = 0; i < 0x80; i++) psxMemWLUT[i + 0x0000] = (u8 *)&psxM[(i & 0x1f) << 16];
104
105 memcpy(psxMemWLUT + 0x8000, psxMemWLUT, 0x80 * sizeof(void *));
106 memcpy(psxMemWLUT + 0xa000, psxMemWLUT, 0x80 * sizeof(void *));
107
108 psxMemWLUT[0x1f00] = (u8 *)psxP;
109 psxMemWLUT[0x1f80] = (u8 *)psxH;
110
111 return 0;
112}
113
114void psxMemReset() {
115 FILE *f = NULL;
116 char bios[1024];
117
118 memset(psxM, 0, 0x00200000);
119 memset(psxP, 0, 0x00010000);
120
121 if (strcmp(Config.Bios, "HLE") != 0) {
122 sprintf(bios, "%s/%s", Config.BiosDir, Config.Bios);
123 f = fopen(bios, "rb");
124
125 if (f == NULL) {
126 SysMessage(_("Could not open BIOS:\"%s\". Enabling HLE Bios!\n"), bios);
127 memset(psxR, 0, 0x80000);
128 Config.HLE = TRUE;
129 } else {
130 fread(psxR, 1, 0x80000, f);
131 fclose(f);
132 Config.HLE = FALSE;
133 }
134 } else Config.HLE = TRUE;
135}
136
137void psxMemShutdown() {
6e1a0c4d 138 munmap(psxM, 0x00210000);
139 munmap(psxH, 0x1f800000);
a06c1d6e 140 munmap(psxR, 0x80000);
ef79bbde 141
ef79bbde
P
142 free(psxMemRLUT);
143 free(psxMemWLUT);
144}
145
146static int writeok = 1;
147
148u8 psxMemRead8(u32 mem) {
149 char *p;
150 u32 t;
151
152 t = mem >> 16;
153 if (t == 0x1f80) {
154 if (mem < 0x1f801000)
155 return psxHu8(mem);
156 else
157 return psxHwRead8(mem);
158 } else {
159 p = (char *)(psxMemRLUT[t]);
160 if (p != NULL) {
161 if (Config.Debug)
162 DebugCheckBP((mem & 0xffffff) | 0x80000000, R1);
163 return *(u8 *)(p + (mem & 0xffff));
164 } else {
165#ifdef PSXMEM_LOG
166 PSXMEM_LOG("err lb %8.8lx\n", mem);
167#endif
168 return 0;
169 }
170 }
171}
172
173u16 psxMemRead16(u32 mem) {
174 char *p;
175 u32 t;
176
177 t = mem >> 16;
178 if (t == 0x1f80) {
179 if (mem < 0x1f801000)
180 return psxHu16(mem);
181 else
182 return psxHwRead16(mem);
183 } else {
184 p = (char *)(psxMemRLUT[t]);
185 if (p != NULL) {
186 if (Config.Debug)
187 DebugCheckBP((mem & 0xffffff) | 0x80000000, R2);
188 return SWAPu16(*(u16 *)(p + (mem & 0xffff)));
189 } else {
190#ifdef PSXMEM_LOG
191 PSXMEM_LOG("err lh %8.8lx\n", mem);
192#endif
193 return 0;
194 }
195 }
196}
197
198u32 psxMemRead32(u32 mem) {
199 char *p;
200 u32 t;
201
202 t = mem >> 16;
203 if (t == 0x1f80) {
204 if (mem < 0x1f801000)
205 return psxHu32(mem);
206 else
207 return psxHwRead32(mem);
208 } else {
209 p = (char *)(psxMemRLUT[t]);
210 if (p != NULL) {
211 if (Config.Debug)
212 DebugCheckBP((mem & 0xffffff) | 0x80000000, R4);
213 return SWAPu32(*(u32 *)(p + (mem & 0xffff)));
214 } else {
215#ifdef PSXMEM_LOG
216 if (writeok) { PSXMEM_LOG("err lw %8.8lx\n", mem); }
217#endif
218 return 0;
219 }
220 }
221}
222
223void psxMemWrite8(u32 mem, u8 value) {
224 char *p;
225 u32 t;
226
227 t = mem >> 16;
228 if (t == 0x1f80) {
229 if (mem < 0x1f801000)
230 psxHu8(mem) = value;
231 else
232 psxHwWrite8(mem, value);
233 } else {
234 p = (char *)(psxMemWLUT[t]);
235 if (p != NULL) {
236 if (Config.Debug)
237 DebugCheckBP((mem & 0xffffff) | 0x80000000, W1);
238 *(u8 *)(p + (mem & 0xffff)) = value;
239#ifdef PSXREC
240 psxCpu->Clear((mem & (~3)), 1);
241#endif
242 } else {
243#ifdef PSXMEM_LOG
244 PSXMEM_LOG("err sb %8.8lx\n", mem);
245#endif
246 }
247 }
248}
249
250void psxMemWrite16(u32 mem, u16 value) {
251 char *p;
252 u32 t;
253
254 t = mem >> 16;
255 if (t == 0x1f80) {
256 if (mem < 0x1f801000)
257 psxHu16ref(mem) = SWAPu16(value);
258 else
259 psxHwWrite16(mem, value);
260 } else {
261 p = (char *)(psxMemWLUT[t]);
262 if (p != NULL) {
263 if (Config.Debug)
264 DebugCheckBP((mem & 0xffffff) | 0x80000000, W2);
265 *(u16 *)(p + (mem & 0xffff)) = SWAPu16(value);
266#ifdef PSXREC
3e31e934 267 psxCpu->Clear((mem & (~3)), 1);
ef79bbde
P
268#endif
269 } else {
270#ifdef PSXMEM_LOG
271 PSXMEM_LOG("err sh %8.8lx\n", mem);
272#endif
273 }
274 }
275}
276
277void psxMemWrite32(u32 mem, u32 value) {
278 char *p;
279 u32 t;
280
281// if ((mem&0x1fffff) == 0x71E18 || value == 0x48088800) SysPrintf("t2fix!!\n");
282 t = mem >> 16;
283 if (t == 0x1f80) {
284 if (mem < 0x1f801000)
285 psxHu32ref(mem) = SWAPu32(value);
286 else
287 psxHwWrite32(mem, value);
288 } else {
289 p = (char *)(psxMemWLUT[t]);
290 if (p != NULL) {
291 if (Config.Debug)
292 DebugCheckBP((mem & 0xffffff) | 0x80000000, W4);
293 *(u32 *)(p + (mem & 0xffff)) = SWAPu32(value);
294#ifdef PSXREC
295 psxCpu->Clear(mem, 1);
296#endif
297 } else {
298 if (mem != 0xfffe0130) {
299#ifdef PSXREC
300 if (!writeok)
301 psxCpu->Clear(mem, 1);
302#endif
303
304#ifdef PSXMEM_LOG
305 if (writeok) { PSXMEM_LOG("err sw %8.8lx\n", mem); }
306#endif
307 } else {
308 int i;
309
310 switch (value) {
311 case 0x800: case 0x804:
312 if (writeok == 0) break;
313 writeok = 0;
314 memset(psxMemWLUT + 0x0000, 0, 0x80 * sizeof(void *));
315 memset(psxMemWLUT + 0x8000, 0, 0x80 * sizeof(void *));
316 memset(psxMemWLUT + 0xa000, 0, 0x80 * sizeof(void *));
317 break;
318 case 0x00: case 0x1e988:
319 if (writeok == 1) break;
320 writeok = 1;
321 for (i = 0; i < 0x80; i++) psxMemWLUT[i + 0x0000] = (void *)&psxM[(i & 0x1f) << 16];
322 memcpy(psxMemWLUT + 0x8000, psxMemWLUT, 0x80 * sizeof(void *));
323 memcpy(psxMemWLUT + 0xa000, psxMemWLUT, 0x80 * sizeof(void *));
324 break;
325 default:
326#ifdef PSXMEM_LOG
327 PSXMEM_LOG("unk %8.8lx = %x\n", mem, value);
328#endif
329 break;
330 }
331 }
332 }
333 }
334}
335
336void *psxMemPointer(u32 mem) {
337 char *p;
338 u32 t;
339
340 t = mem >> 16;
341 if (t == 0x1f80) {
342 if (mem < 0x1f801000)
343 return (void *)&psxH[mem];
344 else
345 return NULL;
346 } else {
347 p = (char *)(psxMemWLUT[t]);
348 if (p != NULL) {
349 return (void *)(p + (mem & 0xffff));
350 }
351 return NULL;
352 }
353}