[Project64] Cleanup FlashRam.cpp

This commit is contained in:
zilmar 2015-12-13 18:10:40 +11:00
parent 29d693ba1f
commit abcfe60a51
2 changed files with 195 additions and 197 deletions

View File

@ -15,232 +15,230 @@
#include <Common/path.h> #include <Common/path.h>
#include <Windows.h> #include <Windows.h>
CFlashram::CFlashram(bool ReadOnly): CFlashram::CFlashram(bool ReadOnly) :
m_FlashRamPointer(NULL), m_FlashRamPointer(NULL),
m_FlashFlag(FLASHRAM_MODE_NOPES), m_FlashFlag(FLASHRAM_MODE_NOPES),
m_FlashStatus(0), m_FlashStatus(0),
m_FlashRAM_Offset(0), m_FlashRAM_Offset(0),
m_ReadOnly(ReadOnly), m_ReadOnly(ReadOnly),
m_hFile(NULL) m_hFile(NULL)
{ {
} }
CFlashram::~CFlashram() CFlashram::~CFlashram()
{ {
if (m_hFile) if (m_hFile)
{ {
CloseHandle(m_hFile); CloseHandle(m_hFile);
m_hFile = NULL; m_hFile = NULL;
} }
} }
void CFlashram::DmaFromFlashram(uint8_t * dest, int StartOffset, int len) void CFlashram::DmaFromFlashram(uint8_t * dest, int StartOffset, int len)
{ {
uint8_t FlipBuffer[0x10000]; uint8_t FlipBuffer[0x10000];
uint32_t count; uint32_t count;
switch (m_FlashFlag) switch (m_FlashFlag)
{ {
case FLASHRAM_MODE_READ: case FLASHRAM_MODE_READ:
if (m_hFile == NULL) if (m_hFile == NULL)
{ {
if (!LoadFlashram()) if (!LoadFlashram())
{ {
return; return;
} }
} }
if (len > 0x10000) if (len > 0x10000)
{ {
if (bHaveDebugger()) if (bHaveDebugger())
{ {
g_Notify->DisplayError(stdstr_f(__FUNCTION__ ": DmaFromFlashram FlipBuffer to small (len: %d)", len).ToUTF16().c_str()); g_Notify->DisplayError(stdstr_f(__FUNCTION__ ": DmaFromFlashram FlipBuffer to small (len: %d)", len).ToUTF16().c_str());
} }
len = 0x10000; len = 0x10000;
} }
if ((len & 3) != 0) if ((len & 3) != 0)
{ {
if (bHaveDebugger()) if (bHaveDebugger())
{ {
g_Notify->DisplayError(__FUNCTIONW__ L": Unaligned flash ram read ???"); g_Notify->DisplayError(__FUNCTIONW__ L": Unaligned flash ram read ???");
} }
return; return;
} }
memset(FlipBuffer,0,sizeof(FlipBuffer)); memset(FlipBuffer, 0, sizeof(FlipBuffer));
StartOffset = StartOffset << 1; StartOffset = StartOffset << 1;
SetFilePointer(m_hFile,StartOffset,NULL,FILE_BEGIN); SetFilePointer(m_hFile, StartOffset, NULL, FILE_BEGIN);
DWORD dwRead; DWORD dwRead;
ReadFile(m_hFile,FlipBuffer,len,&dwRead,NULL); ReadFile(m_hFile, FlipBuffer, len, &dwRead, NULL);
for (count = dwRead; (int)count < len; count ++) for (count = dwRead; (int)count < len; count++)
{ {
FlipBuffer[count] = 0xFF; FlipBuffer[count] = 0xFF;
} }
for (count = 0; (int)count < len; count += 4) for (count = 0; (int)count < len; count += 4)
{ {
register uint32_t eax; register uint32_t eax;
eax = *(uint32_t *)&FlipBuffer[count]; eax = *(uint32_t *)&FlipBuffer[count];
// eax = swap32by8(eax); // ; bswap eax // eax = swap32by8(eax); // ; bswap eax
*(uint32_t *)(dest + count) = eax; *(uint32_t *)(dest + count) = eax;
} }
break; break;
case FLASHRAM_MODE_STATUS: case FLASHRAM_MODE_STATUS:
if (StartOffset != 0 && len != 8) if (StartOffset != 0 && len != 8)
{ {
if (bHaveDebugger()) if (bHaveDebugger())
{ {
g_Notify->DisplayError(stdstr_f(__FUNCTION__ ": Reading m_FlashStatus not being handled correctly\nStart: %X len: %X", StartOffset, len).ToUTF16().c_str()); g_Notify->DisplayError(stdstr_f(__FUNCTION__ ": Reading m_FlashStatus not being handled correctly\nStart: %X len: %X", StartOffset, len).ToUTF16().c_str());
} }
} }
*((uint32_t *)(dest)) = (uint32_t)((m_FlashStatus >> 32) & 0xFFFFFFFF); *((uint32_t *)(dest)) = (uint32_t)((m_FlashStatus >> 32) & 0xFFFFFFFF);
*((uint32_t *)(dest)+1) = (uint32_t)(m_FlashStatus & 0xFFFFFFFF); *((uint32_t *)(dest)+1) = (uint32_t)(m_FlashStatus & 0xFFFFFFFF);
break; break;
default: default:
if (bHaveDebugger()) if (bHaveDebugger())
{ {
g_Notify->DisplayError(stdstr_f(__FUNCTION__": Start: %X, Offset: %X len: %X",dest - g_MMU->Rdram(),StartOffset,len).ToUTF16().c_str()); g_Notify->DisplayError(stdstr_f(__FUNCTION__": Start: %X, Offset: %X len: %X", dest - g_MMU->Rdram(), StartOffset, len).ToUTF16().c_str());
} }
} }
} }
void CFlashram::DmaToFlashram(uint8_t * Source, int StartOffset, int len) void CFlashram::DmaToFlashram(uint8_t * Source, int StartOffset, int len)
{ {
switch (m_FlashFlag) switch (m_FlashFlag)
{ {
case FLASHRAM_MODE_WRITE: case FLASHRAM_MODE_WRITE:
m_FlashRamPointer = Source; m_FlashRamPointer = Source;
break; break;
default: default:
if (bHaveDebugger()) if (bHaveDebugger())
{ {
g_Notify->DisplayError(stdstr_f(__FUNCTION__ ": Start: %X, Offset: %X len: %X", Source - g_MMU->Rdram(), StartOffset, len).ToUTF16().c_str()); g_Notify->DisplayError(stdstr_f(__FUNCTION__ ": Start: %X, Offset: %X len: %X", Source - g_MMU->Rdram(), StartOffset, len).ToUTF16().c_str());
} }
} }
} }
uint32_t CFlashram::ReadFromFlashStatus(uint32_t PAddr) uint32_t CFlashram::ReadFromFlashStatus(uint32_t PAddr)
{ {
switch (PAddr) switch (PAddr)
{ {
case 0x08000000: return (uint32_t)(m_FlashStatus >> 32); case 0x08000000: return (uint32_t)(m_FlashStatus >> 32);
default: default:
if (bHaveDebugger()) if (bHaveDebugger())
{ {
g_Notify->DisplayError(stdstr_f(__FUNCTION__ ": PAddr (%X)", PAddr).ToUTF16().c_str()); g_Notify->DisplayError(stdstr_f(__FUNCTION__ ": PAddr (%X)", PAddr).ToUTF16().c_str());
} }
break; break;
} }
return (uint32_t)(m_FlashStatus >> 32); return (uint32_t)(m_FlashStatus >> 32);
} }
bool CFlashram::LoadFlashram() bool CFlashram::LoadFlashram()
{ {
CPath FileName; CPath FileName;
FileName.SetDriveDirectory( g_Settings->LoadStringVal(Directory_NativeSave).c_str()); FileName.SetDriveDirectory(g_Settings->LoadStringVal(Directory_NativeSave).c_str());
FileName.SetName(g_Settings->LoadStringVal(Game_GameName).c_str()); FileName.SetName(g_Settings->LoadStringVal(Game_GameName).c_str());
FileName.SetExtension("fla"); FileName.SetExtension("fla");
if (!FileName.DirectoryExists()) if (!FileName.DirectoryExists())
{ {
FileName.DirectoryCreate(); FileName.DirectoryCreate();
} }
m_hFile = CreateFile(FileName,m_ReadOnly ? GENERIC_READ : GENERIC_WRITE | GENERIC_READ, FILE_SHARE_READ | FILE_SHARE_WRITE,NULL,OPEN_ALWAYS, m_hFile = CreateFile(FileName, m_ReadOnly ? GENERIC_READ : GENERIC_WRITE | GENERIC_READ, FILE_SHARE_READ | FILE_SHARE_WRITE, NULL, OPEN_ALWAYS,
FILE_ATTRIBUTE_NORMAL | FILE_FLAG_RANDOM_ACCESS, NULL); FILE_ATTRIBUTE_NORMAL | FILE_FLAG_RANDOM_ACCESS, NULL);
if (m_hFile == INVALID_HANDLE_VALUE) if (m_hFile == INVALID_HANDLE_VALUE)
{ {
WriteTraceF(TraceError,__FUNCTION__ ": Failed to open (%s), ReadOnly = %d, LastError = %X",(LPCTSTR)FileName, m_ReadOnly, GetLastError()); WriteTraceF(TraceError, __FUNCTION__ ": Failed to open (%s), ReadOnly = %d, LastError = %X", (LPCTSTR)FileName, m_ReadOnly, GetLastError());
g_Notify->DisplayError(GS(MSG_FAIL_OPEN_FLASH)); g_Notify->DisplayError(GS(MSG_FAIL_OPEN_FLASH));
return false; return false;
} }
SetFilePointer(m_hFile,0,NULL,FILE_BEGIN); SetFilePointer(m_hFile, 0, NULL, FILE_BEGIN);
return true; return true;
} }
void CFlashram::WriteToFlashCommand(uint32_t FlashRAM_Command) void CFlashram::WriteToFlashCommand(uint32_t FlashRAM_Command)
{ {
uint8_t EmptyBlock[128]; uint8_t EmptyBlock[128];
DWORD dwWritten; DWORD dwWritten;
switch (FlashRAM_Command & 0xFF000000) switch (FlashRAM_Command & 0xFF000000)
{ {
case 0xD2000000: case 0xD2000000:
switch (m_FlashFlag) switch (m_FlashFlag)
{ {
case FLASHRAM_MODE_NOPES: break; case FLASHRAM_MODE_NOPES: break;
case FLASHRAM_MODE_READ: break; case FLASHRAM_MODE_READ: break;
case FLASHRAM_MODE_STATUS: break; case FLASHRAM_MODE_STATUS: break;
case FLASHRAM_MODE_ERASE: case FLASHRAM_MODE_ERASE:
memset(EmptyBlock,0xFF,sizeof(EmptyBlock)); memset(EmptyBlock, 0xFF, sizeof(EmptyBlock));
if (m_hFile == NULL) { if (m_hFile == NULL) {
if (!LoadFlashram()) if (!LoadFlashram())
{ {
return; return;
} }
} }
SetFilePointer(m_hFile,m_FlashRAM_Offset,NULL,FILE_BEGIN); SetFilePointer(m_hFile, m_FlashRAM_Offset, NULL, FILE_BEGIN);
WriteFile(m_hFile,EmptyBlock,128,&dwWritten,NULL); WriteFile(m_hFile, EmptyBlock, 128, &dwWritten, NULL);
break; break;
case FLASHRAM_MODE_WRITE: case FLASHRAM_MODE_WRITE:
if (m_hFile == NULL) { if (m_hFile == NULL) {
if (!LoadFlashram()) if (!LoadFlashram())
{ {
return; return;
} }
} }
{ {
uint8_t FlipBuffer[128]; uint8_t FlipBuffer[128];
register size_t edx; register size_t edx;
uint8_t * FlashRamPointer = m_FlashRamPointer; uint8_t * FlashRamPointer = m_FlashRamPointer;
memset(FlipBuffer,0,sizeof(FlipBuffer)); memset(FlipBuffer, 0, sizeof(FlipBuffer));
for (edx = 0; edx < 128; edx += 4) for (edx = 0; edx < 128; edx += 4)
{ {
register uint32_t eax; register uint32_t eax;
eax = *(unsigned __int32 *)&FlashRamPointer[edx]; eax = *(unsigned __int32 *)&FlashRamPointer[edx];
// eax = swap32by8(eax); // ; bswap eax // eax = swap32by8(eax); // ; bswap eax
*(unsigned __int32 *)(FlipBuffer + edx) = eax; *(unsigned __int32 *)(FlipBuffer + edx) = eax;
} }
SetFilePointer(m_hFile,m_FlashRAM_Offset,NULL,FILE_BEGIN); SetFilePointer(m_hFile, m_FlashRAM_Offset, NULL, FILE_BEGIN);
WriteFile(m_hFile,FlipBuffer,128,&dwWritten,NULL); WriteFile(m_hFile, FlipBuffer, 128, &dwWritten, NULL);
} }
break; break;
default: default:
g_Notify->DisplayError(stdstr_f("Writing %X to flash ram command register\nm_FlashFlag: %d",FlashRAM_Command,m_FlashFlag).ToUTF16().c_str()); g_Notify->DisplayError(stdstr_f("Writing %X to flash ram command register\nm_FlashFlag: %d", FlashRAM_Command, m_FlashFlag).ToUTF16().c_str());
} }
m_FlashFlag = FLASHRAM_MODE_NOPES; m_FlashFlag = FLASHRAM_MODE_NOPES;
break; break;
case 0xE1000000: case 0xE1000000:
m_FlashFlag = FLASHRAM_MODE_STATUS; m_FlashFlag = FLASHRAM_MODE_STATUS;
m_FlashStatus = 0x1111800100C2001E; m_FlashStatus = 0x1111800100C2001E;
break; break;
case 0xF0000000: case 0xF0000000:
m_FlashFlag = FLASHRAM_MODE_READ; m_FlashFlag = FLASHRAM_MODE_READ;
m_FlashStatus = 0x11118004F0000000; m_FlashStatus = 0x11118004F0000000;
break; break;
case 0x4B000000: case 0x4B000000:
m_FlashRAM_Offset = (FlashRAM_Command & 0xffff) * 128; m_FlashRAM_Offset = (FlashRAM_Command & 0xffff) * 128;
break; break;
case 0x78000000: case 0x78000000:
m_FlashFlag = FLASHRAM_MODE_ERASE; m_FlashFlag = FLASHRAM_MODE_ERASE;
m_FlashStatus = 0x1111800800C2001E; m_FlashStatus = 0x1111800800C2001E;
break; break;
case 0xB4000000: case 0xB4000000:
m_FlashFlag = FLASHRAM_MODE_WRITE; //???? m_FlashFlag = FLASHRAM_MODE_WRITE; //????
break; break;
case 0xA5000000: case 0xA5000000:
m_FlashRAM_Offset = (FlashRAM_Command & 0xffff) * 128; m_FlashRAM_Offset = (FlashRAM_Command & 0xffff) * 128;
m_FlashStatus = 0x1111800400C2001E; m_FlashStatus = 0x1111800400C2001E;
break; break;
default: default:
if (bHaveDebugger()) if (bHaveDebugger())
{ {
g_Notify->DisplayError(stdstr_f("Writing %X to flash ram command register",FlashRAM_Command).ToUTF16().c_str()); g_Notify->DisplayError(stdstr_f("Writing %X to flash ram command register", FlashRAM_Command).ToUTF16().c_str());
} }
} }
} }

