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
|
#include "ultra64.h"
#include "ultra64/leo.h"
#include "ultra64/leoappli.h"
#include "ultra64/leodrive.h"
extern OSIoMesg LEOPiDmaParam;
extern vu16 LEOrw_flags;
// bss
static u32 mseq_tbl[0x10];
// rodata
static const u32 rd_mseq_code[0x10] = {
0x00010000, 0x00020200, 0x80030100, 0x82040000, 0xA8050000, 0xA0060600, 0x31760000, 0x00020300,
0, 0, 0, 0, 0, 0, 0, 0x4060000,
};
static const u32 wt_mseq_code[0x10] = {
0x40020000, 0x00020000, 0x40130B00, 0x42140100, 0x68050000, 0x50060600, 0x401702FF, 0x01870000,
0x40020000, 0, 0, 0, 0, 0, 0, 0x40F0000,
};
void leoSet_mseq(u16 rwmode) {
const u32* tbl;
u32 sct_byte_x;
u32 sct_byte_u;
u8 i;
LEOasic_seq_ctl_shadow &= 0xBFFFFFFF;
osEPiWriteIo(LEOPiInfo, ASIC_SEQ_CTL, LEOasic_seq_ctl_shadow);
if (rwmode == 1) {
tbl = wt_mseq_code;
} else {
tbl = rd_mseq_code;
}
for (i = 0; i < 0x10; i++, tbl++) {
mseq_tbl[i] = *tbl;
}
sct_byte_x = sct_byte_u = LEOtgt_param.sec_bytes - 1;
sct_byte_u += 7;
sct_byte_x <<= 8;
mseq_tbl[4] |= sct_byte_x;
osWritebackDCache(mseq_tbl, 0x40);
LEOPiDmaParam.dramAddr = mseq_tbl;
LEOPiDmaParam.devAddr = MSEQ_RAM_ADDR;
LEOPiDmaParam.size = 0x40;
LEOPiInfo->transferInfo.cmdType = 2;
osEPiStartDma(LEOPiInfo, &LEOPiDmaParam, 1);
osRecvMesg(&LEOdma_que, NULL, OS_MESG_BLOCK);
osEPiWriteIo(LEOPiInfo, ASIC_SEC_BYTE, (sct_byte_u | 0x5900) << 0x10);
if (LEOrw_flags & 0x800) {
sct_byte_x += 0x100;
}
osEPiWriteIo(LEOPiInfo, ASIC_HOST_SECBYTE, sct_byte_x << 8);
LEOasic_seq_ctl_shadow |= 0x40000000;
osEPiWriteIo(LEOPiInfo, ASIC_SEQ_CTL, LEOasic_seq_ctl_shadow);
}
|
