Leahnaya/savegame-manager
1
0
Fork 0
mirror of https://github.com/suloku/savegame-manager.git synced 2026-03-22 10:25:30 -05:00
Code Issues Actions Packages Projects Releases Wiki Activity
429c4c60c9
savegame-manager/arm9/source/dsCard.cpp

714 lines
18 KiB
C++
Raw Blame History

/*
* savegame_manager: a tool to backup and restore savegames from Nintendo
* DS cartridges. Nintendo DS and all derivative names are trademarks
* by Nintendo. EZFlash 3-in-1 is a trademark by EZFlash.
*
* dsCard.cpp: Functions for accessing an EZFlash 3-in-1.
*
* Copyright (C) EZFlash Group (2006)
* Copyright (C) Pokedoc (2010)
*/
/*
* 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.,
* 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
*/
#include "dscard.h"
#include "string.h"
#include <stdio.h>
#ifdef __cplusplus
extern "C" {
#endif
// This is set by "ReadNORFlashID", which *must* *always* be called before anything else!
uint32 ID;
//&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&&
//---------------------------------------------------
//DS ¿¨ »ù±¾²Ù×÷
void Enable_Arm9DS()
{
REG_EXMEMCNT &= ~0x0800;
//WAIT_CR &= ~0x0800;
}
void Enable_Arm7DS()
{
REG_EXMEMCNT |= 0x0800;
//WAIT_CR |= 0x0800;
}
void OpenNorWrite()
{
*(vuint16 *)0x9fe0000 = 0xd200;
*(vuint16 *)0x8000000 = 0x1500;
*(vuint16 *)0x8020000 = 0xd200;
*(vuint16 *)0x8040000 = 0x1500;
*(vuint16 *)0x9C40000 = 0x1500;
*(vuint16 *)0x9fc0000 = 0x1500;
}
void CloseNorWrite()
{
*(vuint16 *)0x9fe0000 = 0xd200;
*(vuint16 *)0x8000000 = 0x1500;
*(vuint16 *)0x8020000 = 0xd200;
*(vuint16 *)0x8040000 = 0x1500;
*(vuint16 *)0x9C40000 = 0xd200;
*(vuint16 *)0x9fc0000 = 0x1500;
}
void SetRompage(u16 page)
{
*(vuint16 *)0x9fe0000 = 0xd200;
*(vuint16 *)0x8000000 = 0x1500;
*(vuint16 *)0x8020000 = 0xd200;
*(vuint16 *)0x8040000 = 0x1500;
*(vuint16 *)0x9880000 = page;
*(vuint16 *)0x9fc0000 = 0x1500;
}
void SetRampage(u16 page)
{
*(vu16 *)0x9fe0000 = 0xd200;
*(vu16 *)0x8000000 = 0x1500;
*(vu16 *)0x8020000 = 0xd200;
*(vu16 *)0x8040000 = 0x1500;
*(vu16 *)0x9c00000 = page;
*(vu16 *)0x9fc0000 = 0x1500;
}
void SetSerialMode()
{
*(vu16 *)0x9fe0000 = 0xd200;
*(vu16 *)0x8000000 = 0x1500;
*(vu16 *)0x8020000 = 0xd200;
*(vu16 *)0x8040000 = 0x1500;
*(vu16 *)0x9A40000 = 0xe200;
*(vu16 *)0x9fc0000 = 0x1500;
}
uint32 ReadNorFlashID()
{
// This function was damaged on the original sample, "ID mode" was never left. It is fixed now.
vuint16 id1,id2,id3,id4;
ID=0;
//check intel 512M 3in1 card
*((vuint16 *)(FlashBase+0)) = 0xFF ;
*((vuint16 *)(FlashBase+0x1000*2)) = 0xFF ;
*((vuint16 *)(FlashBase+0)) = 0x90 ;
*((vuint16 *)(FlashBase+0x1000*2)) = 0x90 ;
id1 = *((vuint16 *)(FlashBase+0)) ;
id2 = *((vuint16 *)(FlashBase+0x1000*2)) ;
id3 = *((vuint16 *)(FlashBase+1*2)) ;
id4 = *((vuint16 *)(FlashBase+0x1001*2)) ;
if(id3==0x8810)
id3=0x8816;
if(id4==0x8810)
id4=0x8816;
if( (id1==0x89)&& (id2==0x89) &&(id3==0x8816) && (id4==0x8816))
{
ID = 0x89168916;
return 0x89168916;
}
//¼ì²â256M¿¨
*((vuint16 *)(FlashBase+0x555*2)) = 0xAA ;
*((vuint16 *)(FlashBase+0x2AA*2)) = 0x55 ;
*((vuint16 *)(FlashBase+0x555*2)) = 0x90 ;
*((vuint16 *)(FlashBase+0x1555*2)) = 0xAA ;
*((vuint16 *)(FlashBase+0x12AA*2)) = 0x55 ;
*((vuint16 *)(FlashBase+0x1555*2)) = 0x90 ;
id1 = *((vuint16 *)(FlashBase+0x2)) ;
id2 = *((vuint16 *)(FlashBase+0x2002)) ;
if( (id1!=0x227E)|| (id2!=0x227E)) {
*((vuint16 *)(FlashBase+0x555*2)) = 0xAA ;
*((vuint16 *)(FlashBase+0x2AA*2)) = 0x55 ;
*((vuint16 *)(FlashBase+0x555*2)) = 0xf0 ;
*((vuint16 *)(FlashBase+0x1555*2)) = 0xAA ;
*((vuint16 *)(FlashBase+0x12AA*2)) = 0x55 ;
*((vuint16 *)(FlashBase+0x1555*2)) = 0xf0 ;
return 0;
}
id1 = *((vuint16 *)(FlashBase+0xE*2)) ;
id2 = *((vuint16 *)(FlashBase+0x100e*2)) ;
if(id1==0x2218 && id2==0x2218) //H6H6
{
*((vuint16 *)(FlashBase+0x555*2)) = 0xAA ;
*((vuint16 *)(FlashBase+0x2AA*2)) = 0x55 ;
*((vuint16 *)(FlashBase+0x555*2)) = 0xf0 ;
*((vuint16 *)(FlashBase+0x1555*2)) = 0xAA ;
*((vuint16 *)(FlashBase+0x12AA*2)) = 0x55 ;
*((vuint16 *)(FlashBase+0x1555*2)) = 0xf0 ;
ID = 0x227E2218;
return 0x227E2218;
}
if(id1==0x2202 && id2==0x2202) //VZ064
{
*((vuint16 *)(FlashBase+0x555*2)) = 0xAA ;
*((vuint16 *)(FlashBase+0x2AA*2)) = 0x55 ;
*((vuint16 *)(FlashBase+0x555*2)) = 0xf0 ;
*((vuint16 *)(FlashBase+0x1555*2)) = 0xAA ;
*((vuint16 *)(FlashBase+0x12AA*2)) = 0x55 ;
*((vuint16 *)(FlashBase+0x1555*2)) = 0xf0 ;
ID = 0x227E2202;
return 0x227E2202;
}
if(id1==0x2202 && id2==0x2220) //VZ064
{
*((vuint16 *)(FlashBase+0x555*2)) = 0xAA ;
*((vuint16 *)(FlashBase+0x2AA*2)) = 0x55 ;
*((vuint16 *)(FlashBase+0x555*2)) = 0xf0 ;
*((vuint16 *)(FlashBase+0x1555*2)) = 0xAA ;
*((vuint16 *)(FlashBase+0x12AA*2)) = 0x55 ;
*((vuint16 *)(FlashBase+0x1555*2)) = 0xf0 ;
ID = 0x227E2202;
return 0x227E2202;
}
if(id1==0x2202 && id2==0x2215) //VZ064
{
*((vuint16 *)(FlashBase+0x555*2)) = 0xAA ;
*((vuint16 *)(FlashBase+0x2AA*2)) = 0x55 ;
*((vuint16 *)(FlashBase+0x555*2)) = 0xf0 ;
*((vuint16 *)(FlashBase+0x1555*2)) = 0xAA ;
*((vuint16 *)(FlashBase+0x12AA*2)) = 0x55 ;
*((vuint16 *)(FlashBase+0x1555*2)) = 0xf0 ;
ID = 0x227E2202;
return 0x227E2202;
}
return 0;
}
void chip_reset()
{
if(ID==0x89168916)
{
*((vuint16 *)(FlashBase+0)) = 0x50 ;
*((vuint16 *)(FlashBase+0x1000*2)) = 0x50 ;
*((vuint16 *)(FlashBase+0)) = 0xFF ;
*((vuint16 *)(FlashBase+0x1000*2)) = 0xFF ;
return;
}
*((vu16 *)(FlashBase)) = 0xF0 ;
*((vu16 *)(FlashBase+0x1000*2)) = 0xF0 ;
if(ID==0x227E2202)
{
*((vu16 *)(FlashBase+0x1000000)) = 0xF0 ;
*((vu16 *)(FlashBase+0x1000000+0x1000*2)) = 0xF0 ;
}
}
void Block_EraseIntel(u32 blockAdd)
{
u32 loop;
vu16 v1,v2;
bool b512=false;
if(blockAdd>=0x2000000)
{
blockAdd-=0x2000000;
CloseNorWrite();
SetRompage(768);
OpenNorWrite();
b512=true;
}
else
{
CloseNorWrite();
SetRompage(0);
OpenNorWrite();
}
if(blockAdd==0)
{
for(loop=0;loop<0x40000;loop+=0x10000)
{
*((vu16 *)(FlashBase+loop)) = 0x50 ;
*((vu16 *)(FlashBase+loop+0x2000)) = 0x50 ;
*((vu16 *)(FlashBase+loop)) = 0xFF ;
*((vu16 *)(FlashBase+loop+0x2000)) = 0xFF ;
*((vu16 *)(FlashBase+loop)) = 0x60 ;
*((vu16 *)(FlashBase+loop+0x2000)) = 0x60;
*((vu16 *)(FlashBase+loop)) = 0xD0 ;
*((vu16 *)(FlashBase+loop+0x2000)) = 0xD0;
*((vu16 *)(FlashBase+loop)) = 0x20 ;
*((vu16 *)(FlashBase+loop+0x2000)) = 0x20;
*((vu16 *)(FlashBase+loop)) = 0xD0 ;
*((vu16 *)(FlashBase+loop+0x2000)) = 0xD0;
do
{
v1 = *((vu16 *)(FlashBase+loop));
v2 = *((vu16 *)(FlashBase+loop+0x2000));
}
while((v1!=0x80)||(v2!=0x80));
}
}
else
{
*((vu16 *)(FlashBase+blockAdd)) = 0xFF ;
*((vu16 *)(FlashBase+blockAdd+0x2000)) = 0xFF ;
*((vu16 *)(FlashBase+blockAdd)) = 0x60 ;
*((vu16 *)(FlashBase+blockAdd+0x2000)) = 0x60 ;
*((vu16 *)(FlashBase+blockAdd)) = 0xD0 ;
*((vu16 *)(FlashBase+blockAdd+0x2000)) = 0xD0 ;
*((vu16 *)(FlashBase+blockAdd)) = 0x20 ;
*((vu16 *)(FlashBase+blockAdd+0x2000)) = 0x20 ;
*((vu16 *)(FlashBase+blockAdd)) = 0xD0 ;
*((vu16 *)(FlashBase+blockAdd+0x2000)) = 0xD0 ;
do
{
v1 = *((vu16 *)(FlashBase+blockAdd));
v2 = *((vu16 *)(FlashBase+blockAdd+0x2000));
}
while((v1!=0x80)||(v2!=0x80));
}
if(b512)
{
CloseNorWrite();
SetRompage(0);
OpenNorWrite();
b512=true;
}
}
void Block_Erase(u32 blockAdd)
{
vu16 v1,v2;
u32 Address;
u32 loop;
u32 off=0;
if(ID==0x89168916)
{
//intel 512 card
Block_EraseIntel(blockAdd);
return ;
}
if( (blockAdd>=0x1000000) && (ID==0x227E2202))
{
off=0x1000000;
*((vu16 *)(FlashBase+off+0x555*2)) = 0xF0 ;
*((vu16 *)(FlashBase+off+0x1555*2)) = 0xF0 ;
}
else
off=0;
Address=blockAdd;
*((vu16 *)(FlashBase+0x555*2)) = 0xF0 ;
*((vu16 *)(FlashBase+0x1555*2)) = 0xF0 ;
if( (blockAdd==0) || (blockAdd==0x1FC0000) || (blockAdd==0xFC0000) || (blockAdd==0x1000000))
{
for(loop=0;loop<0x40000;loop+=0x8000)
{
*((vu16 *)(FlashBase+off+0x555*2)) = 0xAA ;
*((vu16 *)(FlashBase+off+0x2AA*2)) = 0x55 ;
*((vu16 *)(FlashBase+off+0x555*2)) = 0x80 ;
*((vu16 *)(FlashBase+off+0x555*2)) = 0xAA ;
*((vu16 *)(FlashBase+off+0x2AA*2)) = 0x55 ;
*((vu16 *)(FlashBase+Address+loop)) = 0x30 ;
*((vu16 *)(FlashBase+off+0x1555*2)) = 0xAA ;
*((vu16 *)(FlashBase+off+0x12AA*2)) = 0x55 ;
*((vu16 *)(FlashBase+off+0x1555*2)) = 0x80 ;
*((vu16 *)(FlashBase+off+0x1555*2)) = 0xAA ;
*((vu16 *)(FlashBase+off+0x12AA*2)) = 0x55 ;
*((vu16 *)(FlashBase+Address+loop+0x2000)) = 0x30 ;
*((vu16 *)(FlashBase+off+0x2555*2)) = 0xAA ;
*((vu16 *)(FlashBase+off+0x22AA*2)) = 0x55 ;
*((vu16 *)(FlashBase+off+0x2555*2)) = 0x80 ;
*((vu16 *)(FlashBase+off+0x2555*2)) = 0xAA ;
*((vu16 *)(FlashBase+off+0x22AA*2)) = 0x55 ;
*((vu16 *)(FlashBase+Address+loop+0x4000)) = 0x30 ;
*((vu16 *)(FlashBase+off+0x3555*2)) = 0xAA ;
*((vu16 *)(FlashBase+off+0x32AA*2)) = 0x55 ;
*((vu16 *)(FlashBase+off+0x3555*2)) = 0x80 ;
*((vu16 *)(FlashBase+off+0x3555*2)) = 0xAA ;
*((vu16 *)(FlashBase+off+0x32AA*2)) = 0x55 ;
*((vu16 *)(FlashBase+Address+loop+0x6000)) = 0x30 ;
do
{
v1 = *((vu16 *)(FlashBase+Address+loop)) ;
v2 = *((vu16 *)(FlashBase+Address+loop)) ;
}while(v1!=v2);
do
{
v1 = *((vu16 *)(FlashBase+Address+loop+0x2000)) ;
v2 = *((vu16 *)(FlashBase+Address+loop+0x2000)) ;
}while(v1!=v2);
do
{
v1 = *((vu16 *)(FlashBase+Address+loop+0x4000)) ;
v2 = *((vu16 *)(FlashBase+Address+loop+0x4000)) ;
}while(v1!=v2);
do
{
v1 = *((vu16 *)(FlashBase+Address+loop+0x6000)) ;
v2 = *((vu16 *)(FlashBase+Address+loop+0x6000)) ;
}while(v1!=v2);
}
}
else
{
*((vu16 *)(FlashBase+off+0x555*2)) = 0xAA ;
*((vu16 *)(FlashBase+off+0x2AA*2)) = 0x55 ;
*((vu16 *)(FlashBase+off+0x555*2)) = 0x80 ;
*((vu16 *)(FlashBase+off+0x555*2)) = 0xAA ;
*((vu16 *)(FlashBase+off+0x2AA*2)) = 0x55;
*((vu16 *)(FlashBase+Address)) = 0x30 ;
*((vu16 *)(FlashBase+off+0x1555*2)) = 0xAA ;
*((vu16 *)(FlashBase+off+0x12AA*2)) = 0x55 ;
*((vu16 *)(FlashBase+off+0x1555*2)) = 0x80 ;
*((vu16 *)(FlashBase+off+0x1555*2)) = 0xAA ;
*((vu16 *)(FlashBase+off+0x12AA*2)) = 0x55 ;
*((vu16 *)(FlashBase+Address+0x2000)) = 0x30 ;
do
{
v1 = *((vu16 *)(FlashBase+Address)) ;
v2 = *((vu16 *)(FlashBase+Address)) ;
}while(v1!=v2);
do
{
v1 = *((vu16 *)(FlashBase+Address+0x2000)) ;
v2 = *((vu16 *)(FlashBase+Address+0x2000)) ;
}while(v1!=v2);
*((vu16 *)(FlashBase+off+0x555*2)) = 0xAA ;
*((vu16 *)(FlashBase+off+0x2AA*2)) = 0x55 ;
*((vu16 *)(FlashBase+off+0x555*2)) = 0x80 ;
*((vu16 *)(FlashBase+off+0x555*2)) = 0xAA ;
*((vu16 *)(FlashBase+off+0x2AA*2)) = 0x55;
*((vu16 *)(FlashBase+Address+0x20000)) = 0x30 ;
*((vu16 *)(FlashBase+off+0x1555*2)) = 0xAA ;
*((vu16 *)(FlashBase+off+0x12AA*2)) = 0x55 ;
*((vu16 *)(FlashBase+off+0x1555*2)) = 0x80 ;
*((vu16 *)(FlashBase+off+0x1555*2)) = 0xAA ;
*((vu16 *)(FlashBase+off+0x12AA*2)) = 0x55 ;
*((vu16 *)(FlashBase+Address+0x2000+0x20000)) = 0x30 ;
do
{
v1 = *((vu16 *)(FlashBase+Address+0x20000)) ;
v2 = *((vu16 *)(FlashBase+Address+0x20000)) ;
}while(v1!=v2);
do
{
v1 = *((vu16 *)(FlashBase+Address+0x2000+0x20000)) ;
v2 = *((vu16 *)(FlashBase+Address+0x2000+0x20000)) ;
}while(v1!=v2);
}
}
void ReadNorFlash(u8* pBuf,u32 address,u16 len)
{
vu16 *p = (vu16 *)pBuf;
u32 loop;
bool b512=false;
if(address>=0x2000000)//256M
{
CloseNorWrite();
SetRompage(768);
address-=0x2000000;
b512=true;
}
else
{
CloseNorWrite();
SetRompage(0);
}
Enable_Arm7DS();
OpenNorWrite();
if(ID==0x89168916)
{
*((vuint16 *)(FlashBase+address)) = 0x50 ;
*((vuint16 *)(FlashBase+address+0x1000*2)) = 0x50 ;
*((vuint16 *)(FlashBase+address)) = 0xFF ;
*((vuint16 *)(FlashBase+address+0x1000*2)) = 0xFF ;
}
for(loop=0;loop<len/2;loop++)
{
p[loop]=*((vu16 *)(FlashBase+address+loop*2) );
}
CloseNorWrite();
Enable_Arm9DS();
if(b512==true)
{
SetRompage(0);
}
}
void WriteNorFlashINTEL(u32 address,u8 *buffer,u32 size)
{
u32 mapaddress;
u32 size2,lop,j;
vu16* buf = (vu16*)buffer ;
register u32 loopwrite,i ;
vu16 v1,v2;
bool b512=false;
if(address>=0x2000000)
{
address-=0x2000000;
CloseNorWrite();
SetRompage(768);
OpenNorWrite();
b512=true;
}
else
{
CloseNorWrite();
SetRompage(0);
OpenNorWrite();
}
if(size>0x4000)
{
size2 = size >>1 ;
lop = 2;
}
else
{
size2 = size ;
lop = 1;
}
mapaddress = address;
// _consolePrintf("WriteNorFlashINTEL begin\n");
for(j=0;j<lop;j++)
{
if(j!=0)
{
mapaddress += 0x4000;
buf = (vu16*)(buffer+0x4000);
}
for(loopwrite=0;loopwrite<(size2);loopwrite+=64)
{
// _consolePrintf("WriteNorFlashINTEL begin 1\n");
*((vu16 *)(FlashBase+mapaddress+(loopwrite>>1))) = 0x50;
*((vu16 *)(FlashBase+mapaddress+(loopwrite>>1)+0x2000)) = 0x50;
*((vu16 *)(FlashBase+mapaddress+(loopwrite>>1))) = 0xFF;
*((vu16 *)(FlashBase+mapaddress+(loopwrite>>1)+0x2000)) = 0xFF;
*((vu16 *)(FlashBase+mapaddress+(loopwrite>>1))) = 0xE8;
*((vu16 *)(FlashBase+mapaddress+(loopwrite>>1)+0x2000)) = 0xE8;
*((vu16 *)(FlashBase+mapaddress+(loopwrite>>1))) = 0x70;
*((vu16 *)(FlashBase+mapaddress+(loopwrite>>1)+0x2000)) = 0x70;
v1=v2=0;
while((v1!= 0x80) || (v2 != 0x80) )
{
v1 = *((vu16 *)(FlashBase+mapaddress+(loopwrite>>1))) ;
v2 = *((vu16 *)(FlashBase+mapaddress+(loopwrite>>1)+0x2000)) ;
}
*((vu16 *)(FlashBase+mapaddress+(loopwrite>>1))) = 0x0F;
*((vu16 *)(FlashBase+mapaddress+(loopwrite>>1)+0x2000)) = 0x0F;
for(i=0;i<0x10;i++)
{
*((vu16 *)(FlashBase+mapaddress+(loopwrite>>1)+i*2)) = buf[(loopwrite>>2)+i];
*((vu16 *)(FlashBase+mapaddress+0x2000+(loopwrite>>1)+i*2)) = buf[0x1000+(loopwrite>>2)+i];
}
*((vu16 *)(FlashBase+mapaddress+(loopwrite>>1))) = 0xD0;
*((vu16 *)(FlashBase+mapaddress+(loopwrite>>1)+0x2000)) = 0xD0;
v1=v2=0;
// _consolePrintf("WriteNorFlashINTEL begin 2\n");
while((v1!= 0x80) || (v2 != 0x80) )
{
v1 = *((vu16 *)(FlashBase+mapaddress+(loopwrite>>1))) ;
v2 = *((vu16 *)(FlashBase+mapaddress+(loopwrite>>1)+0x2000)) ;
if( (v1==0x90) || (v2==0x90))
{
WriteSram(0xA000000,(u8 *)buf,0x8000);
// _consolePrintf("Err \n");
while(1);
break;
}
}
// _consolePrintf("WriteNorFlashINTEL begin 3\n");
}
}
if(b512==true)
{
CloseNorWrite();
SetRompage(0);
OpenNorWrite();
}
}
void WriteNorFlash(u32 address,u8 *buffer,u32 size)
{
if(ID==0x89168916)
{
WriteNorFlashINTEL(address,buffer,size);
return;
}
CloseNorWrite();
SetRompage(0);
OpenNorWrite();
vu16 v1,v2;
register u32 loopwrite ;
vu16* buf = (vu16*)buffer ;
u32 size2,lop;
u32 mapaddress;
u32 j;
v1=0;v2=1;
u32 off=0;
if( (address>=0x1000000) && (ID==0x227E2202))
{
off=0x1000000;
}
else
off=0;
if(size>0x4000)
{
size2 = size >>1 ;
lop = 2;
}
else
{
size2 = size ;
lop = 1;
}
mapaddress = address;
for(j=0;j<lop;j++)
{
if(j!=0)
{
mapaddress += 0x4000;
buf = (vu16*)(buffer+0x4000);
}
for(loopwrite=0;loopwrite<(size2>>2);loopwrite++)
{
*((vu16 *)(FlashBase+off+0x555*2)) = 0xAA ;
*((vu16 *)(FlashBase+off+0x2AA*2)) = 0x55 ;
*((vu16 *)(FlashBase+off+0x555*2)) = 0xA0 ;
*((vu16 *)(FlashBase+mapaddress+loopwrite*2)) = buf[loopwrite];
*((vu16 *)(FlashBase+off+0x1555*2)) = 0xAA ;
*((vu16 *)(FlashBase+off+0x12AA*2)) = 0x55 ;
*((vu16 *)(FlashBase+off+0x1555*2)) = 0xA0 ;
*((vu16 *)(FlashBase+mapaddress+0x2000+loopwrite*2)) = buf[0x1000+loopwrite];
do
{
v1 = *((vu16 *)(FlashBase+mapaddress+loopwrite*2)) ;
v2 = *((vu16 *)(FlashBase+mapaddress+loopwrite*2)) ;
}while(v1!=v2);
do
{
v1 = *((vu16 *)(FlashBase+mapaddress+0x2000+loopwrite*2)) ;
v2 = *((vu16 *)(FlashBase+mapaddress+0x2000+loopwrite*2)) ;
}while(v1!=v2);
}
}
}
void WriteSram(uint32 address, u8* data , uint32 size )
{
uint32 i ;
for(i=0;i<size;i++)
*(u8*)(address+i)=data[i];
}
void ReadSram(uint32 address, u8* data , uint32 size )
{
uint32 i ;
u16* pData = (u16*)data;
for(i=0;i<size;i+=2)
{
pData[i>>1]=*(u8*)(address+i)+(*(u8*)(address+i+1)*0x100);
}
}
void WritePSram(u8* address, u8* data , uint32 length )
{
vuint16 *pPatch=NULL;
pPatch=(vuint16*)address;
Enable_Arm7DS();
CloseNorWrite();
SetRompage(192);
OpenNorWrite();
for(u32 pi=0;pi<length;pi+=2)
{
pPatch[pi>>1]= data[pi] + (data[pi+1]<<8);
}
CloseNorWrite();
Enable_Arm9DS();
}
void ReadPSram(u8* address, u8* data , uint32 length )
{
vuint16 *pPatch=NULL;
pPatch=(vuint16*)address;
Enable_Arm7DS();
CloseNorWrite();
SetRompage(192);
OpenNorWrite();
for(u32 pi=0;pi<length;pi+=2)
{
data[pi]=pPatch[pi>>1] & 0xff;
data[pi+1]=(pPatch[pi>>1] &0xff00)>>8;
}
CloseNorWrite();
Enable_Arm9DS();
}
void OpenRamWrite()
{
*(vu16 *)0x9fe0000 = 0xd200;
*(vu16 *)0x8000000 = 0x1500;
*(vu16 *)0x8020000 = 0xd200;
*(vu16 *)0x8040000 = 0x1500;
*(vu16 *)0x9C40000 = 0xA500;
*(vu16 *)0x9fc0000 = 0x1500;
}
void CloseRamWrite()
{
*(vu16 *)0x9fe0000 = 0xd200;
*(vu16 *)0x8000000 = 0x1500;
*(vu16 *)0x8020000 = 0xd200;
*(vu16 *)0x8040000 = 0x1500;
*(vu16 *)0x9C40000 = 0xA200;
*(vu16 *)0x9fc0000 = 0x1500;
}
void SetShake(u16 data)
{
*(vuint16 *)0x9fe0000 = 0xd200;
*(vuint16 *)0x8000000 = 0x1500;
*(vuint16 *)0x8020000 = 0xd200;
*(vuint16 *)0x8040000 = 0x1500;
*(vuint16 *)0x9E20000 = data;
*(vuint16 *)0x9fc0000 = 0x1500;
}
#ifdef __cplusplus
}
#endif
Reference in New Issue View Git Blame Copy Permalink