47 lines
864 B
C++
47 lines
864 B
C++
|
#include <STDInclude.hpp>
|
||
|
|
|
||
|
|
namespace Utils::Maths
|
||
|
|
{
|
||
|
|
float DotProduct(float v1[3], float v2[3])
|
||
|
|
{
|
||
|
|
return v1[0] * v2[0] + v1[1] * v2[1] + v1[2] * v2[2];
|
||
|
|
}
|
||
|
|
|
||
|
|
void VectorSubtract(float va[3], float vb[3], float out[3])
|
||
|
|
{
|
||
|
|
out[0] = va[0] - vb[0];
|
||
|
|
out[1] = va[1] - vb[1];
|
||
|
|
out[2] = va[2] - vb[2];
|
||
|
|
}
|
||
|
|
|
||
|
|
void VectorAdd(float va[3], float vb[3], float out[3])
|
||
|
|
{
|
||
|
|
out[0] = va[0] + vb[0];
|
||
|
|
out[1] = va[1] + vb[1];
|
||
|
|
out[2] = va[2] + vb[2];
|
||
|
|
}
|
||
|
|
|
||
|
|
void VectorCopy(float in[3], float out[3])
|
||
|
|
{
|
||
|
|
out[0] = in[0];
|
||
|
|
out[1] = in[1];
|
||
|
|
out[2] = in[2];
|
||
|
|
}
|
||
|
|
|
||
|
|
void VectorScale(float v[3], float scale, float out[3])
|
||
|
|
{
|
||
|
|
out[0] = v[0] * scale;
|
||
|
|
out[1] = v[1] * scale;
|
||
|
|
out[2] = v[2] * scale;
|
||
|
|
}
|
||
|
|
|
||
|
|
float Vec3SqrDistance(float v1[3], float v2[3])
|
||
|
|
{
|
||
|
|
float out[3];
|
||
|
|
|
||
|
|
VectorSubtract(v2, v1, out);
|
||
|
|
|
||
|
|
return (out[0] * out[0]) + (out[1] * out[1]) + (out[2] * out[2]);
|
||
|
|
}
|
||
|
|
}
|