2020-04-14 17:17:25 +00:00
|
|
|
#include <ultra64.h>
|
|
|
|
#include <global.h>
|
|
|
|
#include <ultra64/controller.h>
|
|
|
|
|
|
|
|
// Valid addr up to 0x7FF
|
|
|
|
// It's the address of a block of 0x20 bytes in the mempak
|
|
|
|
// So that means the whole mempak has a 16-bit address space
|
2020-07-07 00:15:01 +00:00
|
|
|
u8 __osContAddressCrc(u16 addr) {
|
2020-04-14 17:17:25 +00:00
|
|
|
u32 addr32 = addr;
|
|
|
|
u32 ret = 0;
|
|
|
|
u32 bit;
|
|
|
|
s32 i;
|
|
|
|
|
|
|
|
for (bit = 0x400; bit; bit /= 2) {
|
|
|
|
ret *= 2;
|
|
|
|
if (addr32 & bit) {
|
|
|
|
if (ret & 0x20) {
|
|
|
|
ret ^= 0x14;
|
|
|
|
} else {
|
|
|
|
++ret;
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
if (ret & 0x20) {
|
|
|
|
ret ^= 0x15;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
for (i = 0; i < 5; ++i) {
|
|
|
|
ret <<= 1;
|
|
|
|
if (ret & 0x20) {
|
|
|
|
ret ^= 0x15;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return ret & 0x1f;
|
|
|
|
}
|
|
|
|
|
2020-07-07 00:15:01 +00:00
|
|
|
u8 __osContDataCrc(u8* data) {
|
2020-04-14 17:17:25 +00:00
|
|
|
s32 ret;
|
|
|
|
u32 bit;
|
|
|
|
u32 byte;
|
|
|
|
|
|
|
|
ret = 0;
|
|
|
|
for (byte = 0x20; byte; --byte, ++data) {
|
|
|
|
for (bit = 0x80; bit; bit /= 2) {
|
|
|
|
ret *= 2;
|
|
|
|
if ((*data & bit) != 0) {
|
|
|
|
if ((ret & 0x100) != 0) {
|
|
|
|
ret ^= 0x84;
|
|
|
|
} else {
|
|
|
|
++ret;
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
if (ret & 0x100) {
|
|
|
|
ret ^= 0x85;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
do {
|
|
|
|
ret *= 2;
|
|
|
|
if (ret & 0x100) {
|
|
|
|
ret ^= 0x85;
|
|
|
|
}
|
|
|
|
++byte;
|
|
|
|
} while (byte < 8U);
|
|
|
|
return ret;
|
|
|
|
}
|