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
  32 #include "memmap.h"
  33
  34 #ifdef USE_LIBRETRO_VFS
  35 #include <streams/file_stream_transforms.h>
  36 #endif
  37
  38 #ifndef MAP_ANONYMOUS
  39 #define MAP_ANONYMOUS MAP_ANON
  40 #endif
  41
  42 void *(*psxMapHook)(unsigned long addr, size_t size, int is_fixed,
  43                 enum psxMapTag tag);
  44 void (*psxUnmapHook)(void *ptr, size_t size, enum psxMapTag tag);
  45
  46 void *psxMap(unsigned long addr, size_t size, int is_fixed,
  47                 enum psxMapTag tag)
  48 {
  49 #ifdef LIGHTREC
  50 #ifdef MAP_FIXED_NOREPLACE
  51         int flags = MAP_PRIVATE | MAP_ANONYMOUS | MAP_FIXED_NOREPLACE;
  52 #else
  53         int flags = MAP_PRIVATE | MAP_ANONYMOUS | MAP_FIXED;
  54 #endif
  55 #else
  56         int flags = MAP_PRIVATE | MAP_ANONYMOUS;
  57 #endif
  58
  59         int try_ = 0;
  60         unsigned long mask;
  61         void *req, *ret;
  62
  63 retry:
  64         if (psxMapHook != NULL) {
  65                 ret = psxMapHook(addr, size, 0, tag);
  66                 if (ret == NULL)
  67                         return NULL;
  68         }
  69         else {
  70                 /* avoid MAP_FIXED, it overrides existing mappings.. */
  71                 /* if (is_fixed)
  72                         flags |= MAP_FIXED; */
  73
  74                 req = (void *)addr;
  75                 ret = mmap(req, size, PROT_READ | PROT_WRITE, flags, -1, 0);
  76                 if (ret == MAP_FAILED)
  77                         return NULL;
  78         }
  79
  80         if (addr != 0 && ret != (void *)addr) {
  81                 SysMessage("psxMap: warning: wanted to map @%08x, got %p\n",
  82                         addr, ret);
  83
  84                 if (is_fixed) {
  85                         psxUnmap(ret, size, tag);
  86                         return NULL;
  87                 }
  88
  89                 if (((addr ^ (unsigned long)ret) & ~0xff000000l) && try_ < 2)
  90                 {
  91                         psxUnmap(ret, size, tag);
  92
  93                         // try to use similarly aligned memory instead
  94                         // (recompiler needs this)
  95                         mask = try_ ? 0xffff : 0xffffff;
  96                         addr = ((unsigned long)ret + mask) & ~mask;
  97                         try_++;
  98                         goto retry;
  99                 }
 100         }
 101
 102         return ret;
 103 }
 104
 105 void psxUnmap(void *ptr, size_t size, enum psxMapTag tag)
 106 {
 107         if (psxUnmapHook != NULL) {
 108                 psxUnmapHook(ptr, size, tag);
 109                 return;
 110         }
 111
 112         if (ptr)
 113                 munmap(ptr, size);
 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 int psxMemInit() {
 144         int i;
 145
 146         psxMemRLUT = (u8 **)malloc(0x10000 * sizeof(void *));
 147         psxMemWLUT = (u8 **)malloc(0x10000 * sizeof(void *));
 148         memset(psxMemRLUT, 0, 0x10000 * sizeof(void *));
 149         memset(psxMemWLUT, 0, 0x10000 * sizeof(void *));
 150
 151 #ifdef LIGHTREC
 152         psxM = psxMap(0x30000000, 0x00210000, 1, MAP_TAG_RAM);
 153         if (psxM == NULL)
 154                 psxM = psxMap(0x70000000, 0x00210000, 1, MAP_TAG_RAM);
 155
 156 #else
 157         psxM = psxMap(0x80000000, 0x00210000, 1, MAP_TAG_RAM);
 158 #endif
 159 #ifndef RAM_FIXED
 160         if (psxM == NULL)
 161                 psxM = psxMap(0x77000000, 0x00210000, 0, MAP_TAG_RAM);
 162 #endif
 163         if (psxM == NULL) {
 164                 SysMessage(_("mapping main RAM failed"));
 165                 return -1;
 166         }
 167
 168         psxP = &psxM[0x200000];
 169 #ifdef LIGHTREC
 170         psxH = psxMap(0x4f800000, 0x10000, 0, MAP_TAG_OTHER);
 171         if (psxH == NULL)
 172                 psxH = psxMap(0x8f800000, 0x10000, 0, MAP_TAG_OTHER);
 173
 174         psxR = psxMap(0x4fc00000, 0x80000, 0, MAP_TAG_OTHER);
 175         if (psxR == NULL)
 176                 psxR = psxMap(0x8fc00000, 0x80000, 0, MAP_TAG_OTHER);
 177 #else
 178         psxH = psxMap(0x1f800000, 0x10000, 0, MAP_TAG_OTHER);
 179         psxR = psxMap(0x1fc00000, 0x80000, 0, MAP_TAG_OTHER);
 180 #endif
 181
 182         if (psxMemRLUT == NULL || psxMemWLUT == NULL ||
 183             psxR == NULL || psxP == NULL || psxH == NULL) {
 184                 SysMessage(_("Error allocating memory!"));
 185                 psxMemShutdown();
 186                 return -1;
 187         }
 188
 189 // MemR
 190         for (i = 0; i < 0x80; i++) psxMemRLUT[i + 0x0000] = (u8 *)&psxM[(i & 0x1f) << 16];
 191
 192         memcpy(psxMemRLUT + 0x8000, psxMemRLUT, 0x80 * sizeof(void *));
 193         memcpy(psxMemRLUT + 0xa000, psxMemRLUT, 0x80 * sizeof(void *));
 194
 195         psxMemRLUT[0x1f00] = (u8 *)psxP;
 196         psxMemRLUT[0x1f80] = (u8 *)psxH;
 197
 198         for (i = 0; i < 0x08; i++) psxMemRLUT[i + 0x1fc0] = (u8 *)&psxR[i << 16];
 199
 200         memcpy(psxMemRLUT + 0x9fc0, psxMemRLUT + 0x1fc0, 0x08 * sizeof(void *));
 201         memcpy(psxMemRLUT + 0xbfc0, psxMemRLUT + 0x1fc0, 0x08 * sizeof(void *));
 202
 203 // MemW
 204         for (i = 0; i < 0x80; i++) psxMemWLUT[i + 0x0000] = (u8 *)&psxM[(i & 0x1f) << 16];
 205
 206         memcpy(psxMemWLUT + 0x8000, psxMemWLUT, 0x80 * sizeof(void *));
 207         memcpy(psxMemWLUT + 0xa000, psxMemWLUT, 0x80 * sizeof(void *));
 208
 209         psxMemWLUT[0x1f00] = (u8 *)psxP;
 210         psxMemWLUT[0x1f80] = (u8 *)psxH;
 211
 212         return 0;
 213 }
 214
 215 void psxMemReset() {
 216         FILE *f = NULL;
 217         char bios[1024];
 218
 219         memset(psxM, 0, 0x00200000);
 220         memset(psxP, 0xff, 0x00010000);
 221
 222         if (strcmp(Config.Bios, "HLE") != 0) {
 223                 sprintf(bios, "%s/%s", Config.BiosDir, Config.Bios);
 224                 f = fopen(bios, "rb");
 225
 226                 if (f == NULL) {
 227                         SysMessage(_("Could not open BIOS:\"%s\". Enabling HLE Bios!\n"), bios);
 228                         memset(psxR, 0, 0x80000);
 229                         Config.HLE = TRUE;
 230                 } else {
 231                         fread(psxR, 1, 0x80000, f);
 232                         fclose(f);
 233                         Config.HLE = FALSE;
 234                 }
 235         } else Config.HLE = TRUE;
 236 }
 237
 238 void psxMemShutdown() {
 239         psxUnmap(psxM, 0x00210000, MAP_TAG_RAM); psxM = NULL;
 240         psxUnmap(psxH, 0x10000, MAP_TAG_OTHER); psxH = NULL;
 241         psxUnmap(psxR, 0x80000, MAP_TAG_OTHER); psxR = NULL;
 242
 243         free(psxMemRLUT); psxMemRLUT = NULL;
 244         free(psxMemWLUT); psxMemWLUT = NULL;
 245 }
 246
 247 static int writeok = 1;
 248
 249 u8 psxMemRead8(u32 mem) {
 250         char *p;
 251         u32 t;
 252
 253         t = mem >> 16;
 254         if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
 255                 if ((mem & 0xffff) < 0x400)
 256                         return psxHu8(mem);
 257                 else
 258                         return psxHwRead8(mem);
 259         } else {
 260                 p = (char *)(psxMemRLUT[t]);
 261                 if (p != NULL) {
 262                         if (Config.Debug)
 263                                 DebugCheckBP((mem & 0xffffff) | 0x80000000, R1);
 264                         return *(u8 *)(p + (mem & 0xffff));
 265                 } else {
 266 #ifdef PSXMEM_LOG
 267                         PSXMEM_LOG("err lb %8.8lx\n", mem);
 268 #endif
 269                         return 0;
 270                 }
 271         }
 272 }
 273
 274 u16 psxMemRead16(u32 mem) {
 275         char *p;
 276         u32 t;
 277
 278         t = mem >> 16;
 279         if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
 280                 if ((mem & 0xffff) < 0x400)
 281                         return psxHu16(mem);
 282                 else
 283                         return psxHwRead16(mem);
 284         } else {
 285                 p = (char *)(psxMemRLUT[t]);
 286                 if (p != NULL) {
 287                         if (Config.Debug)
 288                                 DebugCheckBP((mem & 0xffffff) | 0x80000000, R2);
 289                         return SWAPu16(*(u16 *)(p + (mem & 0xffff)));
 290                 } else {
 291 #ifdef PSXMEM_LOG
 292                         PSXMEM_LOG("err lh %8.8lx\n", mem);
 293 #endif
 294                         return 0;
 295                 }
 296         }
 297 }
 298
 299 u32 psxMemRead32(u32 mem) {
 300         char *p;
 301         u32 t;
 302
 303         t = mem >> 16;
 304         if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
 305                 if ((mem & 0xffff) < 0x400)
 306                         return psxHu32(mem);
 307                 else
 308                         return psxHwRead32(mem);
 309         } else {
 310                 p = (char *)(psxMemRLUT[t]);
 311                 if (p != NULL) {
 312                         if (Config.Debug)
 313                                 DebugCheckBP((mem & 0xffffff) | 0x80000000, R4);
 314                         return SWAPu32(*(u32 *)(p + (mem & 0xffff)));
 315                 } else {
 316 #ifdef PSXMEM_LOG
 317                         if (writeok) { PSXMEM_LOG("err lw %8.8lx\n", mem); }
 318 #endif
 319                         return 0;
 320                 }
 321         }
 322 }
 323
 324 void psxMemWrite8(u32 mem, u8 value) {
 325         char *p;
 326         u32 t;
 327
 328         t = mem >> 16;
 329         if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
 330                 if ((mem & 0xffff) < 0x400)
 331                         psxHu8(mem) = value;
 332                 else
 333                         psxHwWrite8(mem, value);
 334         } else {
 335                 p = (char *)(psxMemWLUT[t]);
 336                 if (p != NULL) {
 337                         if (Config.Debug)
 338                                 DebugCheckBP((mem & 0xffffff) | 0x80000000, W1);
 339                         *(u8 *)(p + (mem & 0xffff)) = value;
 340 #ifdef PSXREC
 341                         psxCpu->Clear((mem & (~3)), 1);
 342 #endif
 343                 } else {
 344 #ifdef PSXMEM_LOG
 345                         PSXMEM_LOG("err sb %8.8lx\n", mem);
 346 #endif
 347                 }
 348         }
 349 }
 350
 351 void psxMemWrite16(u32 mem, u16 value) {
 352         char *p;
 353         u32 t;
 354
 355         t = mem >> 16;
 356         if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
 357                 if ((mem & 0xffff) < 0x400)
 358                         psxHu16ref(mem) = SWAPu16(value);
 359                 else
 360                         psxHwWrite16(mem, value);
 361         } else {
 362                 p = (char *)(psxMemWLUT[t]);
 363                 if (p != NULL) {
 364                         if (Config.Debug)
 365                                 DebugCheckBP((mem & 0xffffff) | 0x80000000, W2);
 366                         *(u16 *)(p + (mem & 0xffff)) = SWAPu16(value);
 367 #ifdef PSXREC
 368                         psxCpu->Clear((mem & (~3)), 1);
 369 #endif
 370                 } else {
 371 #ifdef PSXMEM_LOG
 372                         PSXMEM_LOG("err sh %8.8lx\n", mem);
 373 #endif
 374                 }
 375         }
 376 }
 377
 378 void psxMemWrite32(u32 mem, u32 value) {
 379         char *p;
 380         u32 t;
 381
 382 //      if ((mem&0x1fffff) == 0x71E18 || value == 0x48088800) SysPrintf("t2fix!!\n");
 383         t = mem >> 16;
 384         if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
 385                 if ((mem & 0xffff) < 0x400)
 386                         psxHu32ref(mem) = SWAPu32(value);
 387                 else
 388                         psxHwWrite32(mem, value);
 389         } else {
 390                 p = (char *)(psxMemWLUT[t]);
 391                 if (p != NULL) {
 392                         if (Config.Debug)
 393                                 DebugCheckBP((mem & 0xffffff) | 0x80000000, W4);
 394                         *(u32 *)(p + (mem & 0xffff)) = SWAPu32(value);
 395 #ifdef PSXREC
 396                         psxCpu->Clear(mem, 1);
 397 #endif
 398                 } else {
 399                         if (mem != 0xfffe0130) {
 400 #ifdef PSXREC
 401                                 if (!writeok)
 402                                         psxCpu->Clear(mem, 1);
 403 #endif
 404
 405 #ifdef PSXMEM_LOG
 406                                 if (writeok) { PSXMEM_LOG("err sw %8.8lx\n", mem); }
 407 #endif
 408                         } else {
 409                                 int i;
 410
 411                                 switch (value) {
 412                                         case 0x800: case 0x804:
 413                                                 if (writeok == 0) break;
 414                                                 writeok = 0;
 415                                                 memset(psxMemWLUT + 0x0000, 0, 0x80 * sizeof(void *));
 416                                                 memset(psxMemWLUT + 0x8000, 0, 0x80 * sizeof(void *));
 417                                                 memset(psxMemWLUT + 0xa000, 0, 0x80 * sizeof(void *));
 418                                                 break;
 419                                         case 0x00: case 0x1e988:
 420                                                 if (writeok == 1) break;
 421                                                 writeok = 1;
 422                                                 for (i = 0; i < 0x80; i++) psxMemWLUT[i + 0x0000] = (void *)&psxM[(i & 0x1f) << 16];
 423                                                 memcpy(psxMemWLUT + 0x8000, psxMemWLUT, 0x80 * sizeof(void *));
 424                                                 memcpy(psxMemWLUT + 0xa000, psxMemWLUT, 0x80 * sizeof(void *));
 425                                                 break;
 426                                         default:
 427 #ifdef PSXMEM_LOG
 428                                                 PSXMEM_LOG("unk %8.8lx = %x\n", mem, value);
 429 #endif
 430                                                 break;
 431                                 }
 432                         }
 433                 }
 434         }
 435 }
 436
 437 void *psxMemPointer(u32 mem) {
 438         char *p;
 439         u32 t;
 440
 441         t = mem >> 16;
 442         if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
 443                 if ((mem & 0xffff) < 0x400)
 444                         return (void *)&psxH[mem];
 445                 else
 446                         return NULL;
 447         } else {
 448                 p = (char *)(psxMemWLUT[t]);
 449                 if (p != NULL) {
 450                         return (void *)(p + (mem & 0xffff));
 451                 }
 452                 return NULL;
 453         }
 454 }