mirror of https://github.com/AxioDL/metaforce.git
141 lines
4.0 KiB
C++
141 lines
4.0 KiB
C++
#include "CSteeringBehaviors.hpp"
|
|
|
|
namespace urde
|
|
{
|
|
|
|
zeus::CVector3f CSteeringBehaviors::Flee(const CPhysicsActor& actor,
|
|
const zeus::CVector3f& v0) const
|
|
{
|
|
return {};
|
|
}
|
|
|
|
zeus::CVector3f CSteeringBehaviors::Seek(const CPhysicsActor& actor,
|
|
const zeus::CVector3f& v0) const
|
|
{
|
|
return {};
|
|
}
|
|
|
|
zeus::CVector3f CSteeringBehaviors::Arrival(const CPhysicsActor& actor,
|
|
const zeus::CVector3f& v0, float f1) const
|
|
{
|
|
return {};
|
|
}
|
|
|
|
zeus::CVector3f CSteeringBehaviors::Pursuit(const CPhysicsActor& actor,
|
|
const zeus::CVector3f& v0, const zeus::CVector3f& v1) const
|
|
{
|
|
return {};
|
|
}
|
|
|
|
zeus::CVector3f CSteeringBehaviors::Separation(const CPhysicsActor& actor,
|
|
const zeus::CVector3f& v0, float f1) const
|
|
{
|
|
return {};
|
|
}
|
|
|
|
zeus::CVector3f CSteeringBehaviors::Alignment(const CPhysicsActor& actor,
|
|
rstl::reserved_vector<TUniqueId, 1024>& list, const CStateManager& mgr) const
|
|
{
|
|
return {};
|
|
}
|
|
|
|
zeus::CVector3f CSteeringBehaviors::Cohesion(const CPhysicsActor& actor,
|
|
rstl::reserved_vector<TUniqueId, 1024>& list, float f1, const CStateManager& mgr) const
|
|
{
|
|
return {};
|
|
}
|
|
|
|
zeus::CVector3f CSteeringBehaviors::Flee2D(const CPhysicsActor& actor,
|
|
const zeus::CVector2f& v0) const
|
|
{
|
|
return {};
|
|
}
|
|
|
|
zeus::CVector3f CSteeringBehaviors::Arrival2D(const CPhysicsActor& actor,
|
|
const zeus::CVector2f& v0, float f1) const
|
|
{
|
|
return {};
|
|
}
|
|
|
|
bool CSteeringBehaviors::SolveQuadratic(float f30, float f31, float f3, float f4, float& out1, float& out2)
|
|
{
|
|
float f1 = f31 * f31 - 4.f * f30 * f3;
|
|
if (f1 > FLT_EPSILON && std::fabs(f1) < FLT_EPSILON)
|
|
return false;
|
|
|
|
out1 = -f31 + std::sqrt(f1) / 2.f * f30;
|
|
out2 = -f31 - std::sqrt(f1) / 2.f * f30;
|
|
return true;
|
|
}
|
|
|
|
bool CSteeringBehaviors::SolveCubic(
|
|
const rstl::reserved_vector<float, 4>& in, rstl::reserved_vector<float, 4>& out)
|
|
{
|
|
return false;
|
|
}
|
|
|
|
bool CSteeringBehaviors::SolveQuartic(
|
|
const rstl::reserved_vector<float, 5>& in, rstl::reserved_vector<float, 4>& out)
|
|
{
|
|
return false;
|
|
}
|
|
|
|
zeus::CVector3f CSteeringBehaviors::ProjectLinearIntersection(const zeus::CVector3f& v0, float f1,
|
|
const zeus::CVector3f& v1, const zeus::CVector3f& v2, zeus::CVector3f& v3)
|
|
{
|
|
return {};
|
|
}
|
|
|
|
zeus::CVector3f CSteeringBehaviors::ProjectLinearIntersection(const zeus::CVector3f& v0, float f1,
|
|
const zeus::CVector3f& v1, const zeus::CVector3f& v2, const zeus::CVector3f& v3, zeus::CVector3f& v4)
|
|
{
|
|
return {};
|
|
}
|
|
|
|
zeus::CVector3f CSteeringBehaviors::ProjectOrbitalIntersection(const zeus::CVector3f& v0, float f1,
|
|
const zeus::CVector3f& v1, const zeus::CVector3f& v2, const zeus::CVector3f& v3, zeus::CVector3f& v4)
|
|
{
|
|
return {};
|
|
}
|
|
|
|
zeus::CVector3f CSteeringBehaviors::ProjectOrbitalIntersection(const zeus::CVector3f& v0, float f1,
|
|
const zeus::CVector3f& v1, const zeus::CVector3f& v2, const zeus::CVector3f& v3,
|
|
const zeus::CVector3f& v4, zeus::CVector3f& v5)
|
|
{
|
|
return {};
|
|
}
|
|
|
|
zeus::CVector3f
|
|
CSteeringBehaviors::ProjectOrbitalPosition(const zeus::CVector3f& pos, const zeus::CVector3f& vel,
|
|
const zeus::CVector3f& orbitPoint, float dt, float preThinkDt)
|
|
{
|
|
zeus::CVector3f usePos = pos;
|
|
if (vel.canBeNormalized())
|
|
{
|
|
zeus::CVector3f pointToPos = pos - orbitPoint;
|
|
pointToPos.z = 0.f;
|
|
if (pointToPos.canBeNormalized())
|
|
{
|
|
zeus::CVector3f useVel = vel;
|
|
pointToPos.normalize();
|
|
float f29 = pointToPos.dot(useVel);
|
|
float f30 = pointToPos.cross(zeus::CVector3f::skUp).dot(useVel);
|
|
for (float curDt = 0.f ; curDt < dt ;)
|
|
{
|
|
usePos += preThinkDt * useVel;
|
|
zeus::CVector3f usePointToPos = usePos - orbitPoint;
|
|
usePointToPos.z = 0.f;
|
|
if (usePointToPos.canBeNormalized())
|
|
{
|
|
usePointToPos.normalize();
|
|
useVel = usePointToPos.cross(zeus::CVector3f::skUp) * f30 + usePointToPos * f29;
|
|
}
|
|
curDt += std::min(dt - curDt, preThinkDt);
|
|
}
|
|
}
|
|
}
|
|
return usePos;
|
|
}
|
|
|
|
}
|