1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
|
#include "global.h"
#include "gba/flash.h"
#include "flash.h"
#include "memory.h"
extern u8 gFlashEnabled;
extern FlashIntrFunc *GetInterruptHandler(s32);
static u8 TryProgramSector(s32, u8 *);
void InitFlash(void)
{
if (!IdentifyFlash() && !SetFlashTimerIntr(2, GetInterruptHandler(3)))
gFlashEnabled = TRUE;
}
void ClearFlashData(void)
{
if (gFlashEnabled)
EraseFlashChip();
}
s32 ReadFlashData(s32 sector, u8 *dest, s32 size)
{
if (gFlashEnabled)
{
u8 *_dest = dest;
while (size >= 0x1000)
{
ReadFlash(sector, 0, _dest, 0x1000);
sector++;
_dest += 0x1000;
size -= 0x1000;
}
if (size > 0)
ReadFlash(sector, 0, _dest, size);
return 0;
}
return 3;
}
s32 WriteFlashData(s32 sector, u8 *src, s32 size)
{
u8 buffer[0x1000];
if (gFlashEnabled)
{
u8 flag = TRUE;
u8 *_src = src;
while (size >= 0x1000)
{
flag = TryProgramSector(sector, _src);
if (!flag)
break;
sector++;
_src += 0x1000;
size -= 0x1000;
}
if (flag)
{
if (size > 0)
{
MemoryFill8(buffer, 0xFF, 0x1000);
MemoryCopy8(buffer, _src, size);
flag = TryProgramSector(sector, buffer);
}
if (flag)
return 0;
}
}
return 3;
}
static u8 TryProgramSector(s32 sector, u8 *src)
{
s32 tries = 3;
do
{
if (!ProgramFlashSector(sector, src) && !VerifyFlashSectorNBytes(sector, src, 0x1000))
return TRUE;
} while (tries-- > 0);
return FALSE;
}
|
