mirror of
https://github.com/coop-deluxe/sm64coopdx.git
synced 2024-12-01 16:27:27 +00:00
55 lines
1.4 KiB
C
55 lines
1.4 KiB
C
|
#include "libultra_internal.h"
|
||
|
|
|
||
|
|
void guMtxF2L(float mf[4][4], Mtx *m) {
|
||
|
|
int r, c;
|
||
|
|
long tmp1;
|
||
|
|
long tmp2;
|
||
|
|
long *m1 = &m->m[0][0];
|
||
|
|
long *m2 = &m->m[2][0];
|
||
|
|
for (r = 0; r < 4; r++) {
|
||
|
|
for (c = 0; c < 2; c++) {
|
||
|
|
tmp1 = mf[r][2 * c] * 65536.0f;
|
||
|
|
tmp2 = mf[r][2 * c + 1] * 65536.0f;
|
||
|
|
*m1++ = (tmp1 & 0xffff0000) | ((tmp2 >> 0x10) & 0xffff);
|
||
|
|
*m2++ = ((tmp1 << 0x10) & 0xffff0000) | (tmp2 & 0xffff);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
void guMtxL2F(float mf[4][4], Mtx *m) {
|
||
|
|
int r, c;
|
||
|
|
u32 tmp1;
|
||
|
|
u32 tmp2;
|
||
|
|
u32 *m1;
|
||
|
|
u32 *m2;
|
||
|
|
s32 stmp1, stmp2;
|
||
|
|
m1 = (u32 *) &m->m[0][0];
|
||
|
|
m2 = (u32 *) &m->m[2][0];
|
||
|
|
for (r = 0; r < 4; r++) {
|
||
|
|
for (c = 0; c < 2; c++) {
|
||
|
|
tmp1 = (*m1 & 0xffff0000) | ((*m2 >> 0x10) & 0xffff);
|
||
|
|
tmp2 = ((*m1++ << 0x10) & 0xffff0000) | (*m2++ & 0xffff);
|
||
|
|
stmp1 = *(s32 *) &tmp1;
|
||
|
|
stmp2 = *(s32 *) &tmp2;
|
||
|
|
mf[r][c * 2 + 0] = stmp1 / 65536.0f;
|
||
|
|
mf[r][c * 2 + 1] = stmp2 / 65536.0f;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void guMtxIdentF(float mf[4][4]) {
|
||
|
|
int r, c;
|
||
|
|
for (r = 0; r < 4; r++) {
|
||
|
|
for (c = 0; c < 4; c++) {
|
||
|
|
if (r == c)
|
||
|
|
mf[r][c] = 1.0f;
|
||
|
|
else
|
||
|
|
mf[r][c] = 0.0f;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
void guMtxIdent(Mtx *m) {
|
||
|
|
float mf[4][4];
|
||
|
|
guMtxIdentF(mf);
|
||
|
|
guMtxF2L(mf, m);
|
||
|
|
}
|