psxinterpreter: adjust COP decoding
[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"
87e5b45f 27#include "psxmem_map.h"
ef79bbde
P
28#include "r3000a.h"
29#include "psxhw.h"
7d7672a5 30//#include "debug.h"
31#define DebugCheckBP(...)
ce0e7ac9 32
7a8d521f 33#include "lightrec/mem.h"
ce0e7ac9 34#include "memmap.h"
ef79bbde 35
7a8d521f 36#ifdef USE_LIBRETRO_VFS
37#include <streams/file_stream_transforms.h>
38#endif
39
ef79bbde
P
40#ifndef MAP_ANONYMOUS
41#define MAP_ANONYMOUS MAP_ANON
42#endif
43
826ba56b
PC
44static void * psxMapDefault(unsigned long addr, size_t size,
45 int is_fixed, enum psxMapTag tag)
46{
47 int flags = MAP_PRIVATE | MAP_ANONYMOUS;
48
49 return mmap((void *)(uintptr_t)addr, size,
50 PROT_READ | PROT_WRITE, flags, -1, 0);
51}
52
53static void psxUnmapDefault(void *ptr, size_t size, enum psxMapTag tag)
54{
55 munmap(ptr, size);
56}
57
87e5b45f 58void *(*psxMapHook)(unsigned long addr, size_t size, int is_fixed,
826ba56b
PC
59 enum psxMapTag tag) = psxMapDefault;
60void (*psxUnmapHook)(void *ptr, size_t size,
61 enum psxMapTag tag) = psxUnmapDefault;
87e5b45f 62
63void *psxMap(unsigned long addr, size_t size, int is_fixed,
64 enum psxMapTag tag)
65{
5644b26c 66 int try_ = 0;
b0dd9956 67 unsigned long mask;
826ba56b 68 void *ret;
87e5b45f 69
b0dd9956 70retry:
826ba56b
PC
71 ret = psxMapHook(addr, size, 0, tag);
72 if (ret == NULL)
73 return MAP_FAILED;
87e5b45f 74
77e1e479 75 if (addr != 0 && ret != (void *)(uintptr_t)addr) {
b0dd9956 76 SysMessage("psxMap: warning: wanted to map @%08x, got %p\n",
77 addr, ret);
78
0069615f 79 if (is_fixed) {
80 psxUnmap(ret, size, tag);
7a8d521f 81 return MAP_FAILED;
0069615f 82 }
83
77e1e479 84 if (((addr ^ (unsigned long)(uintptr_t)ret) & ~0xff000000l) && try_ < 2)
b0dd9956 85 {
86 psxUnmap(ret, size, tag);
87
88 // try to use similarly aligned memory instead
89 // (recompiler needs this)
5644b26c 90 mask = try_ ? 0xffff : 0xffffff;
77e1e479 91 addr = ((uintptr_t)ret + mask) & ~mask;
5644b26c 92 try_++;
b0dd9956 93 goto retry;
94 }
95 }
87e5b45f 96
97 return ret;
98}
99
100void psxUnmap(void *ptr, size_t size, enum psxMapTag tag)
101{
826ba56b 102 psxUnmapHook(ptr, size, tag);
87e5b45f 103}
104
ef79bbde
P
105s8 *psxM = NULL; // Kernel & User Memory (2 Meg)
106s8 *psxP = NULL; // Parallel Port (64K)
107s8 *psxR = NULL; // BIOS ROM (512K)
108s8 *psxH = NULL; // Scratch Pad (1K) & Hardware Registers (8K)
109
110u8 **psxMemWLUT = NULL;
111u8 **psxMemRLUT = NULL;
112
113/* Playstation Memory Map (from Playstation doc by Joshua Walker)
1140x0000_0000-0x0000_ffff Kernel (64K)
1150x0001_0000-0x001f_ffff User Memory (1.9 Meg)
116
1170x1f00_0000-0x1f00_ffff Parallel Port (64K)
118
1190x1f80_0000-0x1f80_03ff Scratch Pad (1024 bytes)
120
1210x1f80_1000-0x1f80_2fff Hardware Registers (8K)
122
1230x1fc0_0000-0x1fc7_ffff BIOS (512K)
124
1250x8000_0000-0x801f_ffff Kernel and User Memory Mirror (2 Meg) Cached
1260x9fc0_0000-0x9fc7_ffff BIOS Mirror (512K) Cached
127
1280xa000_0000-0xa01f_ffff Kernel and User Memory Mirror (2 Meg) Uncached
1290xbfc0_0000-0xbfc7_ffff BIOS Mirror (512K) Uncached
130*/
131
7a8d521f 132static int psxMemInitMap(void)
133{
87e5b45f 134 psxM = psxMap(0x80000000, 0x00210000, 1, MAP_TAG_RAM);
7a8d521f 135 if (psxM == MAP_FAILED)
f23d3386 136 psxM = psxMap(0x77000000, 0x00210000, 0, MAP_TAG_RAM);
7a8d521f 137 if (psxM == MAP_FAILED) {
a327ad27 138 SysMessage(_("mapping main RAM failed"));
7a8d521f 139 psxM = NULL;
a327ad27 140 return -1;
141 }
ef79bbde 142 psxP = &psxM[0x200000];
7a8d521f 143
6d760c92 144 psxH = psxMap(0x1f800000, 0x10000, 0, MAP_TAG_OTHER);
7a8d521f 145 if (psxH == MAP_FAILED) {
146 SysMessage(_("Error allocating memory!"));
147 psxMemShutdown();
148 return -1;
149 }
150
87e5b45f 151 psxR = psxMap(0x1fc00000, 0x80000, 0, MAP_TAG_OTHER);
7a8d521f 152 if (psxR == MAP_FAILED) {
153 SysMessage(_("Error allocating memory!"));
154 psxMemShutdown();
155 return -1;
156 }
ef79bbde 157
7a8d521f 158 return 0;
159}
160
161static void psxMemFreeMap(void)
162{
163 if (psxM) psxUnmap(psxM, 0x00210000, MAP_TAG_RAM);
164 if (psxH) psxUnmap(psxH, 0x10000, MAP_TAG_OTHER);
165 if (psxR) psxUnmap(psxR, 0x80000, MAP_TAG_OTHER);
166 psxM = psxH = psxR = NULL;
167 psxP = NULL;
168}
169
170int psxMemInit(void)
171{
172 unsigned int i;
173 int ret;
174
175 if (LIGHTREC_CUSTOM_MAP)
176 ret = lightrec_init_mmap();
177 else
178 ret = psxMemInitMap();
179 if (ret) {
180 SysMessage(_("Error allocating memory!"));
181 psxMemShutdown();
182 return -1;
183 }
184
185 psxMemRLUT = (u8 **)malloc(0x10000 * sizeof(void *));
186 psxMemWLUT = (u8 **)malloc(0x10000 * sizeof(void *));
187
188 if (psxMemRLUT == NULL || psxMemWLUT == NULL) {
ef79bbde 189 SysMessage(_("Error allocating memory!"));
88901dd2 190 psxMemShutdown();
ef79bbde
P
191 return -1;
192 }
193
679d5ee3 194 memset(psxMemRLUT, (int)(uintptr_t)INVALID_PTR, 0x10000 * sizeof(void *));
195 memset(psxMemWLUT, (int)(uintptr_t)INVALID_PTR, 0x10000 * sizeof(void *));
7a8d521f 196
ef79bbde
P
197// MemR
198 for (i = 0; i < 0x80; i++) psxMemRLUT[i + 0x0000] = (u8 *)&psxM[(i & 0x1f) << 16];
199
200 memcpy(psxMemRLUT + 0x8000, psxMemRLUT, 0x80 * sizeof(void *));
201 memcpy(psxMemRLUT + 0xa000, psxMemRLUT, 0x80 * sizeof(void *));
202
203 psxMemRLUT[0x1f00] = (u8 *)psxP;
204 psxMemRLUT[0x1f80] = (u8 *)psxH;
205
206 for (i = 0; i < 0x08; i++) psxMemRLUT[i + 0x1fc0] = (u8 *)&psxR[i << 16];
207
208 memcpy(psxMemRLUT + 0x9fc0, psxMemRLUT + 0x1fc0, 0x08 * sizeof(void *));
209 memcpy(psxMemRLUT + 0xbfc0, psxMemRLUT + 0x1fc0, 0x08 * sizeof(void *));
210
211// MemW
212 for (i = 0; i < 0x80; i++) psxMemWLUT[i + 0x0000] = (u8 *)&psxM[(i & 0x1f) << 16];
213
214 memcpy(psxMemWLUT + 0x8000, psxMemWLUT, 0x80 * sizeof(void *));
215 memcpy(psxMemWLUT + 0xa000, psxMemWLUT, 0x80 * sizeof(void *));
216
fa18abb2 217 // Don't allow writes to PIO Expansion region (psxP) to take effect.
218 // NOTE: Not sure if this is needed to fix any games but seems wise,
219 // seeing as some games do read from PIO as part of copy-protection
220 // check. (See fix in psxMemReset() regarding psxP region reads).
7a8d521f 221 psxMemWLUT[0x1f00] = INVALID_PTR;
ef79bbde
P
222 psxMemWLUT[0x1f80] = (u8 *)psxH;
223
224 return 0;
225}
226
227void psxMemReset() {
228 FILE *f = NULL;
229 char bios[1024];
230
231 memset(psxM, 0, 0x00200000);
23643ee7 232 memset(psxP, 0xff, 0x00010000);
ef79bbde 233
7a8d521f 234 Config.HLE = TRUE;
235
ef79bbde
P
236 if (strcmp(Config.Bios, "HLE") != 0) {
237 sprintf(bios, "%s/%s", Config.BiosDir, Config.Bios);
238 f = fopen(bios, "rb");
239
240 if (f == NULL) {
241 SysMessage(_("Could not open BIOS:\"%s\". Enabling HLE Bios!\n"), bios);
242 memset(psxR, 0, 0x80000);
ef79bbde 243 } else {
7a8d521f 244 if (fread(psxR, 1, 0x80000, f) == 0x80000) {
245 Config.HLE = FALSE;
246 } else {
247 SysMessage(_("The selected BIOS:\"%s\" is of wrong size. Enabling HLE Bios!\n"), bios);
248 }
ef79bbde 249 fclose(f);
ef79bbde 250 }
7a8d521f 251 }
ef79bbde
P
252}
253
254void psxMemShutdown() {
7a8d521f 255 if (LIGHTREC_CUSTOM_MAP)
256 lightrec_free_mmap();
257 else
258 psxMemFreeMap();
ef79bbde 259
88901dd2 260 free(psxMemRLUT); psxMemRLUT = NULL;
261 free(psxMemWLUT); psxMemWLUT = NULL;
ef79bbde
P
262}
263
679d5ee3 264void psxMemOnIsolate(int enable)
265{
266 if (enable) {
267 memset(psxMemWLUT + 0x0000, (int)(uintptr_t)INVALID_PTR, 0x80 * sizeof(void *));
268 memset(psxMemWLUT + 0x8000, (int)(uintptr_t)INVALID_PTR, 0x80 * sizeof(void *));
269 //memset(psxMemWLUT + 0xa000, (int)(uintptr_t)INVALID_PTR, 0x80 * sizeof(void *));
270 } else {
271 int i;
272 for (i = 0; i < 0x80; i++)
273 psxMemWLUT[i + 0x0000] = (void *)&psxM[(i & 0x1f) << 16];
274 memcpy(psxMemWLUT + 0x8000, psxMemWLUT, 0x80 * sizeof(void *));
275 memcpy(psxMemWLUT + 0xa000, psxMemWLUT, 0x80 * sizeof(void *));
276 }
277 psxCpu->Notify(enable ? R3000ACPU_NOTIFY_CACHE_ISOLATED
278 : R3000ACPU_NOTIFY_CACHE_UNISOLATED, NULL);
279}
ef79bbde
P
280
281u8 psxMemRead8(u32 mem) {
282 char *p;
283 u32 t;
284
285 t = mem >> 16;
9dd7d179 286 if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
287 if ((mem & 0xffff) < 0x400)
ef79bbde
P
288 return psxHu8(mem);
289 else
290 return psxHwRead8(mem);
291 } else {
292 p = (char *)(psxMemRLUT[t]);
7a8d521f 293 if (p != INVALID_PTR) {
ef79bbde
P
294 if (Config.Debug)
295 DebugCheckBP((mem & 0xffffff) | 0x80000000, R1);
296 return *(u8 *)(p + (mem & 0xffff));
297 } else {
298#ifdef PSXMEM_LOG
299 PSXMEM_LOG("err lb %8.8lx\n", mem);
300#endif
943a507a 301 return 0xFF;
ef79bbde
P
302 }
303 }
304}
305
306u16 psxMemRead16(u32 mem) {
307 char *p;
308 u32 t;
309
310 t = mem >> 16;
9dd7d179 311 if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
312 if ((mem & 0xffff) < 0x400)
ef79bbde
P
313 return psxHu16(mem);
314 else
315 return psxHwRead16(mem);
316 } else {
317 p = (char *)(psxMemRLUT[t]);
7a8d521f 318 if (p != INVALID_PTR) {
ef79bbde
P
319 if (Config.Debug)
320 DebugCheckBP((mem & 0xffffff) | 0x80000000, R2);
321 return SWAPu16(*(u16 *)(p + (mem & 0xffff)));
322 } else {
323#ifdef PSXMEM_LOG
324 PSXMEM_LOG("err lh %8.8lx\n", mem);
325#endif
943a507a 326 return 0xFFFF;
ef79bbde
P
327 }
328 }
329}
330
331u32 psxMemRead32(u32 mem) {
332 char *p;
333 u32 t;
334
335 t = mem >> 16;
9dd7d179 336 if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
337 if ((mem & 0xffff) < 0x400)
ef79bbde
P
338 return psxHu32(mem);
339 else
340 return psxHwRead32(mem);
341 } else {
342 p = (char *)(psxMemRLUT[t]);
7a8d521f 343 if (p != INVALID_PTR) {
ef79bbde
P
344 if (Config.Debug)
345 DebugCheckBP((mem & 0xffffff) | 0x80000000, R4);
346 return SWAPu32(*(u32 *)(p + (mem & 0xffff)));
347 } else {
679d5ee3 348 if (mem == 0xfffe0130)
349 return psxRegs.biuReg;
ef79bbde 350#ifdef PSXMEM_LOG
679d5ee3 351 PSXMEM_LOG("err lw %8.8lx\n", mem);
ef79bbde 352#endif
943a507a 353 return 0xFFFFFFFF;
ef79bbde
P
354 }
355 }
356}
357
358void psxMemWrite8(u32 mem, u8 value) {
359 char *p;
360 u32 t;
361
362 t = mem >> 16;
9dd7d179 363 if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
364 if ((mem & 0xffff) < 0x400)
ef79bbde
P
365 psxHu8(mem) = value;
366 else
367 psxHwWrite8(mem, value);
368 } else {
369 p = (char *)(psxMemWLUT[t]);
7a8d521f 370 if (p != INVALID_PTR) {
ef79bbde
P
371 if (Config.Debug)
372 DebugCheckBP((mem & 0xffffff) | 0x80000000, W1);
373 *(u8 *)(p + (mem & 0xffff)) = value;
41e82ad4 374#ifndef DRC_DISABLE
ef79bbde
P
375 psxCpu->Clear((mem & (~3)), 1);
376#endif
377 } else {
378#ifdef PSXMEM_LOG
379 PSXMEM_LOG("err sb %8.8lx\n", mem);
380#endif
381 }
382 }
383}
384
385void psxMemWrite16(u32 mem, u16 value) {
386 char *p;
387 u32 t;
388
389 t = mem >> 16;
9dd7d179 390 if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
391 if ((mem & 0xffff) < 0x400)
ef79bbde
P
392 psxHu16ref(mem) = SWAPu16(value);
393 else
394 psxHwWrite16(mem, value);
395 } else {
396 p = (char *)(psxMemWLUT[t]);
7a8d521f 397 if (p != INVALID_PTR) {
ef79bbde
P
398 if (Config.Debug)
399 DebugCheckBP((mem & 0xffffff) | 0x80000000, W2);
400 *(u16 *)(p + (mem & 0xffff)) = SWAPu16(value);
41e82ad4 401#ifndef DRC_DISABLE
3e31e934 402 psxCpu->Clear((mem & (~3)), 1);
ef79bbde
P
403#endif
404 } else {
405#ifdef PSXMEM_LOG
406 PSXMEM_LOG("err sh %8.8lx\n", mem);
407#endif
408 }
409 }
410}
411
412void psxMemWrite32(u32 mem, u32 value) {
413 char *p;
414 u32 t;
415
416// if ((mem&0x1fffff) == 0x71E18 || value == 0x48088800) SysPrintf("t2fix!!\n");
417 t = mem >> 16;
9dd7d179 418 if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
419 if ((mem & 0xffff) < 0x400)
ef79bbde
P
420 psxHu32ref(mem) = SWAPu32(value);
421 else
422 psxHwWrite32(mem, value);
423 } else {
424 p = (char *)(psxMemWLUT[t]);
7a8d521f 425 if (p != INVALID_PTR) {
ef79bbde
P
426 if (Config.Debug)
427 DebugCheckBP((mem & 0xffffff) | 0x80000000, W4);
428 *(u32 *)(p + (mem & 0xffff)) = SWAPu32(value);
41e82ad4 429#ifndef DRC_DISABLE
ef79bbde
P
430 psxCpu->Clear(mem, 1);
431#endif
432 } else {
679d5ee3 433 if (mem == 0xfffe0130) {
434 psxRegs.biuReg = value;
435 return;
436 }
ef79bbde 437#ifdef PSXMEM_LOG
679d5ee3 438 PSXMEM_LOG("err sw %8.8lx\n", mem);
ef79bbde 439#endif
ef79bbde
P
440 }
441 }
442}
443
444void *psxMemPointer(u32 mem) {
445 char *p;
446 u32 t;
447
448 t = mem >> 16;
9dd7d179 449 if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
450 if ((mem & 0xffff) < 0x400)
ef79bbde
P
451 return (void *)&psxH[mem];
452 else
453 return NULL;
454 } else {
455 p = (char *)(psxMemWLUT[t]);
7a8d521f 456 if (p != INVALID_PTR) {
ef79bbde
P
457 return (void *)(p + (mem & 0xffff));
458 }
459 return NULL;
460 }
461}