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