// ------------------------------------------------------------------------------------------------ #include "Base/Quaternion.hpp" #include "Base/Vector3.hpp" #include "Base/Vector4.hpp" #include "Base/Shared.hpp" #include "Library/Random.hpp" // ------------------------------------------------------------------------------------------------ #include // ------------------------------------------------------------------------------------------------ namespace SqMod { // ------------------------------------------------------------------------------------------------ const Quaternion Quaternion::NIL = Quaternion(0); const Quaternion Quaternion::MIN = Quaternion(std::numeric_limits< Quaternion::Value >::min()); const Quaternion Quaternion::MAX = Quaternion(std::numeric_limits< Quaternion::Value >::max()); // ------------------------------------------------------------------------------------------------ SQChar Quaternion::Delim = ','; // ------------------------------------------------------------------------------------------------ SQInteger Quaternion::Typename(HSQUIRRELVM vm) { static SQChar name[] = _SC("Quaternion"); sq_pushstring(vm, name, sizeof(name)); return 1; } // ------------------------------------------------------------------------------------------------ Quaternion::Quaternion() : x(0.0), y(0.0), z(0.0), w(0.0) { /* ... */ } // ------------------------------------------------------------------------------------------------ Quaternion::Quaternion(Value sv) : x(sv), y(sv), z(sv), w(sv) { /* ... */ } // ------------------------------------------------------------------------------------------------ Quaternion::Quaternion(Value xv, Value yv, Value zv) : x(xv), y(yv), z(zv), w(0.0) { /* ... */ } // ------------------------------------------------------------------------------------------------ Quaternion::Quaternion(Value xv, Value yv, Value zv, Value wv) : x(xv), y(yv), z(zv), w(wv) { /* ... */ } // ------------------------------------------------------------------------------------------------ Quaternion & Quaternion::operator = (Value s) { x = s; y = s; z = s; w = s; return *this; } Quaternion & Quaternion::operator = (const Vector3 & q) { x = q.x; y = q.y; z = q.z; w = 0.0; return *this; } Quaternion & Quaternion::operator = (const Vector4 & q) { x = q.x; y = q.y; z = q.z; w = q.w; return *this; } // ------------------------------------------------------------------------------------------------ Quaternion & Quaternion::operator += (const Quaternion & q) { x += q.x; y += q.y; z += q.z; w += q.w; return *this; } Quaternion & Quaternion::operator -= (const Quaternion & q) { x -= q.x; y -= q.y; z -= q.z; w -= q.w; return *this; } Quaternion & Quaternion::operator *= (const Quaternion & q) { x *= q.x; y *= q.y; z *= q.z; w *= q.w; return *this; } Quaternion & Quaternion::operator /= (const Quaternion & q) { x /= q.x; y /= q.y; z /= q.z; w /= q.w; return *this; } Quaternion & Quaternion::operator %= (const Quaternion & q) { x = fmod(x, q.x); y = fmod(y, q.y); z = fmod(z, q.z); w = fmod(w, q.w); return *this; } // ------------------------------------------------------------------------------------------------ Quaternion & Quaternion::operator += (Value s) { x += s; y += s; z += s; w += s; return *this; } Quaternion & Quaternion::operator -= (Value s) { x -= s; y -= s; z -= s; w -= s; return *this; } Quaternion & Quaternion::operator *= (Value s) { x *= s; y *= s; z *= s; w *= s; return *this; } Quaternion & Quaternion::operator /= (Value s) { x /= s; y /= s; z /= s; w /= s; return *this; } Quaternion & Quaternion::operator %= (Value s) { x = fmod(x, s); y = fmod(y, s); z = fmod(z, s); w = fmod(w, s); return *this; } // ------------------------------------------------------------------------------------------------ Quaternion & Quaternion::operator ++ () { ++x; ++y; ++z; ++w; return *this; } Quaternion & Quaternion::operator -- () { --x; --y; --z; --w; return *this; } // ------------------------------------------------------------------------------------------------ Quaternion Quaternion::operator ++ (int) { Quaternion state(*this); ++x; ++y; ++z; ++w; return state; } Quaternion Quaternion::operator -- (int) { Quaternion state(*this); --x; --y; --z; --w; return state; } // ------------------------------------------------------------------------------------------------ Quaternion Quaternion::operator + (const Quaternion & q) const { return Quaternion(x + q.x, y + q.y, z + q.z, w + q.w); } Quaternion Quaternion::operator + (Value s) const { return Quaternion(x + s, y + s, z + s, w + s); } // ------------------------------------------------------------------------------------------------ Quaternion Quaternion::operator - (const Quaternion & q) const { return Quaternion(x - q.x, y - q.y, z - q.z, w - q.w); } Quaternion Quaternion::operator - (Value s) const { return Quaternion(x - s, y - s, z - s, w - s); } // ------------------------------------------------------------------------------------------------ Quaternion Quaternion::operator * (const Quaternion & q) const { return Quaternion(x * q.x, y * q.y, z * q.z, w * q.w); } Quaternion Quaternion::operator * (Value s) const { return Quaternion(x * s, y * s, z * s, w * s); } // ------------------------------------------------------------------------------------------------ Quaternion Quaternion::operator / (const Quaternion & q) const { return Quaternion(x / q.x, y / q.y, z / q.z, w / q.w); } Quaternion Quaternion::operator / (Value s) const { return Quaternion(x / s, y / s, z / s, w / s); } // ------------------------------------------------------------------------------------------------ Quaternion Quaternion::operator % (const Quaternion & q) const { return Quaternion(fmod(x, q.x), fmod(y, q.y), fmod(z, q.z), fmod(w, q.w)); } Quaternion Quaternion::operator % (Value s) const { return Quaternion(fmod(x, s), fmod(y, s), fmod(z, s), fmod(w, s)); } // ------------------------------------------------------------------------------------------------ Quaternion Quaternion::operator + () const { return Quaternion(fabs(x), fabs(y), fabs(z), fabs(w)); } Quaternion Quaternion::operator - () const { return Quaternion(-x, -y, -z, -w); } // ------------------------------------------------------------------------------------------------ bool Quaternion::operator == (const Quaternion & q) const { return EpsEq(x, q.x) && EpsEq(y, q.y) && EpsEq(z, q.z) && EpsEq(w, q.w); } bool Quaternion::operator != (const Quaternion & q) const { return !EpsEq(x, q.x) && !EpsEq(y, q.y) && !EpsEq(z, q.z) && !EpsEq(w, q.w); } bool Quaternion::operator < (const Quaternion & q) const { return EpsLt(x, q.x) && EpsLt(y, q.y) && EpsLt(z, q.z) && EpsLt(w, q.w); } bool Quaternion::operator > (const Quaternion & q) const { return EpsGt(x, q.x) && EpsGt(y, q.y) && EpsGt(z, q.z) && EpsGt(w, q.w); } bool Quaternion::operator <= (const Quaternion & q) const { return EpsLtEq(x, q.x) && EpsLtEq(y, q.y) && EpsLtEq(z, q.z) && EpsLtEq(w, q.w); } bool Quaternion::operator >= (const Quaternion & q) const { return EpsGtEq(x, q.x) && EpsGtEq(y, q.y) && EpsGtEq(z, q.z) && EpsGtEq(w, q.w); } // ------------------------------------------------------------------------------------------------ Int32 Quaternion::Cmp(const Quaternion & o) const { if (*this == o) return 0; else if (*this > o) return 1; else return -1; } // ------------------------------------------------------------------------------------------------ CSStr Quaternion::ToString() const { return ToStrF("%f,%f,%f,%f", x, y, z, w); } // ------------------------------------------------------------------------------------------------ void Quaternion::Set(Value ns) { x = ns; y = ns; z = ns; w = ns; } void Quaternion::Set(Value nx, Value ny, Value nz) { x = nx; y = ny; z = nz; } void Quaternion::Set(Value nx, Value ny, Value nz, Value nw) { x = nx; y = ny; z = nz; w = nw; } // ------------------------------------------------------------------------------------------------ void Quaternion::Set(const Quaternion & q) { x = q.x; y = q.y; z = q.z; w = q.w; } void Quaternion::Set(const Vector3 & v) { x = v.x; y = v.y; z = v.z; w = 0.0; } void Quaternion::Set(const Vector4 & v) { x = v.x; y = v.y; z = v.z; w = v.w; } // ------------------------------------------------------------------------------------------------ void Quaternion::Set(CSStr values, SQChar delim) { Set(GetQuaternion(values, delim)); } // ------------------------------------------------------------------------------------------------ void Quaternion::Generate() { x = GetRandomFloat32(); y = GetRandomFloat32(); z = GetRandomFloat32(); w = GetRandomFloat32(); } void Quaternion::Generate(Value min, Value max) { if (EpsLt(max, min)) STHROWF("max value is lower than min value"); x = GetRandomFloat32(min, max); y = GetRandomFloat32(min, max); z = GetRandomFloat32(min, max); y = GetRandomFloat32(min, max); } void Quaternion::Generate(Value xmin, Value xmax, Value ymin, Value ymax, Value zmin, Value zmax, Value wmin, Value wmax) { if (EpsLt(xmax, xmin) || EpsLt(ymax, ymin) || EpsLt(zmax, zmin) || EpsLt(wmax, wmin)) STHROWF("max value is lower than min value"); x = GetRandomFloat32(xmin, xmax); y = GetRandomFloat32(ymin, ymax); z = GetRandomFloat32(zmin, zmax); y = GetRandomFloat32(ymin, ymax); } // ------------------------------------------------------------------------------------------------ Quaternion Quaternion::Abs() const { return Quaternion(fabs(x), fabs(y), fabs(z), fabs(w)); } // ------------------------------------------------------------------------------------------------ const Quaternion & GetQuaternion(CSStr str) { return GetQuaternion(str, Quaternion::Delim); } // ------------------------------------------------------------------------------------------------ const Quaternion & GetQuaternion(CSStr str, SQChar delim) { // The format specifications that will be used to scan the string static SQChar fs[] = _SC(" %f , %f , %f , %f "); static Quaternion quat; // Clear previous values, if any quat.Clear(); // Is the specified string empty? if (!str || *str == '\0') { return quat; // Return the value as is! } // Assign the specified delimiter fs[4] = delim; fs[9] = delim; fs[14] = delim; // Attempt to extract the component values from the specified string sscanf(str, fs, &quat.x, &quat.y, &quat.z, &quat.w); // Return the resulted value return quat; } // ================================================================================================ void Register_Quaternion(HSQUIRRELVM vm) { typedef Quaternion::Value Val; RootTable(vm).Bind(_SC("Quaternion"), Class< Quaternion >(vm, _SC("Quaternion")) /* Constructors */ .Ctor() .Ctor< Val >() .Ctor< Val, Val, Val >() .Ctor< Val, Val, Val, Val >() /* Static Members */ .SetStaticValue(_SC("Delim"), &Quaternion::Delim) /* Member Variables */ .Var(_SC("x"), &Quaternion::x) .Var(_SC("y"), &Quaternion::y) .Var(_SC("z"), &Quaternion::z) .Var(_SC("w"), &Quaternion::w) /* Properties */ .Prop(_SC("abs"), &Quaternion::Abs) /* Core Metamethods */ .Func(_SC("_tostring"), &Quaternion::ToString) .SquirrelFunc(_SC("_typename"), &Quaternion::Typename) .Func(_SC("_cmp"), &Quaternion::Cmp) /* Metamethods */ .Func(_SC("_add"), &Quaternion::operator +) .Func(_SC("_sub"), &Quaternion::operator -) .Func(_SC("_mul"), &Quaternion::operator *) .Func(_SC("_div"), &Quaternion::operator /) .Func(_SC("_modulo"), &Quaternion::operator %) .Func(_SC("_unm"), &Quaternion::operator -) /* Setters */ .Overload(_SC("Set"), &Quaternion::Set) .Overload(_SC("Set"), &Quaternion::Set) .Overload(_SC("Set"), &Quaternion::Set) .Overload(_SC("SetQuat"), &Quaternion::Set) .Overload(_SC("SetVec3"), &Quaternion::Set) .Overload(_SC("SetVec4"), &Quaternion::Set) .Overload(_SC("SetStr"), &Quaternion::Set) /* Random Generators */ .Overload(_SC("Generate"), &Quaternion::Generate) .Overload(_SC("Generate"), &Quaternion::Generate) .Overload(_SC("Generate"), &Quaternion::Generate) /* Utility Methods */ .Func(_SC("Clear"), &Quaternion::Clear) /* Operator Exposure */ .Func(_SC("opAddAssign"), &Quaternion::operator +=) .Func(_SC("opSubAssign"), &Quaternion::operator -=) .Func(_SC("opMulAssign"), &Quaternion::operator *=) .Func(_SC("opDivAssign"), &Quaternion::operator /=) .Func(_SC("opModAssign"), &Quaternion::operator %=) .Func(_SC("opAddAssignS"), &Quaternion::operator +=) .Func(_SC("opSubAssignS"), &Quaternion::operator -=) .Func(_SC("opMulAssignS"), &Quaternion::operator *=) .Func(_SC("opDivAssignS"), &Quaternion::operator /=) .Func(_SC("opModAssignS"), &Quaternion::operator %=) .Func(_SC("opPreInc"), &Quaternion::operator ++) .Func(_SC("opPreDec"), &Quaternion::operator --) .Func(_SC("opPostInc"), &Quaternion::operator ++) .Func(_SC("opPostDec"), &Quaternion::operator --) .Func(_SC("opAdd"), &Quaternion::operator +) .Func(_SC("opSub"), &Quaternion::operator -) .Func(_SC("opMul"), &Quaternion::operator *) .Func(_SC("opDiv"), &Quaternion::operator /) .Func(_SC("opMod"), &Quaternion::operator %) .Func(_SC("opAddS"), &Quaternion::operator +) .Func(_SC("opSubS"), &Quaternion::operator -) .Func(_SC("opMulS"), &Quaternion::operator *) .Func(_SC("opDivS"), &Quaternion::operator /) .Func(_SC("opModS"), &Quaternion::operator %) .Func(_SC("opUnPlus"), &Quaternion::operator +) .Func(_SC("opUnMinus"), &Quaternion::operator -) .Func(_SC("opEqual"), &Quaternion::operator ==) .Func(_SC("opNotEqual"), &Quaternion::operator !=) .Func(_SC("opLessThan"), &Quaternion::operator <) .Func(_SC("opGreaterThan"), &Quaternion::operator >) .Func(_SC("opLessEqual"), &Quaternion::operator <=) .Func(_SC("opGreaterEqual"), &Quaternion::operator >=) // Static Overloads .StaticOverload< const Quaternion & (*)(CSStr) >(_SC("FromStr"), &GetQuaternion) .StaticOverload< const Quaternion & (*)(CSStr, SQChar) >(_SC("FromStr"), &GetQuaternion) ); } } // Namespace:: SqMod