54219ae051543622e5da6d0338840c0042eff60e
[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 static 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
53 static void psxUnmapDefault(void *ptr, size_t size, enum psxMapTag tag)
54 {
55         munmap(ptr, size);
56 }
57
58 void *(*psxMapHook)(unsigned long addr, size_t size, int is_fixed,
59                 enum psxMapTag tag) = psxMapDefault;
60 void (*psxUnmapHook)(void *ptr, size_t size,
61                      enum psxMapTag tag) = psxUnmapDefault;
62
63 void *psxMap(unsigned long addr, size_t size, int is_fixed,
64                 enum psxMapTag tag)
65 {
66         int try_ = 0;
67         unsigned long mask;
68         void *ret;
69
70 retry:
71         ret = psxMapHook(addr, size, 0, tag);
72         if (ret == NULL)
73                 return MAP_FAILED;
74
75         if (addr != 0 && ret != (void *)(uintptr_t)addr) {
76                 SysMessage("psxMap: warning: wanted to map @%08x, got %p\n",
77                         addr, ret);
78
79                 if (is_fixed) {
80                         psxUnmap(ret, size, tag);
81                         return MAP_FAILED;
82                 }
83
84                 if (((addr ^ (unsigned long)(uintptr_t)ret) & ~0xff000000l) && try_ < 2)
85                 {
86                         psxUnmap(ret, size, tag);
87
88                         // try to use similarly aligned memory instead
89                         // (recompiler needs this)
90                         mask = try_ ? 0xffff : 0xffffff;
91                         addr = ((uintptr_t)ret + mask) & ~mask;
92                         try_++;
93                         goto retry;
94                 }
95         }
96
97         return ret;
98 }
99
100 void psxUnmap(void *ptr, size_t size, enum psxMapTag tag)
101 {
102         psxUnmapHook(ptr, size, tag);
103 }
104
105 s8 *psxM = NULL; // Kernel & User Memory (2 Meg)
106 s8 *psxP = NULL; // Parallel Port (64K)
107 s8 *psxR = NULL; // BIOS ROM (512K)
108 s8 *psxH = NULL; // Scratch Pad (1K) & Hardware Registers (8K)
109
110 u8 **psxMemWLUT = NULL;
111 u8 **psxMemRLUT = NULL;
112
113 /*  Playstation Memory Map (from Playstation doc by Joshua Walker)
114 0x0000_0000-0x0000_ffff         Kernel (64K)
115 0x0001_0000-0x001f_ffff         User Memory (1.9 Meg)
116
117 0x1f00_0000-0x1f00_ffff         Parallel Port (64K)
118
119 0x1f80_0000-0x1f80_03ff         Scratch Pad (1024 bytes)
120
121 0x1f80_1000-0x1f80_2fff         Hardware Registers (8K)
122
123 0x1fc0_0000-0x1fc7_ffff         BIOS (512K)
124
125 0x8000_0000-0x801f_ffff         Kernel and User Memory Mirror (2 Meg) Cached
126 0x9fc0_0000-0x9fc7_ffff         BIOS Mirror (512K) Cached
127
128 0xa000_0000-0xa01f_ffff         Kernel and User Memory Mirror (2 Meg) Uncached
129 0xbfc0_0000-0xbfc7_ffff         BIOS Mirror (512K) Uncached
130 */
131
132 static int psxMemInitMap(void)
133 {
134         psxM = psxMap(0x80000000, 0x00210000, 1, MAP_TAG_RAM);
135         if (psxM == MAP_FAILED)
136                 psxM = psxMap(0x77000000, 0x00210000, 0, MAP_TAG_RAM);
137         if (psxM == MAP_FAILED) {
138                 SysMessage(_("mapping main RAM failed"));
139                 psxM = NULL;
140                 return -1;
141         }
142         psxP = &psxM[0x200000];
143
144         psxH = psxMap(0x1f800000, 0x10000, 0, MAP_TAG_OTHER);
145         if (psxH == MAP_FAILED) {
146                 SysMessage(_("Error allocating memory!"));
147                 psxMemShutdown();
148                 return -1;
149         }
150
151         psxR = psxMap(0x1fc00000, 0x80000, 0, MAP_TAG_OTHER);
152         if (psxR == MAP_FAILED) {
153                 SysMessage(_("Error allocating memory!"));
154                 psxMemShutdown();
155                 return -1;
156         }
157
158         return 0;
159 }
160
161 static 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
170 int 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) {
189                 SysMessage(_("Error allocating memory!"));
190                 psxMemShutdown();
191                 return -1;
192         }
193
194         memset(psxMemRLUT, (int)(uintptr_t)INVALID_PTR, 0x10000 * sizeof(void *));
195         memset(psxMemWLUT, (int)(uintptr_t)INVALID_PTR, 0x10000 * sizeof(void *));
196
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
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).
221         psxMemWLUT[0x1f00] = INVALID_PTR;
222         psxMemWLUT[0x1f80] = (u8 *)psxH;
223
224         return 0;
225 }
226
227 void psxMemReset() {
228         FILE *f = NULL;
229         char bios[1024];
230
231         memset(psxM, 0, 0x00200000);
232         memset(psxP, 0xff, 0x00010000);
233
234         Config.HLE = TRUE;
235
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);
243                 } else {
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                         }
249                         fclose(f);
250                 }
251         }
252 }
253
254 void psxMemShutdown() {
255         if (LIGHTREC_CUSTOM_MAP)
256                 lightrec_free_mmap();
257         else
258                 psxMemFreeMap();
259
260         free(psxMemRLUT); psxMemRLUT = NULL;
261         free(psxMemWLUT); psxMemWLUT = NULL;
262 }
263
264 void 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 }
280
281 u8 psxMemRead8(u32 mem) {
282         char *p;
283         u32 t;
284
285         t = mem >> 16;
286         if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
287                 if ((mem & 0xffff) < 0x400)
288                         return psxHu8(mem);
289                 else
290                         return psxHwRead8(mem);
291         } else {
292                 p = (char *)(psxMemRLUT[t]);
293                 if (p != INVALID_PTR) {
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
301                         return 0xFF;
302                 }
303         }
304 }
305
306 u16 psxMemRead16(u32 mem) {
307         char *p;
308         u32 t;
309
310         t = mem >> 16;
311         if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
312                 if ((mem & 0xffff) < 0x400)
313                         return psxHu16(mem);
314                 else
315                         return psxHwRead16(mem);
316         } else {
317                 p = (char *)(psxMemRLUT[t]);
318                 if (p != INVALID_PTR) {
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
326                         return 0xFFFF;
327                 }
328         }
329 }
330
331 u32 psxMemRead32(u32 mem) {
332         char *p;
333         u32 t;
334
335         t = mem >> 16;
336         if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
337                 if ((mem & 0xffff) < 0x400)
338                         return psxHu32(mem);
339                 else
340                         return psxHwRead32(mem);
341         } else {
342                 p = (char *)(psxMemRLUT[t]);
343                 if (p != INVALID_PTR) {
344                         if (Config.Debug)
345                                 DebugCheckBP((mem & 0xffffff) | 0x80000000, R4);
346                         return SWAPu32(*(u32 *)(p + (mem & 0xffff)));
347                 } else {
348                         if (mem == 0xfffe0130)
349                                 return psxRegs.biuReg;
350 #ifdef PSXMEM_LOG
351                         PSXMEM_LOG("err lw %8.8lx\n", mem);
352 #endif
353                         return 0xFFFFFFFF;
354                 }
355         }
356 }
357
358 void psxMemWrite8(u32 mem, u8 value) {
359         char *p;
360         u32 t;
361
362         t = mem >> 16;
363         if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
364                 if ((mem & 0xffff) < 0x400)
365                         psxHu8(mem) = value;
366                 else
367                         psxHwWrite8(mem, value);
368         } else {
369                 p = (char *)(psxMemWLUT[t]);
370                 if (p != INVALID_PTR) {
371                         if (Config.Debug)
372                                 DebugCheckBP((mem & 0xffffff) | 0x80000000, W1);
373                         *(u8 *)(p + (mem & 0xffff)) = value;
374 #ifndef DRC_DISABLE
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
385 void psxMemWrite16(u32 mem, u16 value) {
386         char *p;
387         u32 t;
388
389         t = mem >> 16;
390         if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
391                 if ((mem & 0xffff) < 0x400)
392                         psxHu16ref(mem) = SWAPu16(value);
393                 else
394                         psxHwWrite16(mem, value);
395         } else {
396                 p = (char *)(psxMemWLUT[t]);
397                 if (p != INVALID_PTR) {
398                         if (Config.Debug)
399                                 DebugCheckBP((mem & 0xffffff) | 0x80000000, W2);
400                         *(u16 *)(p + (mem & 0xffff)) = SWAPu16(value);
401 #ifndef DRC_DISABLE
402                         psxCpu->Clear((mem & (~3)), 1);
403 #endif
404                 } else {
405 #ifdef PSXMEM_LOG
406                         PSXMEM_LOG("err sh %8.8lx\n", mem);
407 #endif
408                 }
409         }
410 }
411
412 void 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;
418         if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
419                 if ((mem & 0xffff) < 0x400)
420                         psxHu32ref(mem) = SWAPu32(value);
421                 else
422                         psxHwWrite32(mem, value);
423         } else {
424                 p = (char *)(psxMemWLUT[t]);
425                 if (p != INVALID_PTR) {
426                         if (Config.Debug)
427                                 DebugCheckBP((mem & 0xffffff) | 0x80000000, W4);
428                         *(u32 *)(p + (mem & 0xffff)) = SWAPu32(value);
429 #ifndef DRC_DISABLE
430                         psxCpu->Clear(mem, 1);
431 #endif
432                 } else {
433                         if (mem == 0xfffe0130) {
434                                 psxRegs.biuReg = value;
435                                 return;
436                         }
437 #ifdef PSXMEM_LOG
438                         PSXMEM_LOG("err sw %8.8lx\n", mem);
439 #endif
440                 }
441         }
442 }
443
444 void *psxMemPointer(u32 mem) {
445         char *p;
446         u32 t;
447
448         t = mem >> 16;
449         if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
450                 if ((mem & 0xffff) < 0x400)
451                         return (void *)&psxH[mem];
452                 else
453                         return NULL;
454         } else {
455                 p = (char *)(psxMemWLUT[t]);
456                 if (p != INVALID_PTR) {
457                         return (void *)(p + (mem & 0xffff));
458                 }
459                 return NULL;
460         }
461 }