[pcsx_rearmed.git] / libpcsxcore / psxmem.c

/***************************************************************************
 *   Copyright (C) 2007 Ryan Schultz, PCSX-df Team, PCSX team              *
 *                                                                         *
 *   This program is free software; you can redistribute it and/or modify  *
 *   it under the terms of the GNU General Public License as published by  *
 *   the Free Software Foundation; either version 2 of the License, or     *
 *   (at your option) any later version.                                   *
 *                                                                         *
 *   This program is distributed in the hope that it will be useful,       *
 *   but WITHOUT ANY WARRANTY; without even the implied warranty of        *
 *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the         *
 *   GNU General Public License for more details.                          *
 *                                                                         *
 *   You should have received a copy of the GNU General Public License     *
 *   along with this program; if not, write to the                         *
 *   Free Software Foundation, Inc.,                                       *
 *   51 Franklin Street, Fifth Floor, Boston, MA 02111-1307 USA.           *
 ***************************************************************************/

/*
* PSX memory functions.
*/

// TODO: Implement caches & cycle penalty.

#include "psxmem.h"
#include "psxmem_map.h"
#include "r3000a.h"
#include "psxhw.h"
//#include "debug.h"
#define DebugCheckBP(...)

#include "lightrec/mem.h"
#include "memmap.h"

#ifdef USE_LIBRETRO_VFS
#include <streams/file_stream_transforms.h>
#endif

#ifndef MAP_ANONYMOUS
#define MAP_ANONYMOUS MAP_ANON
#endif

static void * psxMapDefault(unsigned long addr, size_t size,
			    int is_fixed, enum psxMapTag tag)
{
	void *ptr;
#if !P_HAVE_MMAP
	ptr = calloc(1, size);
	return ptr ? ptr : MAP_FAILED;
#else
	int flags = MAP_PRIVATE | MAP_ANONYMOUS;

	ptr = mmap((void *)(uintptr_t)addr, size,
		    PROT_READ | PROT_WRITE, flags, -1, 0);
#ifdef MADV_HUGEPAGE
	if (size >= 2*1024*1024) {
		if (ptr != MAP_FAILED && ((uintptr_t)ptr & (2*1024*1024 - 1))) {
			// try to manually realign assuming bottom-to-top alloc
			munmap(ptr, size);
			addr = (uintptr_t)ptr & ~(2*1024*1024 - 1);
			ptr = mmap((void *)(uintptr_t)addr, size,
				PROT_READ | PROT_WRITE, flags, -1, 0);
		}
		if (ptr != MAP_FAILED)
			madvise(ptr, size, MADV_HUGEPAGE);
	}
#endif
	return ptr;
#endif
}

static void psxUnmapDefault(void *ptr, size_t size, enum psxMapTag tag)
{
#if !P_HAVE_MMAP
	free(ptr);
#else
	munmap(ptr, size);
#endif
}

void *(*psxMapHook)(unsigned long addr, size_t size, int is_fixed,
		enum psxMapTag tag) = psxMapDefault;
void (*psxUnmapHook)(void *ptr, size_t size,
		     enum psxMapTag tag) = psxUnmapDefault;

void *psxMap(unsigned long addr, size_t size, int is_fixed,
		enum psxMapTag tag)
{
	int try_ = 0;
	unsigned long mask;
	void *ret;

retry:
	ret = psxMapHook(addr, size, 0, tag);
	if (ret == NULL)
		return MAP_FAILED;

	if (addr != 0 && ret != (void *)(uintptr_t)addr) {
		SysMessage("psxMap: warning: wanted to map @%08x, got %p\n",
			addr, ret);

		if (is_fixed) {
			psxUnmap(ret, size, tag);
			return MAP_FAILED;
		}

		if (((addr ^ (unsigned long)(uintptr_t)ret) & ~0xff000000l) && try_ < 2)
		{
			psxUnmap(ret, size, tag);

			// try to use similarly aligned memory instead
			// (recompiler needs this)
			mask = try_ ? 0xffff : 0xffffff;
			addr = ((uintptr_t)ret + mask) & ~mask;
			try_++;
			goto retry;
		}
	}

	return ret;
}

void psxUnmap(void *ptr, size_t size, enum psxMapTag tag)
{
	psxUnmapHook(ptr, size, tag);
}

