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