mirror of
https://github.com/isledecomp/isle.git
synced 2025-12-10 08:03:13 +00:00
Matrix/vector refactor (#426)
This commit is contained in:
committed by
GitHub
parent
eac096036a
commit
d24f5db42f
@@ -1,45 +1,20 @@
|
||||
#include "realtime.h"
|
||||
|
||||
#include <vec.h>
|
||||
|
||||
// FUNCTION: LEGO1 0x100a5b40
|
||||
void CalcLocalTransform(
|
||||
const Vector3Impl& p_posVec,
|
||||
const Vector3Impl& p_dirVec,
|
||||
const Vector3Impl& p_upVec,
|
||||
Matrix4Impl& p_outMatrix
|
||||
)
|
||||
void CalcLocalTransform(const Vector3& p_posVec, const Vector3& p_dirVec, const Vector3& p_upVec, Matrix4& p_outMatrix)
|
||||
{
|
||||
float x_axis[3], y_axis[3], z_axis[3];
|
||||
|
||||
// This is an unrolled version of the "NORMVEC3" macro,
|
||||
// used here to apply a silly hack to get a 100% match
|
||||
{
|
||||
const float dirVec1Operation = (p_dirVec)[1] * (p_dirVec)[1];
|
||||
double len = sqrt(((p_dirVec)[0] * (p_dirVec)[0] + dirVec1Operation + (p_dirVec)[2] * (p_dirVec)[2]));
|
||||
((z_axis)[0] = (p_dirVec)[0] / (len), (z_axis)[1] = (p_dirVec)[1] / (len), (z_axis)[2] = (p_dirVec)[2] / (len));
|
||||
}
|
||||
|
||||
NORMVEC3(z_axis, p_dirVec);
|
||||
NORMVEC3(y_axis, p_upVec)
|
||||
|
||||
VXV3(x_axis, y_axis, z_axis);
|
||||
|
||||
// Exact same thing as pointed out by the above comment
|
||||
{
|
||||
const float axis2Operation = (x_axis)[2] * (x_axis)[2];
|
||||
double len = sqrt(((x_axis)[0] * (x_axis)[0] + axis2Operation + (x_axis)[1] * (x_axis)[1]));
|
||||
((x_axis)[0] = (x_axis)[0] / (len), (x_axis)[1] = (x_axis)[1] / (len), (x_axis)[2] = (x_axis)[2] / (len));
|
||||
}
|
||||
|
||||
NORMVEC3(x_axis, x_axis);
|
||||
VXV3(y_axis, z_axis, x_axis);
|
||||
|
||||
// Again, the same thing
|
||||
{
|
||||
const float axis2Operation = (y_axis)[2] * (y_axis)[2];
|
||||
double len = sqrt(((y_axis)[0] * (y_axis)[0] + axis2Operation + (y_axis)[1] * (y_axis)[1]));
|
||||
((y_axis)[0] = (y_axis)[0] / (len), (y_axis)[1] = (y_axis)[1] / (len), (y_axis)[2] = (y_axis)[2] / (len));
|
||||
}
|
||||
|
||||
SET4from3(&p_outMatrix[0], x_axis, 0);
|
||||
SET4from3(&p_outMatrix[4], y_axis, 0);
|
||||
SET4from3(&p_outMatrix[8], z_axis, 0);
|
||||
SET4from3(&p_outMatrix[12], p_posVec, 1);
|
||||
NORMVEC3(y_axis, y_axis);
|
||||
SET4from3(p_outMatrix[0], x_axis, 0);
|
||||
SET4from3(p_outMatrix[1], y_axis, 0);
|
||||
SET4from3(p_outMatrix[2], z_axis, 0);
|
||||
SET4from3(p_outMatrix[3], p_posVec, 1);
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user