The first commit

src/core1/gu/cosf.c

@@ -0,0 +1,6 @@
+#include <ultra64.h>
+#include "functions.h"
+#include "variables.h"
+
+
+#pragma GLOBAL_ASM("asm/nonmatchings/core1/gu/cosf/cosf.s")

src/core1/gu/mtxutil.c

@@ -0,0 +1,62 @@
+#include <ultra64.h>
+#include "functions.h"
+#include "variables.h"
+
+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);
+	}
+}
+
+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 guMtxIdent(Mtx *m){
+    float mf[4][4];
+
+    guMtxIdentF(mf);
+    guMtxF2L(mf, m);
+}
+
+#pragma GLOBAL_ASM("asm/nonmatchings/core1/gu/mtxutil/guMtxL2F.s")
+// 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) | (*(af++) & 0xffff);
+// 		q1 = *((int *)&e1); 
+// 		q2 = *((int *)&e2); 
+
+// 		mf[i][j*2] = FIX32TOF(q1);
+// 		mf[i][j*2+1] = FIX32TOF(q2);
+// 	}
+// }

src/core1/gu/rotate.c

@@ -0,0 +1,55 @@
+#include <ultra64.h>
+#include "functions.h"
+#include "variables.h"
+
+extern f32 D_80285900;
+
+f32 sinf(f32);
+f32 cosf(f32);
+
+#pragma GLOBAL_ASM("asm/nonmatchings/core1/gu/rotate/guRotateF.s")
+// MATCHING but need to resolve core1 data section for static D_80285900
+// void guRotateF(float mf[4][4], float a, float x, float y, float z)
+// {
+//     static f32 D_80285900 = 3.1415926 / 180.0;
+//     float	sine;
+// 	float	cosine;
+// 	float	ab, bc, ca, t;
+    
+	
+// 	guNormalize(&x, &y, &z);
+// 	a *= D_80285900;
+// 	sine = sinf(a);
+// 	cosine = cosf(a);
+// 	t = (1-cosine);
+// 	ab = x*y*t;
+// 	bc = y*z*t;
+// 	ca = z*x*t;
+
+// 	guMtxIdentF(mf);
+
+// 	t = x*x;
+// 	mf[0][0] = t+cosine*(1-t);
+// 	mf[2][1] = bc-x*sine;
+// 	mf[1][2] = bc+x*sine;
+
+// 	t = y*y;
+// 	mf[1][1] = t+cosine*(1-t);
+// 	mf[2][0] = ca+y*sine;
+// 	mf[0][2] = ca-y*sine;
+
+// 	t = z*z;
+// 	mf[2][2] = t+cosine*(1-t);
+// 	mf[1][0] = ab-z*sine;
+// 	mf[0][1] = ab+z*sine;
+// }
+
+#pragma GLOBAL_ASM("asm/nonmatchings/core1/gu/rotate/guRotate.s")
+// MATCHING with -O3, need to resolve data section
+// void guRotate(Mtx *m, float a, float x, float y, float z)
+// {
+// 	float	mf[4][4];
+
+// 	guRotateF(mf, a, x, y, z);
+// 	guMtxF2L(mf, m);
+// }