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
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
|
#include "PRinternal/macros.h"
#include "PR/os_internal.h"
#include "PRinternal/controller.h"
#include "PRinternal/siint.h"
#if BUILD_VERSION >= VERSION_J
static s32 __osPfsCheckRamArea(OSPfs* pfs);
#endif
s32 osPfsInitPak(OSMesgQueue* queue, OSPfs* pfs, int channel) {
#if BUILD_VERSION < VERSION_J
int k;
#endif
s32 ret = 0;
u16 sum;
u16 isum;
u8 temp[BLOCKSIZE];
__OSPackId* id;
__OSPackId newid;
__osSiGetAccess();
ret = __osPfsGetStatus(queue, channel);
__osSiRelAccess();
if (ret != 0) {
return ret;
}
pfs->queue = queue;
pfs->channel = channel;
pfs->status = 0;
#if BUILD_VERSION >= VERSION_J
ERRCK(__osPfsCheckRamArea(pfs));
#endif
ERRCK(SELECT_BANK(pfs, 0));
ERRCK(__osContRamRead(pfs->queue, pfs->channel, PFS_ID_0AREA, temp));
__osIdCheckSum((u16*)temp, &sum, &isum);
id = (__OSPackId*)temp;
if ((id->checksum != sum) || (id->inverted_checksum != isum)) {
ret = __osCheckPackId(pfs, id);
if (ret != 0) {
#if BUILD_VERSION >= VERSION_J
pfs->status |= PFS_ID_BROKEN;
#endif
return ret;
}
#if BUILD_VERSION < VERSION_J
// Duplicated check
else if (ret != 0) {
return ret;
}
#endif
}
if (!(id->deviceid & 1)) {
ret = __osRepairPackId(pfs, id, &newid);
if (ret != 0) {
#if BUILD_VERSION >= VERSION_J
if (ret == PFS_ERR_ID_FATAL) {
pfs->status |= PFS_ID_BROKEN;
}
#endif
return ret;
}
id = &newid;
if (!(id->deviceid & 1)) {
return PFS_ERR_DEVICE;
}
}
#if BUILD_VERSION >= VERSION_J
bcopy(id, pfs->id, BLOCKSIZE);
#else
for (k = 0; k < ARRLEN(pfs->id); k++) {
pfs->id[k] = ((u8 *)id)[k];
}
#endif
pfs->version = id->version;
pfs->banks = id->banks;
pfs->inode_start_page = 1 + DEF_DIR_PAGES + (2 * pfs->banks);
pfs->dir_size = DEF_DIR_PAGES * PFS_ONE_PAGE;
pfs->inode_table = 1 * PFS_ONE_PAGE;
pfs->minode_table = (1 + pfs->banks) * PFS_ONE_PAGE;
pfs->dir_table = pfs->minode_table + (pfs->banks * PFS_ONE_PAGE);
ERRCK(__osContRamRead(pfs->queue, pfs->channel, PFS_LABEL_AREA, pfs->label));
ret = osPfsChecker(pfs);
pfs->status |= PFS_INITIALIZED;
return ret;
}
#if BUILD_VERSION >= VERSION_J
static s32 __osPfsCheckRamArea(OSPfs* pfs) {
s32 i;
s32 ret = 0;
u8 temp1[BLOCKSIZE];
u8 temp2[BLOCKSIZE];
u8 save[BLOCKSIZE];
ERRCK(SELECT_BANK(pfs, PFS_ID_BANK_256K));
ERRCK(__osContRamRead(pfs->queue, pfs->channel, 0, save));
for (i = 0; i < BLOCKSIZE; i++) {
temp1[i] = i;
}
ERRCK(__osContRamWrite(pfs->queue, pfs->channel, 0, temp1, FALSE));
ERRCK(__osContRamRead(pfs->queue, pfs->channel, 0, temp2));
if (bcmp(temp1, temp2, BLOCKSIZE) != 0) {
return PFS_ERR_DEVICE;
}
ret = __osContRamWrite(pfs->queue, pfs->channel, 0, save, FALSE);
return ret;
}
#endif
|
