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