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