public Vector3 GetPoint(WaypointsMover mover, float time)
{
if (IsCurved)
{
float fullLength = BezierApproximation.GetLength(_moversParts[mover]);
float remainedLength = fullLength * (time - 0.001f);
for (int i = 0; i < _moversParts[mover].Count - 1; i++)
{
Vector3 point1 = _moversParts[mover][i];
Vector3 point2 = _moversParts[mover][i + 1];
float lineLength = Vector3.Distance(point1, point2);
if (lineLength < remainedLength)
{
remainedLength -= lineLength;
}
else
{
return(point1 + (point2 - point1).normalized * remainedLength);
}
}
throw new Exception("Get point error for time:" + time + ", remainedLength: " + remainedLength);
}
else
{
Vector3 point1 = _moversParts[mover][0];
Vector3 point2 = _moversParts[mover][1];
float fullLength = Vector3.Distance(point1, point2);
float remainedLength = fullLength * time;
return(point1 + (point2 - point1).normalized * remainedLength);
}
}
public float GetLength(WaypointsMover mover, int fromInd, int toInd, bool isForwardDirection)
{
if (IsCurved)
{
Vector3 handle1 = isForwardDirection ? GetHandle1(mover, fromInd) : GetHandle2(mover, fromInd);
Vector3 handle2 = isForwardDirection ? GetHandle2(mover, toInd) : GetHandle1(mover, toInd);
return(BezierApproximation.GetLength(_capturedPositions[mover][fromInd], handle1,
_capturedPositions[mover][toInd], handle2, LinesCount));
}
return(Vector3.Distance(_capturedPositions[mover][fromInd], _capturedPositions[mover][toInd]));
}