s8 *psxM = NULL; // Kernel & User Memory (2 Meg)
s8 *psxP = NULL; // Parallel Port (64K)
s8 *psxR = NULL; // BIOS ROM (512K)
s8 *psxH = NULL; // Scratch Pad (1K) & Hardware Registers (8K)

u8 **psxMemWLUT = NULL;
u8 **psxMemRLUT = NULL;

/*  Playstation Memory Map (from Playstation doc by Joshua Walker)
0x0000_0000-0x0000_ffff		Kernel (64K)
0x0001_0000-0x001f_ffff		User Memory (1.9 Meg)

0x1f00_0000-0x1f00_ffff		Parallel Port (64K)

0x1f80_0000-0x1f80_03ff		Scratch Pad (1024 bytes)

0x1f80_1000-0x1f80_2fff		Hardware Registers (8K)

0x1fc0_0000-0x1fc7_ffff		BIOS (512K)

0x8000_0000-0x801f_ffff		Kernel and User Memory Mirror (2 Meg) Cached
0x9fc0_0000-0x9fc7_ffff		BIOS Mirror (512K) Cached

0xa000_0000-0xa01f_ffff		Kernel and User Memory Mirror (2 Meg) Uncached
0xbfc0_0000-0xbfc7_ffff		BIOS Mirror (512K) Uncached
*/

static int psxMemInitMap(void)
{
	psxM = psxMap(0x80000000, 0x00210000, 1, MAP_TAG_RAM);
	if (psxM == MAP_FAILED)
		psxM = psxMap(0x77000000, 0x00210000, 0, MAP_TAG_RAM);
	if (psxM == MAP_FAILED) {
		SysMessage(_("mapping main RAM failed"));
		psxM = NULL;
		return -1;
	}
	psxP = &psxM[0x200000];

	psxH = psxMap(0x1f800000, 0x10000, 0, MAP_TAG_OTHER);
	if (psxH == MAP_FAILED) {
		SysMessage(_("Error allocating memory!"));
		psxMemShutdown();
		return -1;
	}

	psxR = psxMap(0x1fc00000, 0x80000, 0, MAP_TAG_OTHER);
	if (psxR == MAP_FAILED) {
		SysMessage(_("Error allocating memory!"));
		psxMemShutdown();
		return -1;
	}

	return 0;
}

static void psxMemFreeMap(void)
{
	if (psxM) psxUnmap(psxM, 0x00210000, MAP_TAG_RAM);
	if (psxH) psxUnmap(psxH, 0x10000, MAP_TAG_OTHER);
	if (psxR) psxUnmap(psxR, 0x80000, MAP_TAG_OTHER);
	psxM = psxH = psxR = NULL;
	psxP = NULL;
}

int psxMemInit(void)
{
	unsigned int i;
	int ret;

	if (LIGHTREC_CUSTOM_MAP)
		ret = lightrec_init_mmap();
	else
		ret = psxMemInitMap();
	if (ret) {
		SysMessage(_("Error allocating memory!"));
		psxMemShutdown();
		return -1;
	}

	psxMemRLUT = (u8 **)malloc(0x10000 * sizeof(void *));
	psxMemWLUT = (u8 **)malloc(0x10000 * sizeof(void *));

	if (psxMemRLUT == NULL || psxMemWLUT == NULL) {
		SysMessage(_("Error allocating memory!"));
		psxMemShutdown();
		return -1;
	}

	memset(psxMemRLUT, (int)(uintptr_t)INVALID_PTR, 0x10000 * sizeof(void *));
	memset(psxMemWLUT, (int)(uintptr_t)INVALID_PTR, 0x10000 * sizeof(void *));

// MemR
	for (i = 0; i < 0x80; i++) psxMemRLUT[i + 0x0000] = (u8 *)&psxM[(i & 0x1f) << 16];

	memcpy(psxMemRLUT + 0x8000, psxMemRLUT, 0x80 * sizeof(void *));
	memcpy(psxMemRLUT + 0xa000, psxMemRLUT, 0x80 * sizeof(void *));

	psxMemRLUT[0x1f00] = (u8 *)psxP;
	psxMemRLUT[0x1f80] = (u8 *)psxH;

	for (i = 0; i < 0x08; i++) psxMemRLUT[i + 0x1fc0] = (u8 *)&psxR[i << 16];

	memcpy(psxMemRLUT + 0x9fc0, psxMemRLUT + 0x1fc0, 0x08 * sizeof(void *));
	memcpy(psxMemRLUT + 0xbfc0, psxMemRLUT + 0x1fc0, 0x08 * sizeof(void *));

// MemW
	for (i = 0; i < 0x80; i++) psxMemWLUT[i + 0x0000] = (u8 *)&psxM[(i & 0x1f) << 16];

	memcpy(psxMemWLUT + 0x8000, psxMemWLUT, 0x80 * sizeof(void *));
	memcpy(psxMemWLUT + 0xa000, psxMemWLUT, 0x80 * sizeof(void *));

	// Don't allow writes to PIO Expansion region (psxP) to take effect.
	// NOTE: Not sure if this is needed to fix any games but seems wise,
	//       seeing as some games do read from PIO as part of copy-protection
	//       check. (See fix in psxMemReset() regarding psxP region reads).
	psxMemWLUT[0x1f00] = INVALID_PTR;
	psxMemWLUT[0x1f80] = (u8 *)psxH;

	return 0;
}

