mirror of
https://github.com/ksherlock/mpw.git
synced 2024-06-10 15:29:31 +00:00
121 lines
2.4 KiB
C
121 lines
2.4 KiB
C
#include "defs.h"
|
|
#include "fmem.h"
|
|
#include "CpuModule.h"
|
|
|
|
|
|
/*============================================================================*/
|
|
/* Illegal read / write fault information */
|
|
/*============================================================================*/
|
|
|
|
BOOLE memory_fault_read = FALSE; /* TRUE - read / FALSE - write */
|
|
ULO memory_fault_address = 0;
|
|
|
|
/*==============================================================================
|
|
Raises exception 3 when a word or long is accessing an odd address
|
|
and the CPU is < 020
|
|
==============================================================================*/
|
|
|
|
static void memoryOddRead(ULO address)
|
|
{
|
|
if (address & 1)
|
|
{
|
|
if (cpuGetModelMajor() < 2)
|
|
{
|
|
memory_fault_read = TRUE;
|
|
memory_fault_address = address;
|
|
cpuThrowAddressErrorException();
|
|
}
|
|
}
|
|
}
|
|
|
|
static void memoryOddWrite(ULO address)
|
|
{
|
|
if (address & 1)
|
|
{
|
|
if (cpuGetModelMajor() < 2)
|
|
{
|
|
memory_fault_read = FALSE;
|
|
memory_fault_address = address;
|
|
cpuThrowAddressErrorException();
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
// new memory functions.
|
|
|
|
static uint8_t *Memory = NULL;
|
|
static uint32_t MemorySize = 0;
|
|
|
|
void memorySetMemory(uint8_t *memory, uint32_t size)
|
|
{
|
|
Memory = memory;
|
|
MemorySize = size;
|
|
}
|
|
|
|
UBY memoryReadByte(ULO address)
|
|
{
|
|
// hmmm... 32-bit clean addresses?
|
|
if (address < MemorySize)
|
|
return Memory[address];
|
|
return 0;
|
|
}
|
|
|
|
UWO memoryReadWord(ULO address)
|
|
{
|
|
if (address & 0x01) memoryOddRead(address);
|
|
|
|
if (address + 1 < MemorySize)
|
|
return (Memory[address++] << 8)
|
|
| (Memory[address++] << 0);
|
|
|
|
return 0;
|
|
}
|
|
|
|
ULO memoryReadLong(ULO address)
|
|
{
|
|
if (address & 0x01) memoryOddRead(address);
|
|
|
|
if (address + 1 < MemorySize)
|
|
return (Memory[address++] << 24)
|
|
| (Memory[address++] << 16)
|
|
| (Memory[address++] << 8)
|
|
| (Memory[address++] << 0);
|
|
|
|
return 0;
|
|
|
|
}
|
|
void memoryWriteByte(UBY data, ULO address)
|
|
{
|
|
if (address < MemorySize)
|
|
{
|
|
Memory[address] = data;
|
|
}
|
|
}
|
|
|
|
void memoryWriteWord(UWO data, ULO address)
|
|
{
|
|
if (address & 0x01) memoryOddWrite(address);
|
|
|
|
if (address + 1 < MemorySize)
|
|
{
|
|
Memory[address++] = data >> 8;
|
|
Memory[address++] = data >> 0;
|
|
}
|
|
}
|
|
|
|
void memoryWriteLong(ULO data, ULO address)
|
|
{
|
|
if (address & 0x01) memoryOddWrite(address);
|
|
|
|
if (address + 3 < MemorySize)
|
|
{
|
|
Memory[address++] = data >> 24;
|
|
Memory[address++] = data >> 16;
|
|
Memory[address++] = data >> 8;
|
|
Memory[address++] = data >> 0;
|
|
}
|
|
}
|
|
|
|
|