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