f0a884191b3529ff6b72780e7db3c7ca7ee06b13
[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 "r3000a.h"
28 #include "psxhw.h"
29 #include "debug.h"
30 #include <sys/mman.h>
31
32 #ifndef MAP_ANONYMOUS
33 #define MAP_ANONYMOUS MAP_ANON
34 #endif
35
36 s8 *psxM = NULL; // Kernel & User Memory (2 Meg)
37 s8 *psxP = NULL; // Parallel Port (64K)
38 s8 *psxR = NULL; // BIOS ROM (512K)
39 s8 *psxH = NULL; // Scratch Pad (1K) & Hardware Registers (8K)
40
41 u8 **psxMemWLUT = NULL;
42 u8 **psxMemRLUT = NULL;
43
44 /*  Playstation Memory Map (from Playstation doc by Joshua Walker)
45 0x0000_0000-0x0000_ffff         Kernel (64K)
46 0x0001_0000-0x001f_ffff         User Memory (1.9 Meg)
47
48 0x1f00_0000-0x1f00_ffff         Parallel Port (64K)
49
50 0x1f80_0000-0x1f80_03ff         Scratch Pad (1024 bytes)
51
52 0x1f80_1000-0x1f80_2fff         Hardware Registers (8K)
53
54 0x1fc0_0000-0x1fc7_ffff         BIOS (512K)
55
56 0x8000_0000-0x801f_ffff         Kernel and User Memory Mirror (2 Meg) Cached
57 0x9fc0_0000-0x9fc7_ffff         BIOS Mirror (512K) Cached
58
59 0xa000_0000-0xa01f_ffff         Kernel and User Memory Mirror (2 Meg) Uncached
60 0xbfc0_0000-0xbfc7_ffff         BIOS Mirror (512K) Uncached
61 */
62
63 int 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
71         psxM = mmap((void *)0x80000000, 0x00210000,
72                 PROT_WRITE | PROT_READ, MAP_PRIVATE | MAP_ANONYMOUS, -1, 0);
73
74         psxP = &psxM[0x200000];
75         psxH = mmap((void *)0x1f800000, 0x00010000,
76                 PROT_WRITE | PROT_READ, MAP_PRIVATE | MAP_ANONYMOUS, -1, 0);
77
78         psxR = mmap((void *)0x9fc00000, 0x80000,
79                 PROT_WRITE | PROT_READ, MAP_PRIVATE | MAP_ANONYMOUS, -1, 0);
80
81         if (psxMemRLUT == NULL || psxMemWLUT == NULL || 
82                 psxM != (void *)0x80000000 || psxR != (void *)0x9fc00000 ||
83                 psxP == NULL || psxH != (void *)0x1f800000) {
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
114 void 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
137 void psxMemShutdown() {
138         munmap(psxM, 0x00220000);
139         munmap(psxR, 0x80000);
140
141         free(psxMemRLUT);
142         free(psxMemWLUT);
143 }
144
145 static int writeok = 1;
146
147 u8 psxMemRead8(u32 mem) {
148         char *p;
149         u32 t;
150
151         t = mem >> 16;
152         if (t == 0x1f80) {
153                 if (mem < 0x1f801000)
154                         return psxHu8(mem);
155                 else
156                         return psxHwRead8(mem);
157         } else {
158                 p = (char *)(psxMemRLUT[t]);
159                 if (p != NULL) {
160                         if (Config.Debug)
161                                 DebugCheckBP((mem & 0xffffff) | 0x80000000, R1);
162                         return *(u8 *)(p + (mem & 0xffff));
163                 } else {
164 #ifdef PSXMEM_LOG
165                         PSXMEM_LOG("err lb %8.8lx\n", mem);
166 #endif
167                         return 0;
168                 }
169         }
170 }
171
172 u16 psxMemRead16(u32 mem) {
173         char *p;
174         u32 t;
175
176         t = mem >> 16;
177         if (t == 0x1f80) {
178                 if (mem < 0x1f801000)
179                         return psxHu16(mem);
180                 else
181                         return psxHwRead16(mem);
182         } else {
183                 p = (char *)(psxMemRLUT[t]);
184                 if (p != NULL) {
185                         if (Config.Debug)
186                                 DebugCheckBP((mem & 0xffffff) | 0x80000000, R2);
187                         return SWAPu16(*(u16 *)(p + (mem & 0xffff)));
188                 } else {
189 #ifdef PSXMEM_LOG
190                         PSXMEM_LOG("err lh %8.8lx\n", mem);
191 #endif
192                         return 0;
193                 }
194         }
195 }
196
197 u32 psxMemRead32(u32 mem) {
198         char *p;
199         u32 t;
200
201         t = mem >> 16;
202         if (t == 0x1f80) {
203                 if (mem < 0x1f801000)
204                         return psxHu32(mem);
205                 else
206                         return psxHwRead32(mem);
207         } else {
208                 p = (char *)(psxMemRLUT[t]);
209                 if (p != NULL) {
210                         if (Config.Debug)
211                                 DebugCheckBP((mem & 0xffffff) | 0x80000000, R4);
212                         return SWAPu32(*(u32 *)(p + (mem & 0xffff)));
213                 } else {
214 #ifdef PSXMEM_LOG
215                         if (writeok) { PSXMEM_LOG("err lw %8.8lx\n", mem); }
216 #endif
217                         return 0;
218                 }
219         }
220 }
221
222 void psxMemWrite8(u32 mem, u8 value) {
223         char *p;
224         u32 t;
225
226         t = mem >> 16;
227         if (t == 0x1f80) {
228                 if (mem < 0x1f801000)
229                         psxHu8(mem) = value;
230                 else
231                         psxHwWrite8(mem, value);
232         } else {
233                 p = (char *)(psxMemWLUT[t]);
234                 if (p != NULL) {
235                         if (Config.Debug)
236                                 DebugCheckBP((mem & 0xffffff) | 0x80000000, W1);
237                         *(u8 *)(p + (mem & 0xffff)) = value;
238 #ifdef PSXREC
239                         psxCpu->Clear((mem & (~3)), 1);
240 #endif
241                 } else {
242 #ifdef PSXMEM_LOG
243                         PSXMEM_LOG("err sb %8.8lx\n", mem);
244 #endif
245                 }
246         }
247 }
248
249 void psxMemWrite16(u32 mem, u16 value) {
250         char *p;
251         u32 t;
252
253         t = mem >> 16;
254         if (t == 0x1f80) {
255                 if (mem < 0x1f801000)
256                         psxHu16ref(mem) = SWAPu16(value);
257                 else
258                         psxHwWrite16(mem, value);
259         } else {
260                 p = (char *)(psxMemWLUT[t]);
261                 if (p != NULL) {
262                         if (Config.Debug)
263                                 DebugCheckBP((mem & 0xffffff) | 0x80000000, W2);
264                         *(u16 *)(p + (mem & 0xffff)) = SWAPu16(value);
265 #ifdef PSXREC
266                         psxCpu->Clear((mem & (~3)), 1);
267 #endif
268                 } else {
269 #ifdef PSXMEM_LOG
270                         PSXMEM_LOG("err sh %8.8lx\n", mem);
271 #endif
272                 }
273         }
274 }
275
276 void psxMemWrite32(u32 mem, u32 value) {
277         char *p;
278         u32 t;
279
280 //      if ((mem&0x1fffff) == 0x71E18 || value == 0x48088800) SysPrintf("t2fix!!\n");
281         t = mem >> 16;
282         if (t == 0x1f80) {
283                 if (mem < 0x1f801000)
284                         psxHu32ref(mem) = SWAPu32(value);
285                 else
286                         psxHwWrite32(mem, value);
287         } else {
288                 p = (char *)(psxMemWLUT[t]);
289                 if (p != NULL) {
290                         if (Config.Debug)
291                                 DebugCheckBP((mem & 0xffffff) | 0x80000000, W4);
292                         *(u32 *)(p + (mem & 0xffff)) = SWAPu32(value);
293 #ifdef PSXREC
294                         psxCpu->Clear(mem, 1);
295 #endif
296                 } else {
297                         if (mem != 0xfffe0130) {
298 #ifdef PSXREC
299                                 if (!writeok)
300                                         psxCpu->Clear(mem, 1);
301 #endif
302
303 #ifdef PSXMEM_LOG
304                                 if (writeok) { PSXMEM_LOG("err sw %8.8lx\n", mem); }
305 #endif
306                         } else {
307                                 int i;
308
309                                 switch (value) {
310                                         case 0x800: case 0x804:
311                                                 if (writeok == 0) break;
312                                                 writeok = 0;
313                                                 memset(psxMemWLUT + 0x0000, 0, 0x80 * sizeof(void *));
314                                                 memset(psxMemWLUT + 0x8000, 0, 0x80 * sizeof(void *));
315                                                 memset(psxMemWLUT + 0xa000, 0, 0x80 * sizeof(void *));
316                                                 break;
317                                         case 0x00: case 0x1e988:
318                                                 if (writeok == 1) break;
319                                                 writeok = 1;
320                                                 for (i = 0; i < 0x80; i++) psxMemWLUT[i + 0x0000] = (void *)&psxM[(i & 0x1f) << 16];
321                                                 memcpy(psxMemWLUT + 0x8000, psxMemWLUT, 0x80 * sizeof(void *));
322                                                 memcpy(psxMemWLUT + 0xa000, psxMemWLUT, 0x80 * sizeof(void *));
323                                                 break;
324                                         default:
325 #ifdef PSXMEM_LOG
326                                                 PSXMEM_LOG("unk %8.8lx = %x\n", mem, value);
327 #endif
328                                                 break;
329                                 }
330                         }
331                 }
332         }
333 }
334
335 void *psxMemPointer(u32 mem) {
336         char *p;
337         u32 t;
338
339         t = mem >> 16;
340         if (t == 0x1f80) {
341                 if (mem < 0x1f801000)
342                         return (void *)&psxH[mem];
343                 else
344                         return NULL;
345         } else {
346                 p = (char *)(psxMemWLUT[t]);
347                 if (p != NULL) {
348                         return (void *)(p + (mem & 0xffff));
349                 }
350                 return NULL;
351         }
352 }