blob: d631d2fb6ad2c9b5c92735dfcf38c66cfad237aa (
plain)
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
|
#include "ultra64.h"
#define BLOCKSIZE 32
#ifndef BBPLAYER
s32 __osPfsLastChannel = -1;
#endif
s32 __osContRamRead(OSMesgQueue* ctrlrqueue, s32 channel, u16 addr, u8* data) {
#ifndef BBPLAYER
s32 ret;
s32 i;
u8* ptr;
s32 retryCount = 2;
__osSiGetAccess();
do {
ptr = (u8*)&__osPfsPifRam;
if (__osContLastCmd != CONT_CMD_READ_MEMPACK || __osPfsLastChannel != channel) {
__osContLastCmd = CONT_CMD_READ_MEMPACK;
__osPfsLastChannel = channel;
// clang-format off
for (i = 0; i < channel; i++) { *ptr++ = CONT_CMD_SKIP_CHNL; }
// clang-format on
__osPfsPifRam.status = CONT_CMD_EXE;
READFORMAT(ptr)->unk_00 = CONT_CMD_NOP;
READFORMAT(ptr)->txsize = CONT_CMD_READ_MEMPACK_TX;
READFORMAT(ptr)->rxsize = CONT_CMD_READ_MEMPACK_RX;
READFORMAT(ptr)->cmd = CONT_CMD_READ_MEMPACK;
READFORMAT(ptr)->datacrc = CONT_CMD_NOP;
// Received bytes are 6-26 inclusive
ptr[sizeof(__OSContRamReadFormat)] = CONT_CMD_END; // End of commands
} else {
ptr += channel;
}
READFORMAT(ptr)->hi = addr >> 3;
READFORMAT(ptr)->lo = (s8)(__osContAddressCrc(addr) | (addr << 5));
__osSiRawStartDma(OS_WRITE, &__osPfsPifRam);
osRecvMesg(ctrlrqueue, NULL, OS_MESG_BLOCK);
__osSiRawStartDma(OS_READ, &__osPfsPifRam);
osRecvMesg(ctrlrqueue, NULL, OS_MESG_BLOCK);
ret = CHNL_ERR(*READFORMAT(ptr));
if (!ret) {
if (READFORMAT(ptr)->datacrc != __osContDataCrc(ptr + 6)) {
ret = __osPfsGetStatus(ctrlrqueue, channel);
if (ret) {
break;
}
ret = 4; // Retry
} else {
bcopy(ptr + 6, data, BLOCKSIZE);
}
} else {
ret = 1; // Error
}
if (ret != 4) {
break;
}
} while (0 <= retryCount--);
__osSiRelAccess();
return ret;
#else
s32 ret;
__osSiGetAccess();
ret = 0;
if (__osBbPakAddress[channel] != 0) {
if (__osBbPakSize - 0x20 >= addr * 0x20) {
s32 i;
for (i = 0; i < 0x20; i++) {
data[i] = *(u8*)(__osBbPakAddress[channel] + addr * 0x20 + i);
}
}
} else {
ret = PFS_ERR_NOPACK;
}
__osSiRelAccess();
return ret;
#endif
}
|
