Mercurial > hg > dmlib
view dmvecmat.c @ 243:a9d500e5698d
Improve the parser.
author | Matti Hamalainen <ccr@tnsp.org> |
---|---|
date | Tue, 09 Oct 2012 17:22:07 +0300 |
parents | 07c4f1a7ddc6 |
children | 159264c27929 |
line wrap: on
line source
/* * DMLib * -- Vector and matrix functions * Programmed and designed by Matti 'ccr' Hamalainen * (C) Copyright 2011 Tecnic Software productions (TNSP) */ #include "dmvecmat.h" /* Multiply list of given vectors with given matrix. */ void dm_vector_mul_by_mat_n(DMVector *list, const int nlist, const DMMatrix *mat) { int i; for (i = 0; i < nlist; i++) { DMVector q; memcpy(&q, &list[i], sizeof(DMVector)); list[i].x = (q.x * mat->m[0][0]) + (q.y * mat->m[1][0]) + (q.z * mat->m[2][0]); list[i].y = (q.x * mat->m[0][1]) + (q.y * mat->m[1][1]) + (q.z * mat->m[2][1]); list[i].z = (q.x * mat->m[0][2]) + (q.y * mat->m[1][2]) + (q.z * mat->m[2][2]); } } /* Set matrix to unit-matrix */ void dm_matrix_unit(DMMatrix *mat) { memset(mat, 0, sizeof(DMMatrix)); mat->m[0][0] = 1.0f; mat->m[1][1] = 1.0f; mat->m[2][2] = 1.0f; } /* Transpose the matrix mat2 to mat1 */ void dm_matrix_transpose(DMMatrix *mat1, const DMMatrix *mat2) { int i, j; for (i = 0; i < DM_MATRIX_SIZE; i++) for (j = 0; j < DM_MATRIX_SIZE; j++) mat1->m[i][j] = mat2->m[j][i]; } /* Multiply matrices mat1 and mat2, putting result into mat1 */ void dm_matrix_mul(DMMatrix *mat1, const DMMatrix *mat2) { int i, j; DMMatrix tmpM; for (i = 0; i < DM_MATRIX_SIZE; i++) for (j = 0; j < DM_MATRIX_SIZE; j++) tmpM.m[i][j] = (mat1->m[i][0] * mat2->m[0][j]) + (mat1->m[i][1] * mat2->m[1][j]) + (mat1->m[i][2] * mat2->m[2][j]); memcpy(mat1, &tmpM, sizeof(DMMatrix)); } /* Multiply given list of matrices (size of nMatrices units) with given matrix. */ void dm_matrix_mul_n(DMMatrix * list, const int nlist, const DMMatrix *mat) { int i; for (i = 0; i < nlist; i++) dm_matrix_mul(&list[i], mat); } /* Optimized rotation matrix creation */ void dm_matrix_rot(DMMatrix *mat, const DMFloat sx, const DMFloat sy, const DMFloat sz, const DMFloat cx, const DMFloat cy, const DMFloat cz) { const DMFloat q = cx * sz, l = cx * cz, i = sx * sz, j = sx * cz; mat->m[0][0] = cy * cz; mat->m[0][1] = cy * sz; mat->m[0][2] = -sy; mat->m[1][0] = (sy * j) - q; mat->m[1][1] = (sy * i) + l; mat->m[1][2] = sx * cy; mat->m[2][0] = (sy * l) + i; mat->m[2][1] = (sy * q) - j; mat->m[2][2] = cx * cy; }