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
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
|
#include "macros.h"
#include "fault.h"
#include "libc64/sprintf.h"
#include "libc64/sleep.h"
#include "z64dma.h"
// Variables are put before most headers as a hacky way to bypass bss reordering
u8 sYaz0DataBuffer[0x400] ALIGNED(16);
u8* sYaz0DataBufferEnd;
uintptr_t sYaz0CurRomStart;
size_t sYaz0CurSize;
u8* sYaz0MaxPtr;
void* gYaz0DecompressDstEnd;
#include "yaz0.h"
void* Yaz0_FirstDMA(void) {
s32 pad;
size_t dmaSize;
size_t bufferSize;
sYaz0MaxPtr = sYaz0DataBufferEnd - 0x19;
bufferSize = sYaz0DataBufferEnd - sYaz0DataBuffer;
dmaSize = (bufferSize > sYaz0CurSize) ? sYaz0CurSize : bufferSize;
DmaMgr_DmaRomToRam(sYaz0CurRomStart, sYaz0DataBuffer, dmaSize);
sYaz0CurRomStart += dmaSize;
sYaz0CurSize -= dmaSize;
return sYaz0DataBuffer;
}
void* Yaz0_NextDMA(u8* curSrcPos) {
u8* dst;
size_t restSize;
size_t dmaSize;
OSPri oldPri;
restSize = sYaz0DataBufferEnd - curSrcPos;
dst = (restSize & 7) ? (sYaz0DataBuffer - (restSize & 7)) + 8 : sYaz0DataBuffer;
bcopy(curSrcPos, dst, restSize);
dmaSize = sYaz0DataBufferEnd - dst - restSize;
if (sYaz0CurSize < dmaSize) {
dmaSize = sYaz0CurSize;
}
if (dmaSize != 0) {
DmaMgr_DmaRomToRam(sYaz0CurRomStart, dst + restSize, dmaSize);
sYaz0CurRomStart += dmaSize;
sYaz0CurSize -= dmaSize;
if (sYaz0CurSize == 0) {
sYaz0MaxPtr = dst + restSize + dmaSize;
}
} else {
oldPri = osGetThreadPri(NULL);
osSetThreadPri(NULL, OS_PRIORITY_APPMAX);
osSyncPrintf(T("圧縮展開異常\n", "compression/decompression error\n"));
osSetThreadPri(NULL, oldPri);
}
return dst;
}
#define YAZ0_MAGIC 0x59617A30 // 'Yaz0'
typedef struct {
/* 0x0 */ u32 magic;
/* 0x4 */ u32 decSize;
/* 0x8 */ u32 compInfoOffset; // only used in mio0
/* 0xC */ u32 uncompDataOffset; // only used in mio0
} Yaz0Header; // size = 0x10
s32 Yaz0_DecompressImpl(u8* src, u8* dst) {
u32 bitIndex = 0;
u8* dstEnd;
u32 chunkHeader = 0;
u32 nibble;
u8* backPtr;
size_t chunkSize;
u32 off;
u32 magic = ((Yaz0Header*)src)->magic;
if (magic != YAZ0_MAGIC) {
return -1;
}
dstEnd = dst + ((Yaz0Header*)src)->decSize;
src += sizeof(Yaz0Header);
do {
if (bitIndex == 0) {
if ((sYaz0MaxPtr < src) && (sYaz0CurSize != 0)) {
src = Yaz0_NextDMA(src);
}
chunkHeader = *src++;
bitIndex = 8;
}
if (chunkHeader & (1 << 7)) { // uncompressed
*dst = *src;
dst++;
src++;
} else { // compressed
off = ((*src & 0xF) << 8) | *(src + 1);
nibble = *src >> 4;
backPtr = dst - off;
src += 2;
// N = chunkSize; B = back offset
// 3 bytes 0B BB NN
// 2 bytes NB BB
chunkSize = (nibble == 0) ? (u32)(*src++ + 0x12) : nibble + 2;
do {
*dst++ = *(backPtr++ - 1);
chunkSize--;
} while (chunkSize != 0);
}
chunkHeader <<= 1;
bitIndex--;
} while (dst != dstEnd);
gYaz0DecompressDstEnd = dstEnd;
return 0;
}
void Yaz0_Decompress(uintptr_t romStart, void* dst, size_t size) {
s32 status;
s32 pad;
char exp1[80];
char exp2[80];
if (sYaz0DataBufferEnd != NULL) {
while (sYaz0DataBufferEnd != NULL) {
usleep(10);
}
}
sYaz0DataBufferEnd = sYaz0DataBuffer + sizeof(sYaz0DataBuffer);
sYaz0CurRomStart = romStart;
sYaz0CurSize = size;
status = Yaz0_DecompressImpl(Yaz0_FirstDMA(), dst);
if (status != 0) {
sprintf(exp1, "slidma slidstart_szs ret=%d", status);
sprintf(exp2, "src:%08lx dst:%08lx siz:%08lx", romStart, dst, size);
Fault_AddHungupAndCrashImpl(exp1, exp2);
}
sYaz0DataBufferEnd = NULL;
}
|