void psxMemReset() {
	FILE *f = NULL;
	char bios[1024];

	memset(psxM, 0, 0x00200000);
	memset(psxP, 0xff, 0x00010000);

	Config.HLE = TRUE;

	if (strcmp(Config.Bios, "HLE") != 0) {
		sprintf(bios, "%s/%s", Config.BiosDir, Config.Bios);
		f = fopen(bios, "rb");

		if (f == NULL) {
			SysMessage(_("Could not open BIOS:\"%s\". Enabling HLE Bios!\n"), bios);
			memset(psxR, 0, 0x80000);
		} else {
			if (fread(psxR, 1, 0x80000, f) == 0x80000) {
				Config.HLE = FALSE;
			} else {
				SysMessage(_("The selected BIOS:\"%s\" is of wrong size. Enabling HLE Bios!\n"), bios);
			}
			fclose(f);
		}
	}
}

void psxMemShutdown() {
	if (LIGHTREC_CUSTOM_MAP)
		lightrec_free_mmap();
	else
		psxMemFreeMap();

	free(psxMemRLUT); psxMemRLUT = NULL;
	free(psxMemWLUT); psxMemWLUT = NULL;
}

void psxMemOnIsolate(int enable)
{
	if (enable) {
		memset(psxMemWLUT + 0x0000, (int)(uintptr_t)INVALID_PTR, 0x80 * sizeof(void *));
		memset(psxMemWLUT + 0x8000, (int)(uintptr_t)INVALID_PTR, 0x80 * sizeof(void *));
		//memset(psxMemWLUT + 0xa000, (int)(uintptr_t)INVALID_PTR, 0x80 * sizeof(void *));
	} else {
		int i;
		for (i = 0; i < 0x80; i++)
			psxMemWLUT[i + 0x0000] = (void *)&psxM[(i & 0x1f) << 16];
		memcpy(psxMemWLUT + 0x8000, psxMemWLUT, 0x80 * sizeof(void *));
		memcpy(psxMemWLUT + 0xa000, psxMemWLUT, 0x80 * sizeof(void *));
	}
	psxCpu->Notify(enable ? R3000ACPU_NOTIFY_CACHE_ISOLATED
			: R3000ACPU_NOTIFY_CACHE_UNISOLATED, NULL);
}

u8 psxMemRead8(u32 mem) {
	char *p;
	u32 t;

	t = mem >> 16;
	if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
		if ((mem & 0xffff) < 0x400)
			return psxHu8(mem);
		else
			return psxHwRead8(mem);
	} else {
		p = (char *)(psxMemRLUT[t]);
		if (p != INVALID_PTR) {
			if (Config.Debug)
				DebugCheckBP((mem & 0xffffff) | 0x80000000, R1);
			return *(u8 *)(p + (mem & 0xffff));
		} else {
#ifdef PSXMEM_LOG
			PSXMEM_LOG("err lb %8.8lx\n", mem);
#endif
			return 0xFF;
		}
	}
}

