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