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