mirror of
https://github.com/rvtr/TwlIPL.git
synced 2025-10-31 06:01:12 -04:00
6b8751037e
git-svn-id: file:///Users/lillianskinner/Downloads/platinum/twl/TwlIPL/trunk@2285 b08762b0-b915-fc4b-9d8c-17b2551a87ff
768 lines
22 KiB
C
768 lines
22 KiB
C
/*---------------------------------------------------------------------------*
|
||
Project: TwlSDK - demos - CARD - hotswDebug
|
||
File: main_finalize.c
|
||
|
||
Copyright 2007 Nintendo. All rights reserved.
|
||
|
||
These coded instructions, statements, and computer programs contain
|
||
proprietary information of Nintendo of America Inc. and/or Nintendo
|
||
Company Ltd., and are protected by Federal copyright law. They may
|
||
not be disclosed to third parties or copied or duplicated in any form,
|
||
in whole or in part, without the prior written consent of Nintendo.
|
||
*---------------------------------------------------------------------------*/
|
||
|
||
#include <twl.h>
|
||
#include <twl/os/common/format_rom.h>
|
||
#include "DEMO.h"
|
||
#include "hotswTypes.h"
|
||
#include "font.h"
|
||
|
||
#define SDK_MAKERCODE '10'
|
||
#define DIGEST_HASH_BLOCK_SIZE_SHA1 (512/8)
|
||
|
||
#define MY_TEMP_BUFFER_SIZE 0x80000
|
||
#define GAME_FIELD_START_ADDRESS 0x8000
|
||
|
||
#define ONE_SEGMENT_PAGE_NUM 8
|
||
|
||
#define READY_MASK 0x00800000
|
||
#define CARD_COMMAND_MASK 0x07000000
|
||
|
||
#define MY_ROMHEADER_TWL ((ROM_Header_Short *)HW_TWL_CARD_ROM_HEADER_BUF)
|
||
#define MY_ROMHEADER_NTR ((ROM_Header_Short *)HW_CARD_ROM_HEADER)
|
||
#define MY_ROMHEADER_NAND ((ROM_Header_Short *)HW_TWL_ROM_HEADER_BUF)
|
||
|
||
// ---------------------------------------------------------------
|
||
// HMACSHA1‚ÌŒ®
|
||
static u8 s_digestDefaultKey[ DIGEST_HASH_BLOCK_SIZE_SHA1 ] = {
|
||
0x21, 0x06, 0xc0, 0xde,
|
||
0xba, 0x98, 0xce, 0x3f,
|
||
0xa6, 0x92, 0xe3, 0x9d,
|
||
0x46, 0xf2, 0xed, 0x01,
|
||
|
||
0x76, 0xe3, 0xcc, 0x08,
|
||
0x56, 0x23, 0x63, 0xfa,
|
||
0xca, 0xd4, 0xec, 0xdf,
|
||
0x9a, 0x62, 0x78, 0x34,
|
||
|
||
0x8f, 0x6d, 0x63, 0x3c,
|
||
0xfe, 0x22, 0xca, 0x92,
|
||
0x20, 0x88, 0x97, 0x23,
|
||
0xd2, 0xcf, 0xae, 0xc2,
|
||
|
||
0x32, 0x67, 0x8d, 0xfe,
|
||
0xca, 0x83, 0x64, 0x98,
|
||
0xac, 0xfd, 0x3e, 0x37,
|
||
0x87, 0x46, 0x58, 0x24
|
||
};
|
||
|
||
static u32 rhBuf[BOOT_SEGMENT_SIZE/sizeof(u32)];
|
||
static u32 checkBuf[MY_TEMP_BUFFER_SIZE/sizeof(u32)];
|
||
|
||
static u16 card_lock_id;
|
||
static BOOL error, flxhash, ltdhash, romheader;
|
||
static BOOL isTwlApplication;
|
||
static BOOL isTwlCard;
|
||
static ROM_Header_Short *rh;
|
||
|
||
static u16 screen[32 * 32] ATTRIBUTE_ALIGN(HW_CACHE_LINE_SIZE);
|
||
|
||
// ---------------------------------------------------------------
|
||
static void CheckMirrorImage(void);
|
||
static int CompRomHeaderForNTR(void* buf);
|
||
static void CheckRomHeader(void);
|
||
static BOOL CheckHashValue(void* buf, u32 size, void* digest);
|
||
static void MY_LoadCard_arm7Static(void);
|
||
static void MY_LoadCard_arm7LtdStatic(void);
|
||
static void CheckBackupDevice(void);
|
||
static void ShowResult(void);
|
||
static void debugMessage(void);
|
||
|
||
static void ReadBootSegNormal(void* buf);
|
||
static void SetCommand(Cmd64 *cndLE);
|
||
static void ReadPageGame(u32 start_addr, void* buf, u32 size);
|
||
static void ReadCardData(void* dest, s32 offset, s32 length);
|
||
|
||
static void VBlankIntr (void);
|
||
static void PrintString (s16 x, s16 y, u8 palette, char *text, ...);
|
||
static void VolumeSwitchCallback(SNDEXResult result, void* arg);
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: NitroMain
|
||
|
||
Description: ƒ<>ƒCƒ“ ƒGƒ“ƒgƒŠƒ|ƒCƒ“ƒg.
|
||
*---------------------------------------------------------------------------*/
|
||
void NitroMain(void)
|
||
{
|
||
CARDRomHeader *card_header = (void*)CARD_GetRomHeader();
|
||
|
||
OS_Init();
|
||
OS_InitTick();
|
||
CARD_Init();
|
||
GX_Init();
|
||
GX_DispOff();
|
||
GXS_DispOff();
|
||
|
||
if ( card_header->maker_code == SDK_MAKERCODE )
|
||
{
|
||
CARD_Enable(TRUE);
|
||
}
|
||
|
||
/* •\Ž¦<C5BD>Ý’è<E28099>‰Šú‰» */
|
||
GX_SetBankForLCDC(GX_VRAM_LCDC_ALL);
|
||
MI_CpuClearFast((void*)HW_LCDC_VRAM, HW_LCDC_VRAM_SIZE);
|
||
(void)GX_DisableBankForLCDC();
|
||
MI_CpuFillFast((void*)HW_OAM, GX_LCD_SIZE_Y, HW_OAM_SIZE);
|
||
MI_CpuClearFast((void*)HW_PLTT, HW_PLTT_SIZE);
|
||
MI_CpuFillFast((void*)HW_DB_OAM, GX_LCD_SIZE_Y, HW_DB_OAM_SIZE);
|
||
MI_CpuClearFast((void*)HW_DB_PLTT, HW_DB_PLTT_SIZE);
|
||
GX_SetBankForBG(GX_VRAM_BG_128_A);
|
||
G2_SetBG0Control(GX_BG_SCRSIZE_TEXT_256x256,
|
||
GX_BG_COLORMODE_16,
|
||
GX_BG_SCRBASE_0xf800, // SCR ƒx<C692>[ƒXƒuƒ<75>ƒbƒN 31
|
||
GX_BG_CHARBASE_0x00000, // CHR ƒx<C692>[ƒXƒuƒ<75>ƒbƒN 0
|
||
GX_BG_EXTPLTT_01);
|
||
G2_SetBG0Priority(0);
|
||
GX_SetGraphicsMode(GX_DISPMODE_GRAPHICS, GX_BGMODE_0, GX_BG0_AS_2D);
|
||
GX_SetVisiblePlane(GX_PLANEMASK_BG0);
|
||
GX_LoadBG0Char(d_CharData, 0, sizeof(d_CharData));
|
||
GX_LoadBGPltt(d_PaletteData, 0, sizeof(d_PaletteData));
|
||
MI_CpuClearFast((void*)screen, sizeof(screen));
|
||
DC_FlushRange(screen, sizeof(screen));
|
||
GX_LoadBG0Scr(screen, 0, sizeof(screen));
|
||
|
||
/* Š„<C5A0>ž‚Ý<E2809A>Ý’è */
|
||
OS_SetIrqFunction(OS_IE_V_BLANK, VBlankIntr);
|
||
(void)OS_EnableIrqMask(OS_IE_V_BLANK);
|
||
(void)GX_VBlankIntr(TRUE);
|
||
(void)OS_EnableIrq();
|
||
(void)OS_EnableInterrupts();
|
||
|
||
/* LCD •\Ž¦ŠJŽn */
|
||
GX_DispOn();
|
||
GXS_DispOn();
|
||
|
||
PrintString(0, 0, 0xc, "+++ Card Access Check +++");
|
||
|
||
// NANDƒAƒvƒŠ‚ªHYB‚Ì<E2809A>ê<EFBFBD>‡
|
||
if(MY_ROMHEADER_NAND->platform_code == 0x02){
|
||
PrintString(0, 2, 0x5, "<HYBRID ver.>");
|
||
}
|
||
else if(MY_ROMHEADER_NAND->platform_code == 0x03){
|
||
PrintString(0, 2, 0x6, "<LIMITED ver.>");
|
||
}
|
||
|
||
// ƒJ<C692>[ƒhƒAƒvƒŠƒ^ƒCƒv‚ð”»•Ê<E280A2>BŽg‚¤Rom Header Buffer ‚ð<E2809A>Ø‘Ö‚¦‚é
|
||
if(MY_ROMHEADER_NTR->platform_code & PLATFORM_CODE_FLAG_TWL){
|
||
PrintString(0, 5, 0xf, "- TWL Application -");
|
||
isTwlApplication = TRUE;
|
||
rh = MY_ROMHEADER_TWL;
|
||
}
|
||
else{
|
||
PrintString(0, 5, 0xf, "- NTR Application -");
|
||
isTwlApplication = FALSE;
|
||
rh = MY_ROMHEADER_NTR;
|
||
}
|
||
|
||
// ƒJ<C692>[ƒhƒ^ƒCƒv‚Ì”»•Ê
|
||
isTwlCard = (*(vu32 *)(HW_BOOT_CHECK_INFO_BUF) & HOTSW_ROMID_TWLROM_MASK) ? TRUE : FALSE;
|
||
|
||
// ’<><E28099>Frh‚Ì<E2809A>‰Šú‰»‚ª<E2809A>I‚í‚Á‚Ä‚©‚çŒÄ‚Ñ<E2809A>o‚·
|
||
// debugMessage();
|
||
|
||
// ƒtƒ‰ƒO‚Ì<E2809A>‰Šú‰»
|
||
error = FALSE;
|
||
flxhash = TRUE;
|
||
ltdhash = TRUE;
|
||
romheader = TRUE;
|
||
|
||
// ƒ<>ƒbƒNID‚ðŽæ“¾‚µ‚Ä‚¨‚
|
||
card_lock_id = (u16)OS_GetLockID();
|
||
|
||
if(isTwlApplication){
|
||
MY_LoadCard_arm7Static();
|
||
MY_LoadCard_arm7LtdStatic();
|
||
}
|
||
else{
|
||
CheckMirrorImage();
|
||
}
|
||
|
||
CheckRomHeader();
|
||
CheckBackupDevice();
|
||
|
||
ShowResult();
|
||
|
||
while(1){
|
||
// DEMO_DrawFlip();
|
||
OS_WaitVBlankIntr();
|
||
}
|
||
}
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: CheckMirrorImage
|
||
|
||
Description:
|
||
|
||
Gameƒ‚<C692>[ƒhŽž <20>¨ GameƒRƒ}ƒ“ƒh OK
|
||
NormalƒRƒ}ƒ“ƒh All 1
|
||
|
||
Normalƒ‚<C692>[ƒhŽž <20>¨ GameƒRƒ}ƒ“ƒh All 1
|
||
NormalƒRƒ}ƒ“ƒh OK
|
||
|
||
SlotPowerOffŽž <20>¨ GameƒRƒ}ƒ“ƒh All 0
|
||
NormalƒRƒ}ƒ“ƒh All 0
|
||
*---------------------------------------------------------------------------*/
|
||
static void CheckMirrorImage(void)
|
||
{
|
||
u32 buf1[PAGE_SIZE/sizeof(u32)];
|
||
u32 buf2[PAGE_SIZE/sizeof(u32)];
|
||
u32 buf_ff[PAGE_SIZE/sizeof(u32)];
|
||
u32 buf_00[PAGE_SIZE/sizeof(u32)];
|
||
|
||
MI_CpuFill8( buf_ff, 0xff, sizeof(buf_ff) );
|
||
MI_CpuFill8( buf_00, 0x0, sizeof(buf_00) );
|
||
|
||
CARD_LockRom(card_lock_id);
|
||
|
||
// Gameƒ‚<C692>[ƒh‚̃Rƒ}ƒ“ƒh‚ÅKey Table—̈æ‚ÆGame—̈æ“Ç‚Þ
|
||
ReadCardData(buf1, (s32)0x1000, (s32)PAGE_SIZE);
|
||
ReadCardData(buf2, (s32)0x8000, (s32)PAGE_SIZE);
|
||
|
||
CARD_UnlockRom(card_lock_id);
|
||
|
||
// Gameƒ‚<C692>[ƒh‚ÅKey Table—̈悩‚çGame—̈æ‚̃Cƒ<43><C692>[ƒW‚ª“Ç‚ß‚Ä‚È‚©‚Á‚½‚ç<E2809A>A•s–¾‚ȃ‚<C692>[ƒh
|
||
if(MI_CpuComp8( buf1, buf2, PAGE_SIZE )){
|
||
error = TRUE;
|
||
PrintString(0, 7, 0x1, "Unknown Mode");
|
||
}
|
||
else{
|
||
// “¯‚¶ƒf<C692>[ƒ^‚Å‚à ALL 1(GameModeŽž) or ALL 0(SlotPowerOffŽž)‚È‚ç‚¿‚á‚ñ‚Æ“Ç‚ß‚Ä‚È‚¢‚Ì‚Å<E2809A>ANormalƒ‚<C692>[ƒh
|
||
if(!MI_CpuComp8( buf_ff, buf2, PAGE_SIZE ) || !MI_CpuComp8( buf_00, buf2, PAGE_SIZE )){
|
||
flxhash = FALSE;
|
||
ltdhash = FALSE;
|
||
PrintString(0, 7, 0x1, "Flx Area : Not Accessible");
|
||
}
|
||
// Key Table—̈æ“Ç‚ñ‚Å<E2809A>AGame—̈æ‚̃Cƒ<43><C692>[ƒW‚ª<E2809A>o‚Ä‚½‚çGameƒ‚<C692>[ƒh
|
||
else{
|
||
flxhash = TRUE;
|
||
ltdhash = FALSE;
|
||
PrintString(0, 7, 0x8, "Flx Area : Accessible");
|
||
}
|
||
}
|
||
}
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: CheckRomHeader
|
||
|
||
Description:
|
||
*---------------------------------------------------------------------------*/
|
||
static void CheckRomHeader(void)
|
||
{
|
||
int result;
|
||
u8* pBuf = (u8 *)rhBuf;
|
||
u8* romHeader = (u8 *)rh;
|
||
|
||
CARD_LockRom(card_lock_id);
|
||
|
||
ReadBootSegNormal(pBuf);
|
||
|
||
CARD_UnlockRom(card_lock_id);
|
||
|
||
// ŽÀ<C5BD>Û‚É“Ç‚ñ‚¾Rom Header‚ÆIPL‚Å“Ç‚ñ‚¾Rom Header‚ð”äŠr
|
||
if(isTwlApplication){
|
||
result = MI_CpuComp8( pBuf, romHeader, HW_TWL_CARD_ROM_HEADER_BUF_SIZE );
|
||
}
|
||
else{
|
||
result = CompRomHeaderForNTR(pBuf);
|
||
}
|
||
|
||
// Œ‹‰Ê
|
||
if(result){
|
||
romheader = FALSE;
|
||
PrintString(0, 11, 0x1, "Boot Segment : Not Accessible");
|
||
}
|
||
else{
|
||
romheader = TRUE;
|
||
PrintString(0, 11, 0x8, "Boot Segment : Accessible");
|
||
}
|
||
|
||
// DEMO_DrawFlip();
|
||
OS_WaitVBlankIntr();
|
||
}
|
||
|
||
|
||
static int CompRomHeaderForNTR(void* buf){
|
||
u8* pBuf = (u8 *)buf;
|
||
u8* romHeader = (u8 *)rh;
|
||
u32 remainSize = HW_CARD_ROM_HEADER_SIZE;
|
||
|
||
while(remainSize){
|
||
// ƒ}ƒXƒNRomƒRƒ“ƒgƒ<67><C692>[ƒ‹<C692>î•ñ‚ª•Ï‚í‚Á‚Ä‚é‚Ì‚Å<E2809A>A‚»‚±‚Í”ò‚΂·<E2809A>B
|
||
if((HW_CARD_ROM_HEADER_SIZE - remainSize) == 0x60){
|
||
pBuf += 4;
|
||
romHeader += 4;
|
||
remainSize -= 4;
|
||
}
|
||
if(*pBuf == *romHeader){
|
||
remainSize--;
|
||
}
|
||
else{
|
||
// OS_TPrintf("Error (adr:0x%08x)\n", HW_CARD_ROM_HEADER_SIZE - remainSize);
|
||
// OS_TPrintf("read : 0x%02x real : 0x%02x\n", *pBuf, *romHeader);
|
||
break;
|
||
}
|
||
pBuf++;
|
||
romHeader++;
|
||
}
|
||
|
||
return (int)remainSize;
|
||
}
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: CheckHashValue
|
||
|
||
Description: ƒ‚ƒWƒ…<C692>[ƒ‹ƒnƒbƒVƒ…ƒ`ƒFƒbƒN
|
||
*---------------------------------------------------------------------------*/
|
||
static BOOL CheckHashValue(void* buf, u32 size, void* digest)
|
||
{
|
||
u8 sha1data[DIGEST_SIZE_SHA1];
|
||
BOOL retval = TRUE;
|
||
|
||
// ƒNƒŠƒA
|
||
MI_CpuClear8(sha1data, sizeof(sha1data));
|
||
|
||
// ARM7<4D>í’“ƒ‚ƒWƒ…<C692>[ƒ‹‚ÌHash’l<E28099>Æ<EFBFBD>‡
|
||
SVC_CalcHMACSHA1( sha1data,
|
||
buf,
|
||
size,
|
||
s_digestDefaultKey,
|
||
sizeof(s_digestDefaultKey) );
|
||
|
||
return SVC_CompareSHA1( sha1data, digest );
|
||
}
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: MY_LoadCard_arm7Static
|
||
|
||
Description: ARM7<4D>í’“ƒ‚ƒWƒ…<C692>[ƒ‹ “Ç‚Ý<E2809A>o‚µ<E2809A>EƒnƒbƒVƒ…ƒ`ƒFƒbƒN
|
||
*---------------------------------------------------------------------------*/
|
||
static void MY_LoadCard_arm7Static(void)
|
||
{
|
||
BOOL result;
|
||
u32* pBuf = checkBuf;
|
||
|
||
CARD_LockRom(card_lock_id);
|
||
|
||
ReadCardData(pBuf, (s32)rh->sub_rom_offset, (s32)rh->sub_size);
|
||
|
||
CARD_UnlockRom(card_lock_id);
|
||
|
||
result = CheckHashValue(checkBuf, rh->sub_size, (void *)rh->sub_static_digest);
|
||
|
||
if(result){
|
||
flxhash = TRUE;
|
||
PrintString(0, 7, 0x8, "Flx Area : Accessible");
|
||
}
|
||
else{
|
||
flxhash = FALSE;
|
||
PrintString(0, 7, 0x1, "Flx Area : Not Accessible");
|
||
}
|
||
|
||
// DEMO_DrawFlip();
|
||
OS_WaitVBlankIntr();
|
||
}
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: MY_LoadCard_arm7LtdStatic
|
||
|
||
Description: ARM7Šg’£<E28099>í’“ƒ‚ƒWƒ…<C692>[ƒ‹ “Ç‚Ý<E2809A>o‚µ<E2809A>EƒnƒbƒVƒ…ƒ`ƒFƒbƒN
|
||
*---------------------------------------------------------------------------*/
|
||
static void MY_LoadCard_arm7LtdStatic(void)
|
||
{
|
||
BOOL result;
|
||
u32* pBuf = checkBuf;
|
||
|
||
CARD_LockRom(card_lock_id);
|
||
|
||
ReadCardData(pBuf, (s32)rh->sub_ltd_rom_offset, (s32)rh->sub_ltd_size);
|
||
|
||
CARD_UnlockRom(card_lock_id);
|
||
|
||
result = CheckHashValue(checkBuf, rh->sub_ltd_size, (void *)rh->sub_ltd_static_digest);
|
||
|
||
if(result){
|
||
ltdhash = TRUE;
|
||
PrintString(0, 9, 0x8, "Ltd Area : Accessible");
|
||
}
|
||
else{
|
||
ltdhash = FALSE;
|
||
PrintString(0, 9, 0x1, "Ltd Area : Not Accessible");
|
||
}
|
||
|
||
// DEMO_DrawFlip();
|
||
OS_WaitVBlankIntr();
|
||
}
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: CheckBackupDevice
|
||
|
||
Description: Backup Device ‚ւ̃AƒNƒZƒXƒ`ƒFƒbƒN
|
||
|
||
’<><E28099>FEEPROM 512 kb‚̃TƒuŠî”Õ‚ÆŽg‚Á‚ÄŒŸ<C592>¸‚·‚é
|
||
*---------------------------------------------------------------------------*/
|
||
static void CheckBackupDevice(void)
|
||
{
|
||
BOOL identify;
|
||
static CARDResult last_result = CARD_RESULT_SUCCESS;
|
||
|
||
CARD_LockBackup(card_lock_id);
|
||
|
||
identify = CARD_IdentifyBackup(CARD_BACKUP_TYPE_EEPROM_512KBITS);
|
||
if (!identify)
|
||
{
|
||
PrintString(0, 13, 0x1, "Backup Device Identify Error...");
|
||
error = TRUE;
|
||
CARD_UnlockBackup(card_lock_id);
|
||
return;
|
||
}
|
||
|
||
{
|
||
u32 pos = 0;
|
||
static u8 tmp_buf[65536];
|
||
int i;
|
||
const u32 page_size = CARD_GetBackupPageSize();
|
||
const u32 total_size = CARD_GetBackupTotalSize();
|
||
|
||
for (i = 0; i < page_size; ++i)
|
||
{
|
||
tmp_buf[i] = (u8)(pos * 3 + i);
|
||
}
|
||
|
||
if (!CARD_IsBackupEeprom()){
|
||
PrintString(0, 13, 0x1, "Please Use EEPROM...");
|
||
error = TRUE;
|
||
return;
|
||
}
|
||
|
||
PrintString(0, 13, 0xf, "Backup Device Check Start...");
|
||
// DEMO_DrawFlip();
|
||
|
||
while(pos < total_size){
|
||
CARD_WriteAndVerifyEepromAsync(pos, tmp_buf, page_size, NULL, NULL);
|
||
|
||
(void)CARD_WaitBackupAsync();
|
||
last_result = CARD_GetResultCode();
|
||
|
||
pos += page_size;
|
||
|
||
if (last_result != CARD_RESULT_SUCCESS){
|
||
break;
|
||
}
|
||
}
|
||
|
||
if (last_result != CARD_RESULT_SUCCESS){
|
||
PrintString(0, 14, 0x1, "Backup Device : Not Accessible");
|
||
error = TRUE;
|
||
}
|
||
else{
|
||
PrintString(0, 14, 0x8, "Backup Device : Accessible");
|
||
}
|
||
}
|
||
|
||
CARD_UnlockBackup(card_lock_id);
|
||
|
||
// DEMO_DrawFlip();
|
||
OS_WaitVBlankIntr();
|
||
}
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: ReadBootSegNormal
|
||
|
||
Description: ƒm<C692>[ƒ}ƒ‹ƒ‚<C692>[ƒh‚ÌBoot Segment“Ç‚Ý<E2809A>ž‚Ý
|
||
*---------------------------------------------------------------------------*/
|
||
#define TIME_OUT 1000
|
||
|
||
static void ReadBootSegNormal(void* buf)
|
||
{
|
||
u32 i, loop, pc, size, counter;
|
||
u64 page = 0;
|
||
Cmd64 cndLE;
|
||
BOOL isType1;
|
||
|
||
OSTick start;
|
||
|
||
isType1 = (*(vu32 *)(HW_BOOT_CHECK_INFO_BUF) & HOTSW_ROMID_1TROM_MASK) ? FALSE : TRUE;
|
||
|
||
if(isType1){
|
||
loop = 0x1UL;
|
||
pc = 0x4UL;
|
||
size = BOOT_SEGMENT_SIZE;
|
||
}
|
||
else{
|
||
loop = ONE_SEGMENT_PAGE_NUM;
|
||
pc = 0x1UL;
|
||
size = PAGE_SIZE;
|
||
}
|
||
|
||
counter = 0;
|
||
|
||
HOTSW_WaitCardCtrl();
|
||
|
||
for(i=0; i<loop; i++){
|
||
// ƒŠƒgƒ‹ƒGƒ“ƒfƒBƒAƒ“‚Å<E2809A>ì‚Á‚Ä
|
||
cndLE.dw = HSWOP_N_OP_RD_PAGE;
|
||
cndLE.dw |= page << HSWOP_N_RD_PAGE_ADDR_SHIFT;
|
||
|
||
// MCCMD ƒŒƒWƒXƒ^<5E>Ý’è
|
||
SetCommand(&cndLE);
|
||
|
||
// MCCNT0 ƒŒƒWƒXƒ^<5E>Ý’è
|
||
reg_MI_MCCNT0_A = (u16)((reg_MI_MCCNT0_A & 0x00ff) | REG_MI_MCCNT0_E_MASK);
|
||
|
||
// MCCNT1 ƒŒƒWƒXƒ^<5E>Ý’è
|
||
reg_MI_MCCNT1_A = START_MASK | CT_MASK | PC_MASK & (pc << PC_SHIFT) | LATENCY2_MASK | LATENCY1_MASK;
|
||
|
||
start = OS_GetTick();
|
||
|
||
while(reg_MI_MCCNT1_A & START_MASK){
|
||
while(!(reg_MI_MCCNT1_A & READY_MASK)){
|
||
if(OS_TicksToMilliSeconds(OS_GetTick()-start) > TIME_OUT){
|
||
return;
|
||
}
|
||
}
|
||
*((u32 *)buf + counter++) = reg_MI_MCD1_A;
|
||
}
|
||
|
||
page++;
|
||
|
||
OS_SpinWait( 100 );
|
||
}
|
||
}
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: HOTSWi_SetCommand
|
||
|
||
Description: ˆø<CB86>”‚Å—^‚¦‚ç‚ꂽƒRƒ}ƒ“ƒh‚̃Gƒ“ƒfƒBƒAƒ“‚ð•Ï‚¦‚ăŒƒWƒXƒ^‚ɃZƒbƒg‚·‚é
|
||
*---------------------------------------------------------------------------*/
|
||
static void SetCommand(Cmd64 *cndLE)
|
||
{
|
||
Cmd64 cndBE;
|
||
|
||
// ƒrƒbƒOƒGƒ“ƒfƒBƒAƒ“‚É’¼‚·
|
||
cndBE.b[7] = cndLE->b[0];
|
||
cndBE.b[6] = cndLE->b[1];
|
||
cndBE.b[5] = cndLE->b[2];
|
||
cndBE.b[4] = cndLE->b[3];
|
||
cndBE.b[3] = cndLE->b[4];
|
||
cndBE.b[2] = cndLE->b[5];
|
||
cndBE.b[1] = cndLE->b[6];
|
||
cndBE.b[0] = cndLE->b[7];
|
||
|
||
// MCCMD ƒŒƒWƒXƒ^<5E>Ý’è
|
||
reg_MI_MCCMD0_A = *(u32*)cndBE.b;
|
||
reg_MI_MCCMD1_A = *(u32*)&cndBE.b[4];
|
||
}
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: ReadPageGame
|
||
|
||
Description: ƒQ<C692>[ƒ€ƒ‚<C692>[ƒh‚Å<E2809A>AŽw’肳‚ꂽƒy<C692>[ƒW‚ðŽw’èƒoƒbƒtƒ@‚ÉŽw’èƒTƒCƒY•ª‚ð“Ç‚Ý<E2809A>ž‚Þ
|
||
*---------------------------------------------------------------------------*/
|
||
static void ReadPageGame(u32 start_addr, void* buf, u32 size)
|
||
{
|
||
u32 loop, counter=0;
|
||
u64 i, page;
|
||
Cmd64 cndLE;
|
||
u32 rom_ctrl = *(vu32 *)(HW_CARD_ROM_HEADER + 0x60);
|
||
|
||
OSTick start;
|
||
|
||
rom_ctrl = rom_ctrl & ~CARD_COMMAND_MASK;
|
||
page = (u32)(start_addr / PAGE_SIZE);
|
||
loop = (u32)(size / PAGE_SIZE);
|
||
loop = (size % PAGE_SIZE) ? loop + 1 : loop;
|
||
|
||
HOTSW_WaitCardCtrl();
|
||
|
||
for(i=0; i<loop; i++){
|
||
// ƒRƒ}ƒ“ƒh<C692>ì<EFBFBD>¬
|
||
cndLE.dw = HSWOP_G_OP_RD_PAGE;
|
||
cndLE.dw |= (page + i) << HSWOP_G_RD_PAGE_ADDR_SHIFT;
|
||
|
||
// MCCMD ƒŒƒWƒXƒ^<5E>Ý’è
|
||
SetCommand(&cndLE);
|
||
|
||
// MCCNT0 ƒŒƒWƒXƒ^<5E>Ý’è
|
||
reg_MI_MCCNT0_A = (u16)((reg_MI_MCCNT0_A & 0x00ff) | REG_MI_MCCNT0_E_MASK);
|
||
|
||
// MCCNT1 ƒŒƒWƒXƒ^<5E>Ý’è
|
||
reg_MI_MCCNT1_A = rom_ctrl | START_MASK | PAGE_1;
|
||
|
||
start = OS_GetTick();
|
||
|
||
while(reg_MI_MCCNT1_A & START_MASK){
|
||
while(!(reg_MI_MCCNT1_A & READY_MASK)){
|
||
if(OS_TicksToMilliSeconds(OS_GetTick()-start) > TIME_OUT){
|
||
return;
|
||
}
|
||
}
|
||
*((u32 *)buf + counter++) = reg_MI_MCD1_A;
|
||
}
|
||
}
|
||
|
||
OS_SpinWait( 100 );
|
||
}
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: ReadCardData
|
||
|
||
Description: ƒJ<C692>[ƒh‚©‚ç’†“r”¼’[‚ȃTƒCƒY(page“r’†)‚̃f<C692>[ƒ^‚ð“Ç‚Ý<E2809A>o‚·ŠÖ<C5A0>”
|
||
ƒGƒ‰<C692>[ƒR<C692>[ƒh‚ð•Ô‚·
|
||
*---------------------------------------------------------------------------*/
|
||
static void ReadCardData(void* dest, s32 offset, s32 length)
|
||
{
|
||
static u8 page_buffer[512];
|
||
u32 page_offset = (u32)(offset & -512);
|
||
u32 buffer_offset = (u32)(offset % 512);
|
||
u32 valid_length = 512 - buffer_offset;
|
||
u32 remain_length;
|
||
|
||
// ŠJŽnƒAƒhƒŒƒX‚ªƒy<C692>[ƒW‚Ì“r’†
|
||
if ( offset % 512 )
|
||
{
|
||
ReadPageGame(page_offset, page_buffer, 512);
|
||
|
||
MI_CpuCopy8(page_buffer + buffer_offset, dest, (length < valid_length ? length : valid_length));
|
||
|
||
dest = (u8*)dest + valid_length;
|
||
offset += valid_length;
|
||
length -= valid_length;
|
||
if ( length < 0)
|
||
{
|
||
return;
|
||
}
|
||
}
|
||
|
||
remain_length = (u32)(length % 512);
|
||
ReadPageGame((u32)offset, dest, (u32)(length - remain_length));
|
||
|
||
// ƒPƒc‚ªƒy<C692>[ƒW“r’†
|
||
if( remain_length ){
|
||
dest = (u8*)dest + (length - remain_length);
|
||
offset += length - remain_length;
|
||
|
||
ReadPageGame((u32)offset, page_buffer, 512);
|
||
|
||
MI_CpuCopy8(page_buffer, dest, remain_length);
|
||
}
|
||
}
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: ShowResult
|
||
|
||
Description: Result•\Ž¦
|
||
*---------------------------------------------------------------------------*/
|
||
static void ShowResult(void)
|
||
{
|
||
PrintString(0, 16, 0xf, "-- Result --");
|
||
|
||
if(romheader && !flxhash && !ltdhash){
|
||
PrintString(0, 18, 0x4, "Normal Mode");
|
||
}
|
||
else if((!romheader && flxhash && !ltdhash) ||
|
||
(!romheader && flxhash && ltdhash && !isTwlCard)){
|
||
PrintString(0, 18, 0x5, "Game Mode");
|
||
}
|
||
else if(!romheader && !flxhash && !ltdhash){
|
||
PrintString(0, 18, 0x6, "Slot Power Off");
|
||
}
|
||
else{
|
||
PrintString(0, 18, 0x1, "Unknown Mode");
|
||
}
|
||
|
||
if(error){
|
||
PrintString(0, 20, 0x1, "Backup Device Error");
|
||
}
|
||
|
||
// DEMO_DrawFlip();
|
||
// OS_WaitVBlankIntr();
|
||
}
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: debugMessage
|
||
|
||
Description:
|
||
*---------------------------------------------------------------------------*/
|
||
static void debugMessage(void)
|
||
{
|
||
PrintString(0, 4, 0xf, "amr7 NmlRomOfs : 0x%08x", rh->sub_rom_offset);
|
||
PrintString(0, 5, 0xf, "amr7 LtdRomOfs : 0x%08x", rh->sub_ltd_rom_offset);
|
||
|
||
OS_TPrintf("amr7 NmlRomOfs : 0x%08x\n", rh->sub_rom_offset);
|
||
OS_TPrintf("amr7 NmlSize : 0x%08x\n", rh->sub_size);
|
||
OS_TPrintf("amr7 LtdRomOfs : 0x%08x\n", rh->sub_ltd_rom_offset);
|
||
OS_TPrintf("amr7 LtdSize : 0x%08x\n", rh->sub_ltd_size);
|
||
}
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: VBlankIntr
|
||
|
||
Description: ‚uƒuƒ‰ƒ“ƒNŠ„<C5A0>ž‚݃xƒNƒgƒ‹<C692>B
|
||
*---------------------------------------------------------------------------*/
|
||
static void VBlankIntr (void)
|
||
{
|
||
/* ‰¼‘zƒXƒNƒŠ<C692>[ƒ“‚ð VRAM ‚É”½‰f */
|
||
DC_FlushRange(screen, sizeof(screen));
|
||
GX_LoadBG0Scr(screen, 0, sizeof(screen));
|
||
|
||
/* IRQ ƒ`ƒFƒbƒNƒtƒ‰ƒO‚ðƒZƒbƒg */
|
||
OS_SetIrqCheckFlag(OS_IE_V_BLANK);
|
||
}
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: PrintString
|
||
|
||
Description: ‰¼‘zƒXƒNƒŠ<C692>[ƒ“‚É•¶Žš—ñ‚ð”z’u‚·‚é<E2809A>B•¶Žš—ñ‚Í32•¶Žš‚Ü‚Å<E2809A>B
|
||
|
||
Arguments: x - •¶Žš—ñ‚Ì<E2809A>擪‚ð”z’u‚·‚é x <20>À•W( <20>~ 8 ƒhƒbƒg )<29>B
|
||
y - •¶Žš—ñ‚Ì<E2809A>擪‚ð”z’u‚·‚é y <20>À•W( <20>~ 8 ƒhƒbƒg )<29>B
|
||
palette - •¶Žš‚Ì<E2809A>F‚ðƒpƒŒƒbƒg”Ô<E2809D>†‚ÅŽw’è<E28099>B
|
||
text - ”z’u‚·‚镶Žš—ñ<E28094>B<EFBFBD>I’[•¶Žš‚ÍNULL<4C>B
|
||
... - ‰¼‘zˆø<CB86>”<EFBFBD>B
|
||
|
||
Returns: None.
|
||
*---------------------------------------------------------------------------*/
|
||
static void PrintString (s16 x, s16 y, u8 palette, char *text, ...)
|
||
{
|
||
va_list vlist;
|
||
char temp[32 + 2];
|
||
s32 i;
|
||
|
||
va_start(vlist, text);
|
||
(void)vsnprintf(temp, 33, text, vlist);
|
||
va_end(vlist);
|
||
|
||
*((u16*)(&temp[32])) = 0x0000;
|
||
for (i = 0; ; i++)
|
||
{
|
||
if (temp[i] == 0x00)
|
||
{
|
||
break;
|
||
}
|
||
screen[((y * 32) + x + i) % (32 * 32)] = (u16)((palette << 12) | temp[i]);
|
||
}
|
||
} |