1
0
mirror of https://github.com/VCMP-SqMod/SqMod.git synced 2024-11-09 01:07:16 +01:00
SqMod/module/Base/Quaternion.cpp

882 lines
30 KiB
C++
Raw Normal View History

// ------------------------------------------------------------------------------------------------
2015-09-30 02:56:11 +02:00
#include "Base/Quaternion.hpp"
#include "Base/Vector3.hpp"
#include "Base/Vector4.hpp"
#include "Base/Shared.hpp"
#include "Base/DynArg.hpp"
#include "Base/Buffer.hpp"
#include "Library/Numeric/Random.hpp"
2015-09-30 02:56:11 +02:00
// ------------------------------------------------------------------------------------------------
#include <limits>
2015-09-30 02:56:11 +02:00
// ------------------------------------------------------------------------------------------------
namespace SqMod {
// ------------------------------------------------------------------------------------------------
#define STOVAL(v) static_cast< Quaternion::Value >(v)
// ------------------------------------------------------------------------------------------------
SQMODE_DECL_TYPENAME(Typename, _SC("Quaternion"))
2015-09-30 02:56:11 +02:00
// ------------------------------------------------------------------------------------------------
2016-08-04 02:09:43 +02:00
const Quaternion Quaternion::NIL(0);
const Quaternion Quaternion::MIN(std::numeric_limits< Quaternion::Value >::min());
const Quaternion Quaternion::MAX(std::numeric_limits< Quaternion::Value >::max());
const Quaternion Quaternion::IDENTITY(1.0, 0.0, 0.0, 0.0);
2015-09-30 02:56:11 +02:00
// ------------------------------------------------------------------------------------------------
SQChar Quaternion::Delim = ',';
// ------------------------------------------------------------------------------------------------
2020-03-22 08:16:40 +01:00
Quaternion::Quaternion() noexcept
2015-09-30 02:56:11 +02:00
: x(0.0), y(0.0), z(0.0), w(0.0)
{
/* ... */
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
2020-03-22 08:16:40 +01:00
Quaternion::Quaternion(Value sv) noexcept
: x(sv), y(sv), z(sv), w(sv)
2015-09-30 02:56:11 +02:00
{
/* ... */
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
2020-03-22 08:16:40 +01:00
Quaternion::Quaternion(Value xv, Value yv, Value zv) noexcept
2015-09-30 02:56:11 +02:00
: x(xv), y(yv), z(zv), w(0.0)
{
/* ... */
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
2020-03-22 08:16:40 +01:00
Quaternion::Quaternion(Value xv, Value yv, Value zv, Value wv) noexcept
2015-09-30 02:56:11 +02:00
: x(xv), y(yv), z(zv), w(wv)
{
/* ... */
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
Quaternion & Quaternion::operator = (Value s)
2015-09-30 02:56:11 +02:00
{
x = s;
y = s;
z = s;
w = s;
return *this;
}
// ------------------------------------------------------------------------------------------------
Quaternion & Quaternion::operator = (const Vector3 & q)
2015-09-30 02:56:11 +02:00
{
x = q.x;
y = q.y;
z = q.z;
w = 0.0;
return *this;
}
// ------------------------------------------------------------------------------------------------
Quaternion & Quaternion::operator = (const Vector4 & q)
2015-09-30 02:56:11 +02:00
{
x = q.x;
y = q.y;
z = q.z;
w = q.w;
return *this;
}
// ------------------------------------------------------------------------------------------------
Quaternion & Quaternion::operator += (const Quaternion & q)
2015-09-30 02:56:11 +02:00
{
x += q.x;
y += q.y;
z += q.z;
w += q.w;
return *this;
}
// ------------------------------------------------------------------------------------------------
Quaternion & Quaternion::operator -= (const Quaternion & q)
2015-09-30 02:56:11 +02:00
{
x -= q.x;
y -= q.y;
z -= q.z;
w -= q.w;
return *this;
}
// ------------------------------------------------------------------------------------------------
Quaternion & Quaternion::operator *= (const Quaternion & q)
2015-09-30 02:56:11 +02:00
{
x *= q.x;
y *= q.y;
z *= q.z;
w *= q.w;
return *this;
}
// ------------------------------------------------------------------------------------------------
Quaternion & Quaternion::operator /= (const Quaternion & q)
2015-09-30 02:56:11 +02:00
{
x /= q.x;
y /= q.y;
z /= q.z;
w /= q.w;
return *this;
}
// ------------------------------------------------------------------------------------------------
Quaternion & Quaternion::operator %= (const Quaternion & q)
2015-09-30 02:56:11 +02:00
{
x = std::fmod(x, q.x);
y = std::fmod(y, q.y);
z = std::fmod(z, q.z);
w = std::fmod(w, q.w);
2015-09-30 02:56:11 +02:00
return *this;
}
// ------------------------------------------------------------------------------------------------
Quaternion & Quaternion::operator += (Value s)
2015-09-30 02:56:11 +02:00
{
x += s;
y += s;
z += s;
w += s;
return *this;
}
// ------------------------------------------------------------------------------------------------
Quaternion & Quaternion::operator -= (Value s)
2015-09-30 02:56:11 +02:00
{
x -= s;
y -= s;
z -= s;
w -= s;
return *this;
}
// ------------------------------------------------------------------------------------------------
Quaternion & Quaternion::operator *= (Value s)
2015-09-30 02:56:11 +02:00
{
x *= s;
y *= s;
z *= s;
w *= s;
return *this;
}
// ------------------------------------------------------------------------------------------------
Quaternion & Quaternion::operator /= (Value s)
2015-09-30 02:56:11 +02:00
{
x /= s;
y /= s;
z /= s;
w /= s;
return *this;
}
// ------------------------------------------------------------------------------------------------
Quaternion & Quaternion::operator %= (Value s)
2015-09-30 02:56:11 +02:00
{
x = std::fmod(x, s);
y = std::fmod(y, s);
z = std::fmod(z, s);
w = std::fmod(w, s);
2015-09-30 02:56:11 +02:00
return *this;
}
// ------------------------------------------------------------------------------------------------
Quaternion & Quaternion::operator ++ ()
2015-09-30 02:56:11 +02:00
{
++x;
++y;
++z;
++w;
return *this;
}
// ------------------------------------------------------------------------------------------------
Quaternion & Quaternion::operator -- ()
2015-09-30 02:56:11 +02:00
{
--x;
--y;
--z;
--w;
return *this;
}
// ------------------------------------------------------------------------------------------------
2020-03-22 08:16:40 +01:00
Quaternion Quaternion::operator ++ (int) // NOLINT(cert-dcl21-cpp)
2015-09-30 02:56:11 +02:00
{
Quaternion state(*this);
++x;
++y;
++z;
++w;
return state;
}
// ------------------------------------------------------------------------------------------------
2020-03-22 08:16:40 +01:00
Quaternion Quaternion::operator -- (int) // NOLINT(cert-dcl21-cpp)
2015-09-30 02:56:11 +02:00
{
Quaternion state(*this);
--x;
--y;
--z;
--w;
return state;
}
// ------------------------------------------------------------------------------------------------
Quaternion Quaternion::operator + (const Quaternion & q) const
2015-09-30 02:56:11 +02:00
{
2020-03-22 08:16:40 +01:00
return {x + q.x, y + q.y, z + q.z, w + q.w};
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
Quaternion Quaternion::operator + (Value s) const
2015-09-30 02:56:11 +02:00
{
2020-03-22 08:16:40 +01:00
return {x + s, y + s, z + s, w + s};
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
Quaternion Quaternion::operator - (const Quaternion & q) const
2015-09-30 02:56:11 +02:00
{
2020-03-22 08:16:40 +01:00
return {x - q.x, y - q.y, z - q.z, w - q.w};
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
Quaternion Quaternion::operator - (Value s) const
2015-09-30 02:56:11 +02:00
{
2020-03-22 08:16:40 +01:00
return {x - s, y - s, z - s, w - s};
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
Quaternion Quaternion::operator * (const Quaternion & q) const
2015-09-30 02:56:11 +02:00
{
2020-03-22 08:16:40 +01:00
return {x * q.x, y * q.y, z * q.z, w * q.w};
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
Quaternion Quaternion::operator * (Value s) const
2015-09-30 02:56:11 +02:00
{
2020-03-22 08:16:40 +01:00
return {x * s, y * s, z * s, w * s};
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
Quaternion Quaternion::operator / (const Quaternion & q) const
2015-09-30 02:56:11 +02:00
{
2020-03-22 08:16:40 +01:00
return {x / q.x, y / q.y, z / q.z, w / q.w};
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
Quaternion Quaternion::operator / (Value s) const
2015-09-30 02:56:11 +02:00
{
2020-03-22 08:16:40 +01:00
return {x / s, y / s, z / s, w / s};
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
Quaternion Quaternion::operator % (const Quaternion & q) const
2015-09-30 02:56:11 +02:00
{
2020-03-22 08:16:40 +01:00
return {std::fmod(x, q.x), std::fmod(y, q.y), std::fmod(z, q.z), std::fmod(w, q.w)};
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
Quaternion Quaternion::operator % (Value s) const
2015-09-30 02:56:11 +02:00
{
2020-03-22 08:16:40 +01:00
return {std::fmod(x, s), std::fmod(y, s), std::fmod(z, s), std::fmod(w, s)};
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
Quaternion Quaternion::operator + () const
2015-09-30 02:56:11 +02:00
{
2020-03-22 08:16:40 +01:00
return {std::fabs(x), std::fabs(y), std::fabs(z), std::fabs(w)};
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
Quaternion Quaternion::operator - () const
2015-09-30 02:56:11 +02:00
{
2020-03-22 08:16:40 +01:00
return {-x, -y, -z, -w};
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
bool Quaternion::operator == (const Quaternion & q) const
2015-09-30 02:56:11 +02:00
{
return EpsEq(x, q.x) && EpsEq(y, q.y) && EpsEq(z, q.z) && EpsEq(w, q.w);
}
// ------------------------------------------------------------------------------------------------
bool Quaternion::operator != (const Quaternion & q) const
2015-09-30 02:56:11 +02:00
{
return !EpsEq(x, q.x) || !EpsEq(y, q.y) || !EpsEq(z, q.z) || !EpsEq(w, q.w);
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
bool Quaternion::operator < (const Quaternion & q) const
2015-09-30 02:56:11 +02:00
{
return EpsLt(x, q.x) && EpsLt(y, q.y) && EpsLt(z, q.z) && EpsLt(w, q.w);
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
bool Quaternion::operator > (const Quaternion & q) const
2015-09-30 02:56:11 +02:00
{
return EpsGt(x, q.x) && EpsGt(y, q.y) && EpsGt(z, q.z) && EpsGt(w, q.w);
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
bool Quaternion::operator <= (const Quaternion & q) const
2015-09-30 02:56:11 +02:00
{
return EpsLtEq(x, q.x) && EpsLtEq(y, q.y) && EpsLtEq(z, q.z) && EpsLtEq(w, q.w);
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
bool Quaternion::operator >= (const Quaternion & q) const
2015-09-30 02:56:11 +02:00
{
return EpsGtEq(x, q.x) && EpsGtEq(y, q.y) && EpsGtEq(z, q.z) && EpsGtEq(w, q.w);
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
Int32 Quaternion::Cmp(const Quaternion & o) const
2015-09-30 02:56:11 +02:00
{
if (*this == o)
{
return 0;
}
else if (*this > o)
{
return 1;
}
else
{
return -1;
}
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
CSStr Quaternion::ToString() const
2015-09-30 02:56:11 +02:00
{
return ToStrF("%f,%f,%f,%f", x, y, z, w);
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
void Quaternion::SetScalar(Value ns)
2015-09-30 02:56:11 +02:00
{
x = ns;
y = ns;
z = ns;
w = ns;
}
// ------------------------------------------------------------------------------------------------
void Quaternion::SetQuaternion(const Quaternion & q)
2015-09-30 02:56:11 +02:00
{
x = q.x;
y = q.y;
z = q.z;
w = q.w;
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
void Quaternion::SetQuaternionEx(Value nx, Value ny, Value nz, Value nw)
2015-09-30 02:56:11 +02:00
{
x = nx;
y = ny;
z = nz;
w = nw;
}
// ------------------------------------------------------------------------------------------------
void Quaternion::SetVector3(const Vector3 & v)
2015-09-30 02:56:11 +02:00
{
SetVector3Ex(v.x, v.y, v.z);
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
void Quaternion::SetVector3Ex(Value nx, Value ny, Value nz)
{
Float64 angle;
angle = (nx * 0.5);
const Float64 sr = std::sin(angle);
const Float64 cr = std::cos(angle);
angle = (ny * 0.5);
const Float64 sp = std::sin(angle);
const Float64 cp = std::cos(angle);
angle = (nz * 0.5);
const Float64 sy = std::sin(angle);
const Float64 cy = std::cos(angle);
const Float64 cpcy = (cp * cy);
const Float64 spcy = (sp * cy);
const Float64 cpsy = (cp * sy);
const Float64 spsy = (sp * sy);
x = STOVAL(sr * cpcy - cr * spsy);
y = STOVAL(cr * spcy + sr * cpsy);
z = STOVAL(cr * cpsy - sr * spcy);
w = STOVAL(cr * cpcy + sr * spsy);
Normalize();
}
// ------------------------------------------------------------------------------------------------
void Quaternion::SetVector4(const Vector4 & v)
2015-09-30 02:56:11 +02:00
{
x = v.x;
y = v.y;
z = v.z;
w = v.w;
}
// ------------------------------------------------------------------------------------------------
void Quaternion::SetStr(SQChar delim, StackStrF & values)
2015-09-30 02:56:11 +02:00
{
SetQuaternion(Quaternion::GetEx(delim, values));
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
void Quaternion::Generate()
2015-09-30 02:56:11 +02:00
{
x = GetRandomFloat32();
y = GetRandomFloat32();
z = GetRandomFloat32();
w = GetRandomFloat32();
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
void Quaternion::Generate(Value min, Value max)
2015-09-30 02:56:11 +02:00
{
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);
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
void Quaternion::Generate(Value xmin, Value xmax, Value ymin, Value ymax, Value zmin, Value zmax, Value wmin, Value wmax)
2015-09-30 02:56:11 +02:00
{
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);
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
Quaternion Quaternion::Abs() const
2015-09-30 02:56:11 +02:00
{
2020-03-22 08:16:40 +01:00
return {std::fabs(x), std::fabs(y), std::fabs(z), std::fabs(w)};
2015-09-30 02:56:11 +02:00
}
// ------------------------------------------------------------------------------------------------
bool Quaternion::IsNaN() const
{
return std::isnan(w) || std::isnan(x) || std::isnan(y) || std::isnan(z);
}
// ------------------------------------------------------------------------------------------------
Quaternion::Quaternion::Value Quaternion::LengthSquared() const
{
return (x * x) + (y * y) + (z * z) + (w * w);
}
// ------------------------------------------------------------------------------------------------
Quaternion::Value Quaternion::DotProduct(const Quaternion & quat) const
{
return (x * quat.x) + (y * quat.y) + (z * quat.z) + (w * quat.w);
}
// ------------------------------------------------------------------------------------------------
Quaternion Quaternion::Conjugate() const
{
2020-03-22 08:16:40 +01:00
return {-x, -y, -z, w};
}
// ------------------------------------------------------------------------------------------------
void Quaternion::Normalize()
{
const Value len_squared = LengthSquared();
if (!EpsEq(len_squared, STOVAL(1.0)) && EpsGt(len_squared, STOVAL(0.0)))
{
const Value inv_len = STOVAL(1.0) / std::sqrt(len_squared);
x *= inv_len;
y *= inv_len;
z *= inv_len;
w *= inv_len;
}
}
// ------------------------------------------------------------------------------------------------
Quaternion Quaternion::Normalized() const
{
const Value len_squared = LengthSquared();
if (!EpsEq(len_squared, STOVAL(1.0)) && EpsGt(len_squared, STOVAL(0.0)))
{
Value inv_len = 1.0f / sqrtf(len_squared);
return ((*this) * inv_len);
}
else
{
return (*this);
}
}
// ------------------------------------------------------------------------------------------------
void Quaternion::FromAngleAxis(Value angle, const Vector3 & axis)
{
const Vector3 norm_axis = axis.Normalized();
angle *= SQMOD_DEGTORAD_2;
const Value sin_angle = std::sin(angle);
x = norm_axis.x * sin_angle;
y = norm_axis.y * sin_angle;
z = norm_axis.z * sin_angle;
w = std::cos(angle);
}
// ------------------------------------------------------------------------------------------------
void Quaternion::FromRotationTo(const Vector3 & start, const Vector3 & end)
{
const Vector3 norm_start = start.Normalized();
const Vector3 norm_end = end.Normalized();
const Value d = norm_start.DotProduct(norm_end);
if (EpsGt(d, STOVAL(-1.0)))
{
const Vector3 c = norm_start.CrossProduct(norm_end);
const Value s = std::sqrt((STOVAL(1.0) + d) * STOVAL(2.0));
const Value inv_s = STOVAL(1.0) / s;
x = c.x * inv_s;
y = c.y * inv_s;
z = c.z * inv_s;
w = STOVAL(0.5) * s;
}
else
{
Vector3 axis = Vector3::RIGHT.CrossProduct(norm_start);
if (EpsLt(axis.GetLength(), STOVAL(0.0)))
{
FromAngleAxis(STOVAL(180), Vector3::UP.CrossProduct(norm_start));
}
else
{
FromAngleAxis(STOVAL(180), axis);
}
}
}
// ------------------------------------------------------------------------------------------------
Quaternion Quaternion::Inverse() const
{
const Value len_squared = LengthSquared();
if (EpsEq(len_squared, STOVAL(1.0)))
{
return Conjugate();
}
else if (EpsGtEq(len_squared, STOVAL(0.0)))
{
return Conjugate() * (STOVAL(1.0) / len_squared);
}
else
{
return IDENTITY;
}
}
// ------------------------------------------------------------------------------------------------
Vector3 Quaternion::ToEuler() const
{
const Float64 sqw = (w * w);
const Float64 sqx = (x * x);
const Float64 sqy = (y * y);
const Float64 sqz = (z * z);
const Float64 test = 2.0 * ((y * w) - (x * z));
if (EpsEq(test, 1.0))
{
2020-03-22 08:16:40 +01:00
return {
// bank = rotation about x-axis
STOVAL(0.0),
// attitude = rotation about y-axis
STOVAL(SQMOD_PI64 / 2.0),
// heading = rotation about z-axis
STOVAL(-2.0 * std::atan2(x, w))
2020-03-22 08:16:40 +01:00
};
}
else if (EpsEq(test, -1.0))
{
2020-03-22 08:16:40 +01:00
return {
// bank = rotation about x-axis
STOVAL(0.0),
// attitude = rotation about y-axis
STOVAL(SQMOD_PI64 / -2.0),
// heading = rotation about z-axis
STOVAL(2.0 * std::atan2(x, w))
2020-03-22 08:16:40 +01:00
};
}
2020-03-22 08:16:40 +01:00
return {
// bank = rotation about x-axis
STOVAL(std::atan2(2.0 * ((y * z) + (x * w)), (-sqx - sqy + sqz + sqw))),
// attitude = rotation about y-axis
STOVAL(std::asin(Clamp(test, -1.0, 1.0))),
// heading = rotation about z-axis
STOVAL(std::atan2(2.0 * ((x * y) + (z * w)), (sqx - sqy - sqz + sqw)))
2020-03-22 08:16:40 +01:00
};
}
// ------------------------------------------------------------------------------------------------
Quaternion::Value Quaternion::YawAngle() const
{
return ToEuler().y;
}
// ------------------------------------------------------------------------------------------------
Quaternion::Value Quaternion::PitchAngle() const
{
return ToEuler().x;
}
// ------------------------------------------------------------------------------------------------
Quaternion::Value Quaternion::RollAngle() const
{
return ToEuler().z;
}
// ------------------------------------------------------------------------------------------------
Quaternion Quaternion::Slerp(Quaternion quat, Value t) const
{
// Favor accuracy for native code builds
Value cos_angle = DotProduct(quat);
// Enable shortest path rotation
if (EpsLt(cos_angle, STOVAL(0.0)))
{
cos_angle = -cos_angle;
quat = -quat;
}
const Value angle = std::acos(cos_angle);
Value sin_angle = std::sin(angle);
Value t1, t2;
if (sin_angle > STOVAL(0.001))
{
Value inv_sin_angle = STOVAL(1.0) / sin_angle;
t1 = std::sin((STOVAL(1.0) - t) * angle) * inv_sin_angle;
t2 = std::sin(t * angle) * inv_sin_angle;
}
else
{
t1 = STOVAL(1.0) - t;
t2 = t;
}
return ((*this) * t1 + quat * t2);
}
// ------------------------------------------------------------------------------------------------
Quaternion Quaternion::Nlerp(const Quaternion & quat, Value t) const
{
return NlerpEx(quat, t, false);
}
// ------------------------------------------------------------------------------------------------
Quaternion Quaternion::NlerpEx(const Quaternion & quat, Value t, bool shortest_path) const
{
Quaternion result;
const Value fcos = DotProduct(quat);
if (EpsLt(fcos, STOVAL(0.0)) && shortest_path)
{
result = (*this) + (((-quat) - (*this)) * t);
}
else
{
result = (*this) + ((quat - (*this)) * t);
}
result.Normalize();
return result;
}
// ------------------------------------------------------------------------------------------------
const Quaternion & Quaternion::Get(StackStrF & str)
{
return Quaternion::GetEx(Quaternion::Delim, str);
}
// ------------------------------------------------------------------------------------------------
LightObj Quaternion::Format(const String & spec, StackStrF & fmt) const
{
String out;
// Attempt to build the format string
if (!BuildFormatString(out, fmt, 4, spec))
{
return LightObj{}; // Default to null
}
// Empty string is unacceptable
else if (out.empty())
{
STHROWF("Unable to build a valid format string.");
}
// Grab a temporary buffer
Buffer buff(out.size());
// Generate the string
Buffer::SzType n = buff.WriteF(0, out.c_str(), x, y, z, w);
// Did the format failed?
if (!n && !out.empty())
{
STHROWF("Format failed. Please check format specifier and parameter count.");
}
// Return the resulted string
return LightObj{buff.Begin< SQChar >(), static_cast< SQInteger >(n)};
}
// ------------------------------------------------------------------------------------------------
const Quaternion & Quaternion::GetEx(SQChar delim, StackStrF & str)
{
static Quaternion quat;
// Clear previous values, if any
quat.Clear();
// Is the specified string empty?
if (str.mLen <= 0)
{
return quat; // Return the value as is!
}
// The format specifications that will be used to scan the string
SQChar fs[] = _SC(" %f , %f , %f , %f ");
// Assign the specified delimiter
fs[4] = delim;
fs[9] = delim;
fs[14] = delim;
// Attempt to extract the component values from the specified string
std::sscanf(str.mPtr, fs, &quat.x, &quat.y, &quat.z, &quat.w);
// Return the resulted value
return quat;
}
2015-09-30 02:56:11 +02:00
// ================================================================================================
2020-03-22 08:16:40 +01:00
#pragma clang diagnostic push
#pragma clang diagnostic ignored "-Wunused-parameter"
void Register_Quaternion(HSQUIRRELVM vm)
2020-03-22 08:16:40 +01:00
#pragma clang diagnostic pop
2015-09-30 02:56:11 +02:00
{
typedef Quaternion::Value Val;
RootTable(vm).Bind(Typename::Str,
Class< Quaternion >(vm, Typename::Str)
// Constructors
2015-09-30 02:56:11 +02:00
.Ctor()
.Ctor< Val >()
.Ctor< Val, Val, Val >()
.Ctor< Val, Val, Val, Val >()
// Member Variables
.Var(_SC("x"), &Quaternion::x)
.Var(_SC("y"), &Quaternion::y)
.Var(_SC("z"), &Quaternion::z)
.Var(_SC("w"), &Quaternion::w)
.Var(_SC("X"), &Quaternion::x)
.Var(_SC("Y"), &Quaternion::y)
.Var(_SC("Z"), &Quaternion::z)
.Var(_SC("W"), &Quaternion::w)
// Core Meta-methods
.SquirrelFunc(_SC("cmp"), &SqDynArgFwd< SqDynArgCmpFn< Quaternion >, SQFloat, SQInteger, bool, std::nullptr_t, Quaternion >)
.SquirrelFunc(_SC("_typename"), &Typename::Fn)
.Func(_SC("_tostring"), &Quaternion::ToString)
// Meta-methods
.SquirrelFunc(_SC("_add"), &SqDynArgFwd< SqDynArgAddFn< Quaternion >, SQFloat, SQInteger, bool, std::nullptr_t, Quaternion >)
.SquirrelFunc(_SC("_sub"), &SqDynArgFwd< SqDynArgSubFn< Quaternion >, SQFloat, SQInteger, bool, std::nullptr_t, Quaternion >)
.SquirrelFunc(_SC("_mul"), &SqDynArgFwd< SqDynArgMulFn< Quaternion >, SQFloat, SQInteger, bool, std::nullptr_t, Quaternion >)
.SquirrelFunc(_SC("_div"), &SqDynArgFwd< SqDynArgDivFn< Quaternion >, SQFloat, SQInteger, bool, std::nullptr_t, Quaternion >)
.SquirrelFunc(_SC("_modulo"), &SqDynArgFwd< SqDynArgModFn< Quaternion >, SQFloat, SQInteger, bool, std::nullptr_t, Quaternion >)
.Func< Quaternion (Quaternion::*)(void) const >(_SC("_unm"), &Quaternion::operator -)
// Properties
.Prop(_SC("Abs"), &Quaternion::Abs)
.Prop(_SC("NaN"), &Quaternion::IsNaN)
.Prop(_SC("LengthSq"), &Quaternion::LengthSquared)
.Prop(_SC("Conjugate"), &Quaternion::Conjugate)
.Prop(_SC("Normalized"), &Quaternion::Normalized)
.Prop(_SC("Inverse"), &Quaternion::Inverse)
.Prop(_SC("Euler"), &Quaternion::ToEuler, &Quaternion::SetVector3)
.Prop(_SC("YawAngle"), &Quaternion::YawAngle)
.Prop(_SC("PitchAngle"), &Quaternion::PitchAngle)
.Prop(_SC("RollAngle"), &Quaternion::RollAngle)
// Member Methods
.Func(_SC("SetScalar"), &Quaternion::SetScalar)
.Func(_SC("SetQuaternion"), &Quaternion::SetQuaternion)
.Func(_SC("SetQuaternionEx"), &Quaternion::SetQuaternionEx)
.Func(_SC("SetVector3"), &Quaternion::SetVector3)
.Func(_SC("SetVector3Ex"), &Quaternion::SetVector3Ex)
.Func(_SC("SetVector4"), &Quaternion::SetVector4)
.FmtFunc(_SC("SetStr"), &Quaternion::SetStr)
.Func(_SC("Clear"), &Quaternion::Clear)
.FmtFunc(_SC("Format"), &Quaternion::Format)
.Func(_SC("DotProduct"), &Quaternion::DotProduct)
.Func(_SC("Normalize"), &Quaternion::Normalize)
.Func(_SC("FromAngleAxis"), &Quaternion::FromAngleAxis)
.Func(_SC("FromRotationTo"), &Quaternion::FromRotationTo)
.Func(_SC("Slerp"), &Quaternion::Slerp)
.Func(_SC("Nlerp"), &Quaternion::Nlerp)
.Func(_SC("NlerpEx"), &Quaternion::NlerpEx)
// Member Overloads
.Overload< void (Quaternion::*)(void) >(_SC("Generate"), &Quaternion::Generate)
.Overload< void (Quaternion::*)(Val, Val) >(_SC("Generate"), &Quaternion::Generate)
.Overload< void (Quaternion::*)(Val, Val, Val, Val, Val, Val, Val, Val) >(_SC("Generate"), &Quaternion::Generate)
// Static Functions
.StaticFunc(_SC("GetDelimiter"), &SqGetDelimiter< Quaternion >)
.StaticFunc(_SC("SetDelimiter"), &SqSetDelimiter< Quaternion >)
.StaticFmtFunc(_SC("FromStr"), &Quaternion::Get)
.StaticFmtFunc(_SC("FromStrEx"), &Quaternion::GetEx)
// Operator Exposure
.Func< Quaternion & (Quaternion::*)(const Quaternion &) >(_SC("opAddAssign"), &Quaternion::operator +=)
.Func< Quaternion & (Quaternion::*)(const Quaternion &) >(_SC("opSubAssign"), &Quaternion::operator -=)
.Func< Quaternion & (Quaternion::*)(const Quaternion &) >(_SC("opMulAssign"), &Quaternion::operator *=)
.Func< Quaternion & (Quaternion::*)(const Quaternion &) >(_SC("opDivAssign"), &Quaternion::operator /=)
.Func< Quaternion & (Quaternion::*)(const Quaternion &) >(_SC("opModAssign"), &Quaternion::operator %=)
.Func< Quaternion & (Quaternion::*)(Quaternion::Value) >(_SC("opAddAssignS"), &Quaternion::operator +=)
.Func< Quaternion & (Quaternion::*)(Quaternion::Value) >(_SC("opSubAssignS"), &Quaternion::operator -=)
.Func< Quaternion & (Quaternion::*)(Quaternion::Value) >(_SC("opMulAssignS"), &Quaternion::operator *=)
.Func< Quaternion & (Quaternion::*)(Quaternion::Value) >(_SC("opDivAssignS"), &Quaternion::operator /=)
.Func< Quaternion & (Quaternion::*)(Quaternion::Value) >(_SC("opModAssignS"), &Quaternion::operator %=)
.Func< Quaternion & (Quaternion::*)(void) >(_SC("opPreInc"), &Quaternion::operator ++)
.Func< Quaternion & (Quaternion::*)(void) >(_SC("opPreDec"), &Quaternion::operator --)
.Func< Quaternion (Quaternion::*)(int) >(_SC("opPostInc"), &Quaternion::operator ++)
.Func< Quaternion (Quaternion::*)(int) >(_SC("opPostDec"), &Quaternion::operator --)
.Func< Quaternion (Quaternion::*)(const Quaternion &) const >(_SC("opAdd"), &Quaternion::operator +)
.Func< Quaternion (Quaternion::*)(const Quaternion &) const >(_SC("opSub"), &Quaternion::operator -)
.Func< Quaternion (Quaternion::*)(const Quaternion &) const >(_SC("opMul"), &Quaternion::operator *)
.Func< Quaternion (Quaternion::*)(const Quaternion &) const >(_SC("opDiv"), &Quaternion::operator /)
.Func< Quaternion (Quaternion::*)(const Quaternion &) const >(_SC("opMod"), &Quaternion::operator %)
.Func< Quaternion (Quaternion::*)(Quaternion::Value) const >(_SC("opAddS"), &Quaternion::operator +)
.Func< Quaternion (Quaternion::*)(Quaternion::Value) const >(_SC("opSubS"), &Quaternion::operator -)
.Func< Quaternion (Quaternion::*)(Quaternion::Value) const >(_SC("opMulS"), &Quaternion::operator *)
.Func< Quaternion (Quaternion::*)(Quaternion::Value) const >(_SC("opDivS"), &Quaternion::operator /)
.Func< Quaternion (Quaternion::*)(Quaternion::Value) const >(_SC("opModS"), &Quaternion::operator %)
.Func< Quaternion (Quaternion::*)(void) const >(_SC("opUnPlus"), &Quaternion::operator +)
.Func< Quaternion (Quaternion::*)(void) const >(_SC("opUnMinus"), &Quaternion::operator -)
.Func< bool (Quaternion::*)(const Quaternion &) const >(_SC("opEqual"), &Quaternion::operator ==)
.Func< bool (Quaternion::*)(const Quaternion &) const >(_SC("opNotEqual"), &Quaternion::operator !=)
.Func< bool (Quaternion::*)(const Quaternion &) const >(_SC("opLessThan"), &Quaternion::operator <)
.Func< bool (Quaternion::*)(const Quaternion &) const >(_SC("opGreaterThan"), &Quaternion::operator >)
.Func< bool (Quaternion::*)(const Quaternion &) const >(_SC("opLessEqual"), &Quaternion::operator <=)
.Func< bool (Quaternion::*)(const Quaternion &) const >(_SC("opGreaterEqual"), &Quaternion::operator >=)
2015-09-30 02:56:11 +02:00
);
}
} // Namespace:: SqMod