ext_lib/ext_matrix.h at main · z64tools/ext_lib · GitHub

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
#ifndef EXT_MATRIX_H
#define EXT_MATRIX_H

#include "ext_lib.h"
#include "ext_math.h"
#include "ext_vector.h"

typedef enum {
	MTXMODE_NEW,
	MTXMODE_APPLY
} MtxMode;

typedef union StructBE {
	s32 m[4][4];
	struct StructBE {
		u16 intPart[4][4];
		u16 fracPart[4][4];
	};
} Mtx;

typedef float MtxF_t[4][4];
typedef union {
	MtxF_t mf;
	struct {
		float xx, yx, zx, wx;
		float xy, yy, zy, wy;
		float xz, yz, zz, wz;
		float xw, yw, zw, ww;
	};
} MtxF;

extern MtxF* gMatrixStack;
extern MtxF* gCurrentMatrix;
extern const MtxF gMtxFClear;

void Matrix_Init();
void Matrix_Clear(MtxF* mf);
void Matrix_Push(void);
void Matrix_Pop(void);
void Matrix_Get(MtxF* dest);
void Matrix_Put(MtxF* src);
void Matrix_MultVec3f(Vec3f* src, Vec3f* dest);
void Matrix_Transpose(MtxF* mf);
void Matrix_MtxFTranslate(MtxF* cmf, f32 x, f32 y, f32 z, MtxMode mode);
void Matrix_Translate(f32 x, f32 y, f32 z, MtxMode mode);
void Matrix_Scale(f32 x, f32 y, f32 z, MtxMode mode);
void Matrix_RotateX(f32 x, MtxMode mode);
void Matrix_RotateY(f32 y, MtxMode mode);
void Matrix_RotateZ(f32 z, MtxMode mode);

void Matrix_MultVec3f_Ext(Vec3f* src, Vec3f* dest, MtxF* mf);
void Matrix_MultVec3fToVec4f_Ext(Vec3f* src, Vec4f* dest, MtxF* mf);
void Matrix_OrientVec3f_Ext(Vec3f* src, Vec3f* dest, MtxF* mf);
void Matrix_Mult(MtxF* mf, MtxMode mode);
void Matrix_MtxFCopy(MtxF* dest, MtxF* src);
void Matrix_ToMtxF(MtxF* mtx);
Mtx* Matrix_ToMtx(Mtx* dest);
Mtx* Matrix_NewMtx();
void Matrix_MtxToMtxF(Mtx* src, MtxF* dest);
Mtx* Matrix_MtxFToMtx(MtxF* src, Mtx* dest);
void Matrix_MtxFMtxFMult(MtxF* mfA, MtxF* mfB, MtxF* dest);
void Matrix_Projection(MtxF* mtx, f32 fovy, f32 aspect, f32 near, f32 far, f32 scale);
void Matrix_Ortho(MtxF* mtx, f32 fovy, f32 aspect, f32 near, f32 far);
void Matrix_LookAt(MtxF* mf, Vec3f eye, Vec3f at, Vec3f up);

void Matrix_MtxFTranslateRotateZYX(MtxF* cmf, Vec3f* translation, Vec3s* rotation);
void Matrix_TranslateRotateZYX(Vec3f* translation, Vec3s* rotation);
void Matrix_RotateAToB(Vec3f* a, Vec3f* b, u8 mode);
void Matrix_MultVec4f_Ext(Vec4f* src, Vec4f* dest, MtxF* mtx);
void Matrix_MtxFToYXZRotS(Vec3s* rotDest, s32 flag);
MtxF Matrix_Invert(MtxF* m);
void Matrix_Unproject(MtxF* modelViewMtx, MtxF* projMtx, Vec3f* src, Vec3f* dest, f32 w, f32 h);
void Matrix_Project(MtxF* modelViewMtx, MtxF* projMtx, Vec3f* src, Vec3f* dest, f32 w, f32 h);

static inline void Matrix_RotateX_s(f32 x, MtxMode mode) {
	Matrix_RotateX(BinToRad(x), mode);
}

static inline void Matrix_RotateY_s(f32 y, MtxMode mode) {
	Matrix_RotateY(BinToRad(y), mode);
}

static inline void Matrix_RotateZ_s(f32 z, MtxMode mode) {
	Matrix_RotateZ(BinToRad(z), mode);
}

static inline void Matrix_RotateX_d(f32 x, MtxMode mode) {
	Matrix_RotateX(DegToRad(x), mode);
}

static inline void Matrix_RotateY_d(f32 y, MtxMode mode) {
	Matrix_RotateY(DegToRad(y), mode);
}

static inline void Matrix_RotateZ_d(f32 z, MtxMode mode) {
	Matrix_RotateZ(DegToRad(z), mode);
}

#endif