View File

@ -12,25 +12,25 @@
#include <Project64-core/Settings/DebugSettings.h> #include <Project64-core/Settings/DebugSettings.h>
class CFlashram : class CFlashram :
private CDebugSettings private CDebugSettings
{ {
enum Modes enum Modes
{ {
FLASHRAM_MODE_NOPES = 0, FLASHRAM_MODE_NOPES = 0,
FLASHRAM_MODE_ERASE = 1, FLASHRAM_MODE_ERASE = 1,
FLASHRAM_MODE_WRITE = 2, FLASHRAM_MODE_WRITE = 2,
FLASHRAM_MODE_READ = 3, FLASHRAM_MODE_READ = 3,
FLASHRAM_MODE_STATUS = 4, FLASHRAM_MODE_STATUS = 4,
}; };
public: public:
CFlashram(bool ReadOnly); CFlashram(bool ReadOnly);
~CFlashram(); ~CFlashram();
void DmaFromFlashram ( uint8_t * dest, int StartOffset, int len ); void DmaFromFlashram(uint8_t * dest, int StartOffset, int len);
void DmaToFlashram ( uint8_t * Source, int StartOffset, int len ); void DmaToFlashram(uint8_t * Source, int StartOffset, int len);
uint32_t ReadFromFlashStatus ( uint32_t PAddr ); uint32_t ReadFromFlashStatus(uint32_t PAddr);
void WriteToFlashCommand ( uint32_t Value ); void WriteToFlashCommand(uint32_t Value);
private: private:
bool LoadFlashram(); bool LoadFlashram();