kawa/banjo-kazooie
1
0
Fork 0
Code Issues Actions Packages Projects Releases Wiki Activity

core1/done/gu/mtxutil.c done

Browse Source
This commit is contained in:
Banjo Kazooie
2022-10-14 14:03:43 -05:00
parent 03904ccd4a
commit 59f32adc6b
8 changed files with 56 additions and 57 deletions
Download Patch File Download Diff File Expand all files Collapse all files

62
src/core1/done/gu/mtxutil.c Normal file
View File

@@ -0,0 +1,62 @@
#include <ultra64.h>
#include "functions.h"
#include "variables.h"
void guMtxL2F(float mf[4][4], Mtx *m)
{
int i, j;
unsigned int e1,e2;
unsigned int *ai,*af;
int q1,q2;
ai=(unsigned int *) &m->m[0][0];
af=(unsigned int *) &m->m[2][0];
for (i=0; i<4; i++)
for (j=0; j<2; j++) {
e1 = (*ai & 0xffff0000) | ((*af >> 16) & 0xffff);
e2 = ((*(ai++) << 16) & 0xffff0000) | ((u16)(*(af++) >> 0));
q1 = *((int *)&e1);
q2 = *((int *)&e2);
mf[i][j*2] = (f32)q1/65536.0f;
mf[i][j*2+1] = (f32)q2/65536.0f;
}
}
void guMtxIdent(Mtx *m){
float mf[4][4];
guMtxIdentF(mf);
guMtxF2L(mf, m);
}
void guMtxIdentF(float mf[4][4])
{
int i, j;
for (i=0; i<4; i++)
for (j=0; j<4; j++)
if (i == j) mf[i][j] = 1.0;
else mf[i][j] = 0.0;
}
void guMtxF2L(float mf[4][4], Mtx *m)
{
int i, j;
int e1,e2;
int *ai,*af;
ai=(int *) &m->m[0][0];
af=(int *) &m->m[2][0];
for (i=0; i<4; i++)
for (j=0; j<2; j++) {
e1=FTOFIX32(mf[i][j*2]);
e2=FTOFIX32(mf[i][j*2+1]);
*(ai++) = ( e1 & 0xffff0000 ) | ((e2 >> 16)&0xffff);
*(af++) = ((e1 << 16) & 0xffff0000) | (e2 & 0xffff);
}
}