ecker/GLdc
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Unify and slightly simplify specialised matrix multiply functions

Browse Source
This commit is contained in:
UnknownShadow200 2024-10-07 18:06:42 +11:00
parent 91b59ceca8
commit 490bf3de6d
1 changed files with 51 additions and 74 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

125
GL/matrix.c
View File

@ -139,6 +139,15 @@ void APIENTRY glLoadIdentity() {
OnMatrixChanged(); OnMatrixChanged();
} }
void GL_FORCE_INLINE _glMultMatrix(const Matrix4x4* mat) {
void* top = stack_top(MATRIX_STACKS + MATRIX_IDX);
UploadMatrix4x4(top);
MultiplyMatrix4x4(mat);
DownloadMatrix4x4(top);
OnMatrixChanged();
}
void APIENTRY glTranslatef(GLfloat x, GLfloat y, GLfloat z) { void APIENTRY glTranslatef(GLfloat x, GLfloat y, GLfloat z) {
const Matrix4x4 trn __attribute__((aligned(32))) = { const Matrix4x4 trn __attribute__((aligned(32))) = {
1.0f, 0.0f, 0.0f, 0.0f, 1.0f, 0.0f, 0.0f, 0.0f,
@ -146,17 +155,7 @@ void APIENTRY glTranslatef(GLfloat x, GLfloat y, GLfloat z) {
0.0f, 0.0f, 1.0f, 0.0f, 0.0f, 0.0f, 1.0f, 0.0f,
x, y, z, 1.0f x, y, z, 1.0f
}; };
void* top = stack_top(MATRIX_STACKS + MATRIX_IDX); _glMultMatrix(&trn);
assert(top);
UploadMatrix4x4(top);
MultiplyMatrix4x4(&trn);
top = stack_top(MATRIX_STACKS + MATRIX_IDX);
assert(top);
DownloadMatrix4x4(top);
OnMatrixChanged();
} }
@ -167,11 +166,7 @@ void APIENTRY glScalef(GLfloat x, GLfloat y, GLfloat z) {
0.0f, 0.0f, z, 0.0f, 0.0f, 0.0f, z, 0.0f,
0.0f, 0.0f, 0.0f, 1.0f 0.0f, 0.0f, 0.0f, 1.0f
}; };
_glMultMatrix(&scale);
UploadMatrix4x4(stack_top(MATRIX_STACKS + MATRIX_IDX));
MultiplyMatrix4x4(&scale);
DownloadMatrix4x4(stack_top(MATRIX_STACKS + MATRIX_IDX));
OnMatrixChanged();
} }
void APIENTRY glRotatef(GLfloat angle, GLfloat x, GLfloat y, GLfloat z) { void APIENTRY glRotatef(GLfloat angle, GLfloat x, GLfloat y, GLfloat z) {
@ -213,10 +208,7 @@ void APIENTRY glRotatef(GLfloat angle, GLfloat x, GLfloat y, GLfloat z) {
rotate[M9] = yz * invc - xs; rotate[M9] = yz * invc - xs;
rotate[M10] = (z * z) * invc + c; rotate[M10] = (z * z) * invc + c;
UploadMatrix4x4(stack_top(MATRIX_STACKS + MATRIX_IDX)); _glMultMatrix(&rotate);
MultiplyMatrix4x4((const Matrix4x4*) &rotate);
DownloadMatrix4x4(stack_top(MATRIX_STACKS + MATRIX_IDX));
OnMatrixChanged();
} }
/* Load an arbitrary matrix */ /* Load an arbitrary matrix */
@ -233,25 +225,21 @@ void APIENTRY glOrtho(GLfloat left, GLfloat right,
GLfloat bottom, GLfloat top, GLfloat bottom, GLfloat top,
GLfloat znear, GLfloat zfar) { GLfloat znear, GLfloat zfar) {
/* Ortho Matrix */ Matrix4x4 ortho __attribute__((aligned(32))) = {
Matrix4x4 OrthoMatrix __attribute__((aligned(32))) = {
1.0f, 0.0f, 0.0f, 0.0f, 1.0f, 0.0f, 0.0f, 0.0f,
0.0f, 1.0f, 0.0f, 0.0f, 0.0f, 1.0f, 0.0f, 0.0f,
0.0f, 0.0f, 1.0f, 0.0f, 0.0f, 0.0f, 1.0f, 0.0f,
0.0f, 0.0f, 0.0f, 1.0f 0.0f, 0.0f, 0.0f, 1.0f
}; };
OrthoMatrix[M0] = 2.0f / (right - left); ortho[M0] = 2.0f / (right - left);
OrthoMatrix[M5] = 2.0f / (top - bottom); ortho[M5] = 2.0f / (top - bottom);
OrthoMatrix[M10] = -2.0f / (zfar - znear); ortho[M10] = -2.0f / (zfar - znear);
OrthoMatrix[M12] = -(right + left) / (right - left); ortho[M12] = -(right + left) / (right - left);
OrthoMatrix[M13] = -(top + bottom) / (top - bottom); ortho[M13] = -(top + bottom) / (top - bottom);
OrthoMatrix[M14] = -(zfar + znear) / (zfar - znear); ortho[M14] = -(zfar + znear) / (zfar - znear);
UploadMatrix4x4(stack_top(MATRIX_STACKS + MATRIX_IDX)); _glMultMatrix(&ortho);
MultiplyMatrix4x4((const Matrix4x4*) &OrthoMatrix);
DownloadMatrix4x4(stack_top(MATRIX_STACKS + MATRIX_IDX));
OnMatrixChanged();
} }
@ -260,10 +248,8 @@ void APIENTRY glFrustum(GLfloat left, GLfloat right,
GLfloat bottom, GLfloat top, GLfloat bottom, GLfloat top,
GLfloat znear, GLfloat zfar) { GLfloat znear, GLfloat zfar) {
/* Frustum Matrix */ Matrix4x4 frustum __attribute__((aligned(32)));
Matrix4x4 FrustumMatrix __attribute__((aligned(32))); MEMSET(frustum, 0, sizeof(float) * 16);
MEMSET(FrustumMatrix, 0, sizeof(float) * 16);
const float near2 = 2.0f * znear; const float near2 = 2.0f * znear;
const float A = (right + left) / (right - left); const float A = (right + left) / (right - left);
@ -271,31 +257,25 @@ void APIENTRY glFrustum(GLfloat left, GLfloat right,
const float C = -((zfar + znear) / (zfar - znear)); const float C = -((zfar + znear) / (zfar - znear));
const float D = -((2.0f * zfar * znear) / (zfar - znear)); const float D = -((2.0f * zfar * znear) / (zfar - znear));
FrustumMatrix[M0] = near2 / (right - left); frustum[M0] = near2 / (right - left);
FrustumMatrix[M5] = near2 / (top - bottom); frustum[M5] = near2 / (top - bottom);
FrustumMatrix[M8] = A; frustum[M8] = A;
FrustumMatrix[M9] = B; frustum[M9] = B;
FrustumMatrix[M10] = C; frustum[M10] = C;
FrustumMatrix[M11] = -1.0f; frustum[M11] = -1.0f;
FrustumMatrix[M14] = D; frustum[M14] = D;
UploadMatrix4x4(stack_top(MATRIX_STACKS + MATRIX_IDX)); _glMultMatrix(&frustum);
MultiplyMatrix4x4((const Matrix4x4*) &FrustumMatrix);
DownloadMatrix4x4(stack_top(MATRIX_STACKS + MATRIX_IDX));
OnMatrixChanged();
} }
/* Multiply the current matrix by an arbitrary matrix */ /* Multiply the current matrix by an arbitrary matrix */
void glMultMatrixf(const GLfloat *m) { void glMultMatrixf(const GLfloat *m) {
Matrix4x4 TEMP __attribute__((aligned(32))); Matrix4x4 tmp __attribute__((aligned(32)));
MEMCPY4(TEMP, m, sizeof(Matrix4x4)); MEMCPY4(tmp, m, sizeof(Matrix4x4));
UploadMatrix4x4(stack_top(MATRIX_STACKS + MATRIX_IDX)); _glMultMatrix(&tmp);
MultiplyMatrix4x4(&TEMP);
DownloadMatrix4x4(stack_top(MATRIX_STACKS + MATRIX_IDX));
OnMatrixChanged();
} }
/* Load an arbitrary transposed matrix */ /* Load an arbitrary transposed matrix */
@ -331,32 +311,29 @@ void glLoadTransposeMatrixf(const GLfloat *m) {
/* Multiply the current matrix by an arbitrary transposed matrix */ /* Multiply the current matrix by an arbitrary transposed matrix */
void glMultTransposeMatrixf(const GLfloat *m) { void glMultTransposeMatrixf(const GLfloat *m) {
static Matrix4x4 TEMP __attribute__((aligned(32))); static Matrix4x4 tmp __attribute__((aligned(32)));
TEMP[M0] = m[0]; tmp[M0] = m[0];
TEMP[M1] = m[4]; tmp[M1] = m[4];
TEMP[M2] = m[8]; tmp[M2] = m[8];
TEMP[M3] = m[12]; tmp[M3] = m[12];
TEMP[M4] = m[1]; tmp[M4] = m[1];
TEMP[M5] = m[5]; tmp[M5] = m[5];
TEMP[M6] = m[9]; tmp[M6] = m[9];
TEMP[M7] = m[13]; tmp[M7] = m[13];
TEMP[M8] = m[3]; tmp[M8] = m[3];
TEMP[M9] = m[6]; tmp[M9] = m[6];
TEMP[M10] = m[10]; tmp[M10] = m[10];
TEMP[M11] = m[14]; tmp[M11] = m[14];
TEMP[M12] = m[4]; tmp[M12] = m[4];
TEMP[M13] = m[7]; tmp[M13] = m[7];
TEMP[M14] = m[11]; tmp[M14] = m[11];
TEMP[M15] = m[15]; tmp[M15] = m[15];
UploadMatrix4x4(stack_top(MATRIX_STACKS + MATRIX_IDX)); _glMultMatrix(&tmp);
MultiplyMatrix4x4((const Matrix4x4*) &TEMP);
DownloadMatrix4x4(stack_top(MATRIX_STACKS + MATRIX_IDX));
OnMatrixChanged();
} }
/* Set the GL viewport */ /* Set the GL viewport */