2019-05-15 10:52:37 -04:00
|
|
|
#pragma once
|
|
|
|
|
|
|
|
class CVector
|
|
|
|
{
|
|
|
|
public:
|
|
|
|
float x, y, z;
|
|
|
|
CVector(void) {}
|
|
|
|
CVector(float x, float y, float z) : x(x), y(y), z(z) {}
|
2019-05-28 20:52:30 -04:00
|
|
|
#ifdef RWCORE_H
|
2019-05-29 18:47:33 -04:00
|
|
|
CVector(const RwV3d &v) : x(v.x), y(v.y), z(v.z) {}
|
2019-05-28 20:52:30 -04:00
|
|
|
|
|
|
|
operator RwV3d (void) const {
|
|
|
|
RwV3d vecRw = { this->x, this->y, this->z };
|
|
|
|
return vecRw;
|
|
|
|
}
|
|
|
|
|
2019-05-29 18:47:33 -04:00
|
|
|
operator RwV3d *(void) {
|
|
|
|
return (RwV3d*)this;
|
2019-05-28 20:52:30 -04:00
|
|
|
}
|
|
|
|
|
2019-05-29 18:47:33 -04:00
|
|
|
operator RwV3d &(void) {
|
|
|
|
return *((RwV3d*)this);
|
2019-05-28 20:52:30 -04:00
|
|
|
}
|
|
|
|
#endif
|
2019-07-18 09:41:09 -04:00
|
|
|
// (0,1,0) means no rotation. So get right vector and its atan
|
2019-07-10 11:18:26 -04:00
|
|
|
float Heading(void) const { return Atan2(-x, y); }
|
|
|
|
float Magnitude(void) const { return Sqrt(x*x + y*y + z*z); }
|
2019-05-15 10:52:37 -04:00
|
|
|
float MagnitudeSqr(void) const { return x*x + y*y + z*z; }
|
2019-07-10 11:18:26 -04:00
|
|
|
float Magnitude2D(void) const { return Sqrt(x*x + y*y); }
|
2019-05-31 19:58:19 -04:00
|
|
|
float MagnitudeSqr2D(void) const { return x*x + y*y; }
|
2019-05-29 18:47:33 -04:00
|
|
|
void Normalise(void) {
|
|
|
|
float sq = MagnitudeSqr();
|
|
|
|
if(sq > 0.0f){
|
2019-07-28 07:14:08 -04:00
|
|
|
float invsqrt = RecipSqrt(sq);
|
2019-05-29 18:47:33 -04:00
|
|
|
x *= invsqrt;
|
|
|
|
y *= invsqrt;
|
|
|
|
z *= invsqrt;
|
|
|
|
}else
|
|
|
|
x = 1.0f;
|
2019-05-15 10:52:37 -04:00
|
|
|
}
|
2020-03-28 10:02:44 -04:00
|
|
|
|
|
|
|
void Normalise(float norm) {
|
|
|
|
float sq = MagnitudeSqr();
|
|
|
|
float invsqrt = RecipSqrt(norm, sq);
|
|
|
|
x *= invsqrt;
|
|
|
|
y *= invsqrt;
|
|
|
|
z *= invsqrt;
|
|
|
|
}
|
2020-04-15 01:03:53 -04:00
|
|
|
|
|
|
|
void Normalise2D(void) {
|
|
|
|
float sq = MagnitudeSqr2D();
|
|
|
|
float invsqrt = RecipSqrt(sq);
|
|
|
|
x *= invsqrt;
|
|
|
|
y *= invsqrt;
|
|
|
|
}
|
2019-05-29 18:47:33 -04:00
|
|
|
|
2019-07-07 04:16:16 -04:00
|
|
|
const CVector &operator+=(CVector const &right) {
|
2019-05-29 18:47:33 -04:00
|
|
|
x += right.x;
|
|
|
|
y += right.y;
|
|
|
|
z += right.z;
|
2019-05-28 20:52:30 -04:00
|
|
|
return *this;
|
2019-05-15 10:52:37 -04:00
|
|
|
}
|
2019-05-29 18:47:33 -04:00
|
|
|
|
2019-07-07 04:16:16 -04:00
|
|
|
const CVector &operator-=(CVector const &right) {
|
2019-05-29 18:47:33 -04:00
|
|
|
x -= right.x;
|
|
|
|
y -= right.y;
|
|
|
|
z -= right.z;
|
2019-05-15 10:52:37 -04:00
|
|
|
return *this;
|
|
|
|
}
|
2019-05-29 18:47:33 -04:00
|
|
|
|
2019-07-07 04:16:16 -04:00
|
|
|
const CVector &operator*=(float right) {
|
2019-05-29 18:47:33 -04:00
|
|
|
x *= right;
|
|
|
|
y *= right;
|
|
|
|
z *= right;
|
2019-05-15 10:52:37 -04:00
|
|
|
return *this;
|
|
|
|
}
|
2019-05-29 18:47:33 -04:00
|
|
|
|
2019-07-07 04:16:16 -04:00
|
|
|
const CVector &operator/=(float right) {
|
2019-05-29 18:47:33 -04:00
|
|
|
x /= right;
|
|
|
|
y /= right;
|
|
|
|
z /= right;
|
2019-05-15 10:52:37 -04:00
|
|
|
return *this;
|
|
|
|
}
|
2019-05-29 18:47:33 -04:00
|
|
|
|
2019-07-07 04:16:16 -04:00
|
|
|
CVector operator-() const {
|
2019-05-29 18:47:33 -04:00
|
|
|
return CVector(-x, -y, -z);
|
2019-07-28 07:14:08 -04:00
|
|
|
}
|
|
|
|
|
|
|
|
const bool operator==(CVector const &right) {
|
|
|
|
return x == right.x && y == right.y && z == right.z;
|
2019-05-15 10:52:37 -04:00
|
|
|
}
|
2019-05-29 18:47:33 -04:00
|
|
|
|
2020-04-12 16:50:34 -04:00
|
|
|
bool IsZero(void) const { return x == 0.0f && y == 0.0f && z == 0.0f; }
|
2019-05-15 10:52:37 -04:00
|
|
|
};
|
|
|
|
|
2019-05-29 18:47:33 -04:00
|
|
|
inline CVector operator+(const CVector &left, const CVector &right)
|
|
|
|
{
|
|
|
|
return CVector(left.x + right.x, left.y + right.y, left.z + right.z);
|
|
|
|
}
|
|
|
|
|
|
|
|
inline CVector operator-(const CVector &left, const CVector &right)
|
|
|
|
{
|
|
|
|
return CVector(left.x - right.x, left.y - right.y, left.z - right.z);
|
|
|
|
}
|
2019-05-28 20:52:30 -04:00
|
|
|
|
2019-05-29 18:47:33 -04:00
|
|
|
inline CVector operator*(const CVector &left, float right)
|
|
|
|
{
|
|
|
|
return CVector(left.x * right, left.y * right, left.z * right);
|
|
|
|
}
|
|
|
|
|
2019-05-30 15:24:47 -04:00
|
|
|
inline CVector operator*(float left, const CVector &right)
|
|
|
|
{
|
|
|
|
return CVector(left * right.x, left * right.y, left * right.z);
|
|
|
|
}
|
|
|
|
|
2019-05-29 18:47:33 -04:00
|
|
|
inline CVector operator/(const CVector &left, float right)
|
|
|
|
{
|
|
|
|
return CVector(left.x / right, left.y / right, left.z / right);
|
|
|
|
}
|
2019-11-04 18:31:50 -05:00
|
|
|
|
|
|
|
inline float
|
|
|
|
DotProduct(const CVector &v1, const CVector &v2)
|
|
|
|
{
|
|
|
|
return v1.x*v2.x + v1.y*v2.y + v1.z*v2.z;
|
|
|
|
}
|
|
|
|
|
2020-01-11 06:30:17 -05:00
|
|
|
inline const CVector
|
2019-11-04 18:31:50 -05:00
|
|
|
CrossProduct(const CVector &v1, const CVector &v2)
|
|
|
|
{
|
|
|
|
return CVector(
|
|
|
|
v1.y*v2.z - v1.z*v2.y,
|
|
|
|
v1.z*v2.x - v1.x*v2.z,
|
|
|
|
v1.x*v2.y - v1.y*v2.x);
|
|
|
|
}
|
|
|
|
|
|
|
|
inline float
|
|
|
|
Distance(const CVector &v1, const CVector &v2)
|
|
|
|
{
|
|
|
|
return (v2 - v1).Magnitude();
|
|
|
|
}
|