misc: merge from pcsxr r86908
[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"
fc8145b7 30#include "debug.h"
ce0e7ac9 31
32#include "memmap.h"
ef79bbde
P
33
34#ifndef MAP_ANONYMOUS
35#define MAP_ANONYMOUS MAP_ANON
36#endif
37
87e5b45f 38void *(*psxMapHook)(unsigned long addr, size_t size, int is_fixed,
39 enum psxMapTag tag);
40void (*psxUnmapHook)(void *ptr, size_t size, enum psxMapTag tag);
41
42void *psxMap(unsigned long addr, size_t size, int is_fixed,
43 enum psxMapTag tag)
44{
45 int flags = MAP_PRIVATE | MAP_ANONYMOUS;
b0dd9956 46 int tried_to_align = 0;
47 unsigned long mask;
87e5b45f 48 void *req, *ret;
49
b0dd9956 50retry:
51 if (psxMapHook != NULL) {
52 ret = psxMapHook(addr, size, is_fixed, tag);
53 goto out;
54 }
87e5b45f 55
0069615f 56 /* avoid MAP_FIXED, it overrides existing mappings.. */
57 /* if (is_fixed)
58 flags |= MAP_FIXED; */
87e5b45f 59
60 req = (void *)addr;
61 ret = mmap(req, size, PROT_READ | PROT_WRITE, flags, -1, 0);
62 if (ret == MAP_FAILED)
63 return NULL;
64
b0dd9956 65out:
66 if (addr != 0 && ret != (void *)addr) {
67 SysMessage("psxMap: warning: wanted to map @%08x, got %p\n",
68 addr, ret);
69
0069615f 70 if (is_fixed) {
71 psxUnmap(ret, size, tag);
72 return NULL;
73 }
74
b0dd9956 75 if (ret != NULL && ((addr ^ (long)ret) & 0x00ffffff)
76 && !tried_to_align)
77 {
78 psxUnmap(ret, size, tag);
79
80 // try to use similarly aligned memory instead
81 // (recompiler needs this)
82 mask = (addr - 1) & ~addr & 0x07ffffff;
83 addr = (unsigned long)(ret + mask) & ~mask;
84 tried_to_align = 1;
85 goto retry;
86 }
87 }
87e5b45f 88
89 return ret;
90}
91
92void psxUnmap(void *ptr, size_t size, enum psxMapTag tag)
93{
94 if (psxUnmapHook != NULL) {
95 psxUnmapHook(ptr, size, tag);
96 return;
97 }
98
88901dd2 99 if (ptr)
100 munmap(ptr, size);
87e5b45f 101}
102
ef79bbde
P
103s8 *psxM = NULL; // Kernel & User Memory (2 Meg)
104s8 *psxP = NULL; // Parallel Port (64K)
105s8 *psxR = NULL; // BIOS ROM (512K)
106s8 *psxH = NULL; // Scratch Pad (1K) & Hardware Registers (8K)
107
108u8 **psxMemWLUT = NULL;
109u8 **psxMemRLUT = NULL;
110
111/* Playstation Memory Map (from Playstation doc by Joshua Walker)
1120x0000_0000-0x0000_ffff Kernel (64K)
1130x0001_0000-0x001f_ffff User Memory (1.9 Meg)
114
1150x1f00_0000-0x1f00_ffff Parallel Port (64K)
116
1170x1f80_0000-0x1f80_03ff Scratch Pad (1024 bytes)
118
1190x1f80_1000-0x1f80_2fff Hardware Registers (8K)
120
1210x1fc0_0000-0x1fc7_ffff BIOS (512K)
122
1230x8000_0000-0x801f_ffff Kernel and User Memory Mirror (2 Meg) Cached
1240x9fc0_0000-0x9fc7_ffff BIOS Mirror (512K) Cached
125
1260xa000_0000-0xa01f_ffff Kernel and User Memory Mirror (2 Meg) Uncached
1270xbfc0_0000-0xbfc7_ffff BIOS Mirror (512K) Uncached
128*/
129
130int psxMemInit() {
131 int i;
132
133 psxMemRLUT = (u8 **)malloc(0x10000 * sizeof(void *));
134 psxMemWLUT = (u8 **)malloc(0x10000 * sizeof(void *));
135 memset(psxMemRLUT, 0, 0x10000 * sizeof(void *));
136 memset(psxMemWLUT, 0, 0x10000 * sizeof(void *));
137
87e5b45f 138 psxM = psxMap(0x80000000, 0x00210000, 1, MAP_TAG_RAM);
a327ad27 139#ifndef RAM_FIXED
a4874585
C
140#ifdef __BLACKBERRY_QNX__
141 if (psxM == NULL)
f23d3386 142 psxM = psxMap(0x77000000, 0x00210000, 0, MAP_TAG_RAM);
a4874585 143#else
87e5b45f 144 if (psxM == NULL)
b0dd9956 145 psxM = psxMap(0x78000000, 0x00210000, 0, MAP_TAG_RAM);
a4874585 146#endif
a327ad27 147#endif
87e5b45f 148 if (psxM == NULL) {
a327ad27 149 SysMessage(_("mapping main RAM failed"));
150 return -1;
151 }
ef79bbde
P
152
153 psxP = &psxM[0x200000];
6d760c92 154 psxH = psxMap(0x1f800000, 0x10000, 0, MAP_TAG_OTHER);
87e5b45f 155 psxR = psxMap(0x1fc00000, 0x80000, 0, MAP_TAG_OTHER);
ef79bbde
P
156
157 if (psxMemRLUT == NULL || psxMemWLUT == NULL ||
6d760c92 158 psxR == NULL || psxP == NULL || psxH == NULL) {
ef79bbde 159 SysMessage(_("Error allocating memory!"));
88901dd2 160 psxMemShutdown();
ef79bbde
P
161 return -1;
162 }
163
164// MemR
165 for (i = 0; i < 0x80; i++) psxMemRLUT[i + 0x0000] = (u8 *)&psxM[(i & 0x1f) << 16];
166
167 memcpy(psxMemRLUT + 0x8000, psxMemRLUT, 0x80 * sizeof(void *));
168 memcpy(psxMemRLUT + 0xa000, psxMemRLUT, 0x80 * sizeof(void *));
169
170 psxMemRLUT[0x1f00] = (u8 *)psxP;
171 psxMemRLUT[0x1f80] = (u8 *)psxH;
172
173 for (i = 0; i < 0x08; i++) psxMemRLUT[i + 0x1fc0] = (u8 *)&psxR[i << 16];
174
175 memcpy(psxMemRLUT + 0x9fc0, psxMemRLUT + 0x1fc0, 0x08 * sizeof(void *));
176 memcpy(psxMemRLUT + 0xbfc0, psxMemRLUT + 0x1fc0, 0x08 * sizeof(void *));
177
178// MemW
179 for (i = 0; i < 0x80; i++) psxMemWLUT[i + 0x0000] = (u8 *)&psxM[(i & 0x1f) << 16];
180
181 memcpy(psxMemWLUT + 0x8000, psxMemWLUT, 0x80 * sizeof(void *));
182 memcpy(psxMemWLUT + 0xa000, psxMemWLUT, 0x80 * sizeof(void *));
183
184 psxMemWLUT[0x1f00] = (u8 *)psxP;
185 psxMemWLUT[0x1f80] = (u8 *)psxH;
186
187 return 0;
188}
189
190void psxMemReset() {
191 FILE *f = NULL;
192 char bios[1024];
193
194 memset(psxM, 0, 0x00200000);
195 memset(psxP, 0, 0x00010000);
196
197 if (strcmp(Config.Bios, "HLE") != 0) {
198 sprintf(bios, "%s/%s", Config.BiosDir, Config.Bios);
199 f = fopen(bios, "rb");
200
201 if (f == NULL) {
202 SysMessage(_("Could not open BIOS:\"%s\". Enabling HLE Bios!\n"), bios);
203 memset(psxR, 0, 0x80000);
204 Config.HLE = TRUE;
205 } else {
206 fread(psxR, 1, 0x80000, f);
207 fclose(f);
208 Config.HLE = FALSE;
209 }
210 } else Config.HLE = TRUE;
211}
212
213void psxMemShutdown() {
88901dd2 214 psxUnmap(psxM, 0x00210000, MAP_TAG_RAM); psxM = NULL;
215 psxUnmap(psxH, 0x10000, MAP_TAG_OTHER); psxH = NULL;
216 psxUnmap(psxR, 0x80000, MAP_TAG_OTHER); psxR = NULL;
ef79bbde 217
88901dd2 218 free(psxMemRLUT); psxMemRLUT = NULL;
219 free(psxMemWLUT); psxMemWLUT = NULL;
ef79bbde
P
220}
221
222static int writeok = 1;
223
224u8 psxMemRead8(u32 mem) {
225 char *p;
226 u32 t;
227
228 t = mem >> 16;
9dd7d179 229 if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
230 if ((mem & 0xffff) < 0x400)
ef79bbde
P
231 return psxHu8(mem);
232 else
233 return psxHwRead8(mem);
234 } else {
235 p = (char *)(psxMemRLUT[t]);
236 if (p != NULL) {
237 if (Config.Debug)
238 DebugCheckBP((mem & 0xffffff) | 0x80000000, R1);
239 return *(u8 *)(p + (mem & 0xffff));
240 } else {
241#ifdef PSXMEM_LOG
242 PSXMEM_LOG("err lb %8.8lx\n", mem);
243#endif
244 return 0;
245 }
246 }
247}
248
249u16 psxMemRead16(u32 mem) {
250 char *p;
251 u32 t;
252
253 t = mem >> 16;
9dd7d179 254 if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
255 if ((mem & 0xffff) < 0x400)
ef79bbde
P
256 return psxHu16(mem);
257 else
258 return psxHwRead16(mem);
259 } else {
260 p = (char *)(psxMemRLUT[t]);
261 if (p != NULL) {
262 if (Config.Debug)
263 DebugCheckBP((mem & 0xffffff) | 0x80000000, R2);
264 return SWAPu16(*(u16 *)(p + (mem & 0xffff)));
265 } else {
266#ifdef PSXMEM_LOG
267 PSXMEM_LOG("err lh %8.8lx\n", mem);
268#endif
269 return 0;
270 }
271 }
272}
273
274u32 psxMemRead32(u32 mem) {
275 char *p;
276 u32 t;
277
278 t = mem >> 16;
9dd7d179 279 if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
280 if ((mem & 0xffff) < 0x400)
ef79bbde
P
281 return psxHu32(mem);
282 else
283 return psxHwRead32(mem);
284 } else {
285 p = (char *)(psxMemRLUT[t]);
286 if (p != NULL) {
287 if (Config.Debug)
288 DebugCheckBP((mem & 0xffffff) | 0x80000000, R4);
289 return SWAPu32(*(u32 *)(p + (mem & 0xffff)));
290 } else {
291#ifdef PSXMEM_LOG
292 if (writeok) { PSXMEM_LOG("err lw %8.8lx\n", mem); }
293#endif
294 return 0;
295 }
296 }
297}
298
299void psxMemWrite8(u32 mem, u8 value) {
300 char *p;
301 u32 t;
302
303 t = mem >> 16;
9dd7d179 304 if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
305 if ((mem & 0xffff) < 0x400)
ef79bbde
P
306 psxHu8(mem) = value;
307 else
308 psxHwWrite8(mem, value);
309 } else {
310 p = (char *)(psxMemWLUT[t]);
311 if (p != NULL) {
312 if (Config.Debug)
313 DebugCheckBP((mem & 0xffffff) | 0x80000000, W1);
314 *(u8 *)(p + (mem & 0xffff)) = value;
315#ifdef PSXREC
316 psxCpu->Clear((mem & (~3)), 1);
317#endif
318 } else {
319#ifdef PSXMEM_LOG
320 PSXMEM_LOG("err sb %8.8lx\n", mem);
321#endif
322 }
323 }
324}
325
326void psxMemWrite16(u32 mem, u16 value) {
327 char *p;
328 u32 t;
329
330 t = mem >> 16;
9dd7d179 331 if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
332 if ((mem & 0xffff) < 0x400)
ef79bbde
P
333 psxHu16ref(mem) = SWAPu16(value);
334 else
335 psxHwWrite16(mem, value);
336 } else {
337 p = (char *)(psxMemWLUT[t]);
338 if (p != NULL) {
339 if (Config.Debug)
340 DebugCheckBP((mem & 0xffffff) | 0x80000000, W2);
341 *(u16 *)(p + (mem & 0xffff)) = SWAPu16(value);
342#ifdef PSXREC
3e31e934 343 psxCpu->Clear((mem & (~3)), 1);
ef79bbde
P
344#endif
345 } else {
346#ifdef PSXMEM_LOG
347 PSXMEM_LOG("err sh %8.8lx\n", mem);
348#endif
349 }
350 }
351}
352
353void psxMemWrite32(u32 mem, u32 value) {
354 char *p;
355 u32 t;
356
357// if ((mem&0x1fffff) == 0x71E18 || value == 0x48088800) SysPrintf("t2fix!!\n");
358 t = mem >> 16;
9dd7d179 359 if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
360 if ((mem & 0xffff) < 0x400)
ef79bbde
P
361 psxHu32ref(mem) = SWAPu32(value);
362 else
363 psxHwWrite32(mem, value);
364 } else {
365 p = (char *)(psxMemWLUT[t]);
366 if (p != NULL) {
367 if (Config.Debug)
368 DebugCheckBP((mem & 0xffffff) | 0x80000000, W4);
369 *(u32 *)(p + (mem & 0xffff)) = SWAPu32(value);
370#ifdef PSXREC
371 psxCpu->Clear(mem, 1);
372#endif
373 } else {
374 if (mem != 0xfffe0130) {
375#ifdef PSXREC
376 if (!writeok)
377 psxCpu->Clear(mem, 1);
378#endif
379
380#ifdef PSXMEM_LOG
381 if (writeok) { PSXMEM_LOG("err sw %8.8lx\n", mem); }
382#endif
383 } else {
384 int i;
385
386 switch (value) {
387 case 0x800: case 0x804:
388 if (writeok == 0) break;
389 writeok = 0;
390 memset(psxMemWLUT + 0x0000, 0, 0x80 * sizeof(void *));
391 memset(psxMemWLUT + 0x8000, 0, 0x80 * sizeof(void *));
392 memset(psxMemWLUT + 0xa000, 0, 0x80 * sizeof(void *));
393 break;
394 case 0x00: case 0x1e988:
395 if (writeok == 1) break;
396 writeok = 1;
397 for (i = 0; i < 0x80; i++) psxMemWLUT[i + 0x0000] = (void *)&psxM[(i & 0x1f) << 16];
398 memcpy(psxMemWLUT + 0x8000, psxMemWLUT, 0x80 * sizeof(void *));
399 memcpy(psxMemWLUT + 0xa000, psxMemWLUT, 0x80 * sizeof(void *));
400 break;
401 default:
402#ifdef PSXMEM_LOG
403 PSXMEM_LOG("unk %8.8lx = %x\n", mem, value);
404#endif
405 break;
406 }
407 }
408 }
409 }
410}
411
412void *psxMemPointer(u32 mem) {
413 char *p;
414 u32 t;
415
416 t = mem >> 16;
9dd7d179 417 if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
418 if ((mem & 0xffff) < 0x400)
ef79bbde
P
419 return (void *)&psxH[mem];
420 else
421 return NULL;
422 } else {
423 p = (char *)(psxMemWLUT[t]);
424 if (p != NULL) {
425 return (void *)(p + (mem & 0xffff));
426 }
427 return NULL;
428 }
429}