469358aaf9
Small code cleanup
352 lines
9.6 KiB
C++
352 lines
9.6 KiB
C++
/////////////////////////////////////////////////////////////////////////
|
|
// $Id: memory.cc,v 1.43 2005-10-13 16:22:21 sshwarts Exp $
|
|
/////////////////////////////////////////////////////////////////////////
|
|
//
|
|
// Copyright (C) 2001 MandrakeSoft S.A.
|
|
//
|
|
// MandrakeSoft S.A.
|
|
// 43, rue d'Aboukir
|
|
// 75002 Paris - France
|
|
// http://www.linux-mandrake.com/
|
|
// http://www.mandrakesoft.com/
|
|
//
|
|
// This library is free software; you can redistribute it and/or
|
|
// modify it under the terms of the GNU Lesser General Public
|
|
// License as published by the Free Software Foundation; either
|
|
// version 2 of the License, or (at your option) any later version.
|
|
//
|
|
// This library 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
|
|
// Lesser General Public License for more details.
|
|
//
|
|
// You should have received a copy of the GNU Lesser General Public
|
|
// License along with this library; if not, write to the Free Software
|
|
// Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
|
|
|
|
#include "iodev/iodev.h"
|
|
#define LOG_THIS BX_MEM_THIS
|
|
|
|
#if BX_PROVIDE_CPU_MEMORY
|
|
|
|
void BX_CPP_AttrRegparmN(3)
|
|
BX_MEM_C::writePhysicalPage(BX_CPU_C *cpu, Bit32u addr, unsigned len, void *data)
|
|
{
|
|
Bit8u *data_ptr;
|
|
Bit32u a20addr;
|
|
|
|
// Note: accesses should always be contained within a single page now.
|
|
|
|
#if BX_SUPPORT_IODEBUG
|
|
bx_iodebug_c::mem_write(cpu, addr, len, data);
|
|
#endif
|
|
|
|
a20addr = A20ADDR(addr);
|
|
BX_INSTR_PHY_WRITE(cpu->which_cpu(), a20addr, len);
|
|
|
|
#if BX_DEBUGGER
|
|
// (mch) Check for physical write break points, TODO
|
|
// (bbd) Each breakpoint should have an associated CPU#, TODO
|
|
for (int i = 0; i < num_write_watchpoints; i++)
|
|
if (write_watchpoint[i] == a20addr) {
|
|
BX_CPU(0)->watchpoint = a20addr;
|
|
BX_CPU(0)->break_point = BREAK_POINT_WRITE;
|
|
break;
|
|
}
|
|
#endif
|
|
|
|
struct memory_handler_struct *memory_handler = memory_handlers[a20addr >> 20];
|
|
while (memory_handler) {
|
|
if (memory_handler->begin <= a20addr &&
|
|
memory_handler->end >= a20addr &&
|
|
memory_handler->write_handler(a20addr, len, data, memory_handler->write_param))
|
|
{
|
|
return;
|
|
}
|
|
memory_handler = memory_handler->next;
|
|
}
|
|
|
|
#if BX_SUPPORT_ICACHE
|
|
if (a20addr < BX_MEM_THIS len)
|
|
pageWriteStampTable.decWriteStamp(a20addr);
|
|
#endif
|
|
|
|
#if BX_SUPPORT_APIC
|
|
bx_generic_apic_c *local_apic = &cpu->local_apic;
|
|
bx_generic_apic_c *ioapic = bx_devices.ioapic;
|
|
if (local_apic->is_selected (a20addr, len)) {
|
|
local_apic->write (a20addr, (Bit32u *)data, len);
|
|
return;
|
|
}
|
|
if (ioapic->is_selected (a20addr, len)) {
|
|
ioapic->write (a20addr, (Bit32u *)data, len);
|
|
return;
|
|
}
|
|
#endif
|
|
|
|
if ( (a20addr + len) <= BX_MEM_THIS len ) {
|
|
// all of data is within limits of physical memory
|
|
if ( (a20addr & 0xfff80000) != 0x00080000 ) {
|
|
if (len == 4) {
|
|
WriteHostDWordToLittleEndian(&vector[a20addr], *(Bit32u*)data);
|
|
BX_DBG_DIRTY_PAGE(a20addr >> 12);
|
|
return;
|
|
}
|
|
if (len == 2) {
|
|
WriteHostWordToLittleEndian(&vector[a20addr], *(Bit16u*)data);
|
|
BX_DBG_DIRTY_PAGE(a20addr >> 12);
|
|
return;
|
|
}
|
|
if (len == 1) {
|
|
* ((Bit8u *) (&vector[a20addr])) = * (Bit8u *) data;
|
|
BX_DBG_DIRTY_PAGE(a20addr >> 12);
|
|
return;
|
|
}
|
|
// len == other, just fall thru to special cases handling
|
|
}
|
|
|
|
#ifdef BX_LITTLE_ENDIAN
|
|
data_ptr = (Bit8u *) data;
|
|
#else // BX_BIG_ENDIAN
|
|
data_ptr = (Bit8u *) data + (len - 1);
|
|
#endif
|
|
|
|
write_one:
|
|
if ( (a20addr & 0xfff80000) != 0x00080000 ) {
|
|
// addr *not* in range 00080000 .. 000FFFFF
|
|
vector[a20addr] = *data_ptr;
|
|
BX_DBG_DIRTY_PAGE(a20addr >> 12);
|
|
inc_one:
|
|
if (len == 1) return;
|
|
len--;
|
|
a20addr++;
|
|
#ifdef BX_LITTLE_ENDIAN
|
|
data_ptr++;
|
|
#else // BX_BIG_ENDIAN
|
|
data_ptr--;
|
|
#endif
|
|
goto write_one;
|
|
}
|
|
|
|
// addr in range 00080000 .. 000FFFFF
|
|
|
|
if (a20addr <= 0x0009ffff) {
|
|
// regular memory 80000 .. 9FFFF
|
|
vector[a20addr] = *data_ptr;
|
|
BX_DBG_DIRTY_PAGE(a20addr >> 12);
|
|
goto inc_one;
|
|
}
|
|
// adapter ROM C0000 .. DFFFF
|
|
// ROM BIOS memory E0000 .. FFFFF
|
|
#if BX_SUPPORT_PCI == 0
|
|
// ignore write to ROM
|
|
#else
|
|
// Write Based on 440fx Programming
|
|
if ( bx_options.Oi440FXSupport->get () &&
|
|
((a20addr & 0xfffc0000) == 0x000c0000) )
|
|
{
|
|
switch (DEV_pci_wr_memtype(a20addr & 0xFC000)) {
|
|
case 0x1: // Writes to ShadowRAM
|
|
BX_DEBUG(("Writing to ShadowRAM: address %08x, data %02x", (unsigned) a20addr, *data_ptr));
|
|
vector[a20addr] = *data_ptr;
|
|
BX_DBG_DIRTY_PAGE(a20addr >> 12);
|
|
goto inc_one;
|
|
|
|
case 0x0: // Writes to ROM, Inhibit
|
|
BX_DEBUG(("Write to ROM ignored: address %08x, data %02x", (unsigned) a20addr, *data_ptr));
|
|
goto inc_one;
|
|
|
|
default:
|
|
BX_PANIC(("writePhysicalPage: default case"));
|
|
goto inc_one;
|
|
}
|
|
}
|
|
#endif
|
|
goto inc_one;
|
|
}
|
|
else {
|
|
// some or all of data is outside limits of physical memory
|
|
|
|
#ifdef BX_LITTLE_ENDIAN
|
|
data_ptr = (Bit8u *) data;
|
|
#else // BX_BIG_ENDIAN
|
|
data_ptr = (Bit8u *) data + (len - 1);
|
|
#endif
|
|
|
|
for (unsigned i = 0; i < len; i++) {
|
|
if (a20addr < BX_MEM_THIS len) {
|
|
vector[a20addr] = *data_ptr;
|
|
BX_DBG_DIRTY_PAGE(a20addr >> 12);
|
|
}
|
|
// otherwise ignore byte, since it overruns memory
|
|
addr++;
|
|
a20addr = (addr);
|
|
#ifdef BX_LITTLE_ENDIAN
|
|
data_ptr++;
|
|
#else // BX_BIG_ENDIAN
|
|
data_ptr--;
|
|
#endif
|
|
}
|
|
}
|
|
}
|
|
|
|
void BX_CPP_AttrRegparmN(3)
|
|
BX_MEM_C::readPhysicalPage(BX_CPU_C *cpu, Bit32u addr, unsigned len, void *data)
|
|
{
|
|
Bit8u *data_ptr;
|
|
Bit32u a20addr;
|
|
|
|
#if BX_SUPPORT_IODEBUG
|
|
bx_iodebug_c::mem_read(cpu, addr, len, data);
|
|
#endif
|
|
|
|
a20addr = A20ADDR(addr);
|
|
BX_INSTR_PHY_READ(cpu->which_cpu(), a20addr, len);
|
|
|
|
#if BX_DEBUGGER
|
|
// (mch) Check for physical read break points, TODO
|
|
// (bbd) Each breakpoint should have an associated CPU#, TODO
|
|
for (int i = 0; i < num_read_watchpoints; i++)
|
|
if (read_watchpoint[i] == a20addr) {
|
|
BX_CPU(0)->watchpoint = a20addr;
|
|
BX_CPU(0)->break_point = BREAK_POINT_READ;
|
|
break;
|
|
}
|
|
#endif
|
|
|
|
struct memory_handler_struct *memory_handler = memory_handlers[a20addr >> 20];
|
|
while (memory_handler) {
|
|
if (memory_handler->begin <= a20addr &&
|
|
memory_handler->end >= a20addr &&
|
|
memory_handler->read_handler(a20addr, len, data, memory_handler->read_param))
|
|
{
|
|
return;
|
|
}
|
|
memory_handler = memory_handler->next;
|
|
}
|
|
|
|
#if BX_SUPPORT_APIC
|
|
bx_generic_apic_c *local_apic = &cpu->local_apic;
|
|
bx_generic_apic_c *ioapic = bx_devices.ioapic;
|
|
if (local_apic->is_selected (addr, len)) {
|
|
local_apic->read (addr, data, len);
|
|
return;
|
|
}
|
|
if (ioapic->is_selected (addr, len)) {
|
|
ioapic->read (addr, data, len);
|
|
return;
|
|
}
|
|
#endif
|
|
|
|
if ( (a20addr + len) <= BX_MEM_THIS len ) {
|
|
// all of data is within limits of physical memory
|
|
if ( (a20addr & 0xfff80000) != 0x00080000 ) {
|
|
if (len == 4) {
|
|
ReadHostDWordFromLittleEndian(&vector[a20addr], * (Bit32u*) data);
|
|
return;
|
|
}
|
|
if (len == 2) {
|
|
ReadHostWordFromLittleEndian(&vector[a20addr], * (Bit16u*) data);
|
|
return;
|
|
}
|
|
if (len == 1) {
|
|
* (Bit8u *) data = * ((Bit8u *) (&vector[a20addr]));
|
|
return;
|
|
}
|
|
// len == 3 case can just fall thru to special cases handling
|
|
}
|
|
|
|
|
|
#ifdef BX_LITTLE_ENDIAN
|
|
data_ptr = (Bit8u *) data;
|
|
#else // BX_BIG_ENDIAN
|
|
data_ptr = (Bit8u *) data + (len - 1);
|
|
#endif
|
|
|
|
read_one:
|
|
if ( (a20addr & 0xfff80000) != 0x00080000 ) {
|
|
// addr *not* in range 00080000 .. 000FFFFF
|
|
*data_ptr = vector[a20addr];
|
|
inc_one:
|
|
if (len == 1) return;
|
|
len--;
|
|
a20addr++;
|
|
#ifdef BX_LITTLE_ENDIAN
|
|
data_ptr++;
|
|
#else // BX_BIG_ENDIAN
|
|
data_ptr--;
|
|
#endif
|
|
goto read_one;
|
|
}
|
|
|
|
// addr in range 00080000 .. 000FFFFF
|
|
#if BX_SUPPORT_PCI
|
|
if ( bx_options.Oi440FXSupport->get () &&
|
|
((a20addr & 0xfffc0000) == 0x000c0000) )
|
|
{
|
|
switch (DEV_pci_rd_memtype (a20addr)) {
|
|
case 0x0: // Read from ROM
|
|
if ( (a20addr & 0xfffe0000) == 0x000e0000 )
|
|
{
|
|
*data_ptr = rom[a20addr & BIOS_MASK];
|
|
}
|
|
else
|
|
{
|
|
*data_ptr = rom[(a20addr & EXROM_MASK) + BIOSROMSZ];
|
|
}
|
|
goto inc_one;
|
|
case 0x1: // Read from ShadowRAM
|
|
*data_ptr = vector[a20addr];
|
|
goto inc_one;
|
|
default:
|
|
BX_PANIC(("readPhysicalPage: default case"));
|
|
}
|
|
goto inc_one;
|
|
}
|
|
else
|
|
#endif // #if BX_SUPPORT_PCI
|
|
{
|
|
if ( (a20addr & 0xfffc0000) != 0x000c0000 ) {
|
|
*data_ptr = vector[a20addr];
|
|
}
|
|
else if ( (a20addr & 0xfffe0000) == 0x000e0000 )
|
|
{
|
|
*data_ptr = rom[a20addr & BIOS_MASK];
|
|
}
|
|
else
|
|
{
|
|
*data_ptr = rom[(a20addr & EXROM_MASK) + BIOSROMSZ];
|
|
}
|
|
goto inc_one;
|
|
}
|
|
}
|
|
else
|
|
{ // some or all of data is outside limits of physical memory
|
|
|
|
#ifdef BX_LITTLE_ENDIAN
|
|
data_ptr = (Bit8u *) data;
|
|
#else // BX_BIG_ENDIAN
|
|
data_ptr = (Bit8u *) data + (len - 1);
|
|
#endif
|
|
|
|
for (unsigned i = 0; i < len; i++) {
|
|
if (a20addr < BX_MEM_THIS len)
|
|
*data_ptr = vector[a20addr];
|
|
else if (a20addr >= (Bit32u)~BIOS_MASK)
|
|
*data_ptr = rom[a20addr & BIOS_MASK];
|
|
else
|
|
*data_ptr = 0xff;
|
|
addr++;
|
|
a20addr = (addr);
|
|
#ifdef BX_LITTLE_ENDIAN
|
|
data_ptr++;
|
|
#else // BX_BIG_ENDIAN
|
|
data_ptr--;
|
|
#endif
|
|
}
|
|
}
|
|
}
|
|
|
|
#endif // #if BX_PROVIDE_CPU_MEMORY
|