u16 psxMemRead16(u32 mem) {
	char *p;
	u32 t;

	t = mem >> 16;
	if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
		if ((mem & 0xffff) < 0x400)
			return psxHu16(mem);
		else
			return psxHwRead16(mem);
	} else {
		p = (char *)(psxMemRLUT[t]);
		if (p != INVALID_PTR) {
			if (Config.Debug)
				DebugCheckBP((mem & 0xffffff) | 0x80000000, R2);
			return SWAPu16(*(u16 *)(p + (mem & 0xffff)));
		} else {
#ifdef PSXMEM_LOG
			PSXMEM_LOG("err lh %8.8lx\n", mem);
#endif
			return 0xFFFF;
		}
	}
}

u32 psxMemRead32(u32 mem) {
	char *p;
	u32 t;

	t = mem >> 16;
	if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
		if ((mem & 0xffff) < 0x400)
			return psxHu32(mem);
		else
			return psxHwRead32(mem);
	} else {
		p = (char *)(psxMemRLUT[t]);
		if (p != INVALID_PTR) {
			if (Config.Debug)
				DebugCheckBP((mem & 0xffffff) | 0x80000000, R4);
			return SWAPu32(*(u32 *)(p + (mem & 0xffff)));
		} else {
			if (mem == 0xfffe0130)
				return psxRegs.biuReg;
#ifdef PSXMEM_LOG
			PSXMEM_LOG("err lw %8.8lx\n", mem);
#endif
			return 0xFFFFFFFF;
		}
	}
}

void psxMemWrite8(u32 mem, u8 value) {
	char *p;
	u32 t;

	t = mem >> 16;
	if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
		if ((mem & 0xffff) < 0x400)
			psxHu8(mem) = value;
		else
			psxHwWrite8(mem, value);
	} else {
		p = (char *)(psxMemWLUT[t]);
		if (p != INVALID_PTR) {
			if (Config.Debug)
				DebugCheckBP((mem & 0xffffff) | 0x80000000, W1);
			*(u8 *)(p + (mem & 0xffff)) = value;
#ifndef DRC_DISABLE
			psxCpu->Clear((mem & (~3)), 1);
#endif
		} else {
#ifdef PSXMEM_LOG
			PSXMEM_LOG("err sb %8.8lx\n", mem);
#endif
		}
	}
}

void psxMemWrite16(u32 mem, u16 value) {
	char *p;
	u32 t;

	t = mem >> 16;
	if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
		if ((mem & 0xffff) < 0x400)
			psxHu16ref(mem) = SWAPu16(value);
		else
			psxHwWrite16(mem, value);
	} else {
		p = (char *)(psxMemWLUT[t]);
		if (p != INVALID_PTR) {
			if (Config.Debug)
				DebugCheckBP((mem & 0xffffff) | 0x80000000, W2);
			*(u16 *)(p + (mem & 0xffff)) = SWAPu16(value);
#ifndef DRC_DISABLE
			psxCpu->Clear((mem & (~3)), 1);
#endif
		} else {
#ifdef PSXMEM_LOG
			PSXMEM_LOG("err sh %8.8lx\n", mem);
#endif
		}
	}
}

void psxMemWrite32(u32 mem, u32 value) {
	char *p;
	u32 t;

//	if ((mem&0x1fffff) == 0x71E18 || value == 0x48088800) SysPrintf("t2fix!!\n");
	t = mem >> 16;
	if (t == 0x1f80 || t == 0x9f80 || t == 0xbf80) {
		if ((mem & 0xffff) < 0x400)
			psxHu32ref(mem) = SWAPu32(value);
		else
			psxHwWrite32(mem, value);
	} else {
		p = (char *)(psxMemWLUT[t]);
		if (p != INVALID_PTR) {
			if (Config.Debug)
				DebugCheckBP((mem & 0xffffff) | 0x80000000, W4);
			*(u32 *)(p + (mem & 0xffff)) = SWAPu32(value);
#ifndef DRC_DISABLE
			psxCpu->Clear(mem, 1);
#endif
		} else {
			if (mem == 0xfffe0130) {
				psxRegs.biuReg = value;
				return;
			}
#ifdef PSXMEM_LOG
			PSXMEM_LOG("err sw %8.8lx\n", mem);
#endif
		}
	}
}

void *psxMemPointer(u32 mem) {
	char *p;
	u32 t;

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