86 lines
2.8 KiB
C++
86 lines
2.8 KiB
C++
// Jolt Physics Library (https://github.com/jrouwe/JoltPhysics)
|
|
// SPDX-FileCopyrightText: 2021 Jorrit Rouwe
|
|
// SPDX-License-Identifier: MIT
|
|
|
|
#include <Jolt/Jolt.h>
|
|
|
|
#include <Jolt/Physics/Constraints/PathConstraintPath.h>
|
|
#include <Jolt/Core/StreamUtils.h>
|
|
#ifdef JPH_DEBUG_RENDERER
|
|
#include <Jolt/Renderer/DebugRenderer.h>
|
|
#endif // JPH_DEBUG_RENDERER
|
|
|
|
JPH_NAMESPACE_BEGIN
|
|
|
|
JPH_IMPLEMENT_SERIALIZABLE_ABSTRACT(PathConstraintPath)
|
|
{
|
|
JPH_ADD_BASE_CLASS(PathConstraintPath, SerializableObject)
|
|
}
|
|
|
|
#ifdef JPH_DEBUG_RENDERER
|
|
// Helper function to transform the results of GetPointOnPath to world space
|
|
static inline void sTransformPathPoint(RMat44Arg inTransform, Vec3Arg inPosition, RVec3 &outPosition, Vec3 &ioNormal, Vec3 &ioBinormal)
|
|
{
|
|
outPosition = inTransform * inPosition;
|
|
ioNormal = inTransform.Multiply3x3(ioNormal);
|
|
ioBinormal = inTransform.Multiply3x3(ioBinormal);
|
|
}
|
|
|
|
// Helper function to draw a path segment
|
|
static inline void sDrawPathSegment(DebugRenderer *inRenderer, RVec3Arg inPrevPosition, RVec3Arg inPosition, Vec3Arg inNormal, Vec3Arg inBinormal)
|
|
{
|
|
inRenderer->DrawLine(inPrevPosition, inPosition, Color::sWhite);
|
|
inRenderer->DrawArrow(inPosition, inPosition + 0.1f * inNormal, Color::sRed, 0.02f);
|
|
inRenderer->DrawArrow(inPosition, inPosition + 0.1f * inBinormal, Color::sGreen, 0.02f);
|
|
}
|
|
|
|
void PathConstraintPath::DrawPath(DebugRenderer *inRenderer, RMat44Arg inBaseTransform) const
|
|
{
|
|
// Calculate first point
|
|
Vec3 lfirst_pos, first_tangent, first_normal, first_binormal;
|
|
GetPointOnPath(0.0f, lfirst_pos, first_tangent, first_normal, first_binormal);
|
|
RVec3 first_pos;
|
|
sTransformPathPoint(inBaseTransform, lfirst_pos, first_pos, first_normal, first_binormal);
|
|
|
|
float t_max = GetPathMaxFraction();
|
|
|
|
// Draw the segments
|
|
RVec3 prev_pos = first_pos;
|
|
for (float t = 0.1f; t < t_max; t += 0.1f)
|
|
{
|
|
Vec3 lpos, tangent, normal, binormal;
|
|
GetPointOnPath(t, lpos, tangent, normal, binormal);
|
|
RVec3 pos;
|
|
sTransformPathPoint(inBaseTransform, lpos, pos, normal, binormal);
|
|
sDrawPathSegment(inRenderer, prev_pos, pos, normal, binormal);
|
|
prev_pos = pos;
|
|
}
|
|
|
|
// Draw last point
|
|
Vec3 lpos, tangent, normal, binormal;
|
|
GetPointOnPath(t_max, lpos, tangent, normal, binormal);
|
|
RVec3 pos;
|
|
sTransformPathPoint(inBaseTransform, lpos, pos, normal, binormal);
|
|
sDrawPathSegment(inRenderer, prev_pos, pos, normal, binormal);
|
|
}
|
|
#endif // JPH_DEBUG_RENDERER
|
|
|
|
void PathConstraintPath::SaveBinaryState(StreamOut &inStream) const
|
|
{
|
|
inStream.Write(GetRTTI()->GetHash());
|
|
inStream.Write(mIsLooping);
|
|
}
|
|
|
|
void PathConstraintPath::RestoreBinaryState(StreamIn &inStream)
|
|
{
|
|
// Type hash read by sRestoreFromBinaryState
|
|
inStream.Read(mIsLooping);
|
|
}
|
|
|
|
PathConstraintPath::PathResult PathConstraintPath::sRestoreFromBinaryState(StreamIn &inStream)
|
|
{
|
|
return StreamUtils::RestoreObject<PathConstraintPath>(inStream, &PathConstraintPath::RestoreBinaryState);
|
|
}
|
|
|
|
JPH_NAMESPACE_END
|