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