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));
}
// else
// {
// return Vector3.Distance(_capturedPositions[mover][fromInd], _capturedPositions[mover][toInd]);
// }
}
public void StartNextPart(WaypointsMover mover, int fromInd, int toInd, bool isForwardDirection)
{
Vector3 toPosition = CapturePosition(mover, toInd);
//if (IsCurved)
{
Vector3 handle1 = isForwardDirection ? GetHandle1(mover, fromInd) : GetHandle2(mover, fromInd);
Vector3 handle2 = isForwardDirection ? GetHandle2(mover, toInd) : GetHandle1(mover, toInd);
_moversParts[mover] = BezierApproximation.GetLines(_capturedPositions[mover][fromInd], handle1, toPosition, handle2, LinesCount);
}
// else
// {
// _moversParts[mover] = new List<Vector3> {_capturedPositions[mover][fromInd], toPosition};
// }
ClearDestroyedMovers();
}
public List <Vector3> GetPoints()
{
List <Vector3> points = new List <Vector3>();
//if (IsCurved)
{
for (int ind = 0; ind < Waypoints.Count; ind++)
{
if (ind == Waypoints.Count - 1)
{
continue;
}
int nextInd = (ind + 1) % Waypoints.Count;
float length = BezierApproximation.GetLength(
Waypoints[ind].position, GetHandle1(ind),
Waypoints[nextInd].position, GetHandle2(nextInd), SampleCount);
float unityPerStep = ind < UnitPerStep.Count ? UnitPerStep[ind] : 2f;
int count = Mathf.CeilToInt(length / unityPerStep);
List <Vector3> lines = BezierApproximation.GetLines(
Waypoints[ind].position, GetHandle1(ind),
Waypoints[nextInd].position, GetHandle2(nextInd), count);
if (points.Any())
{
points.RemoveAt(points.Count - 1);
}
points.AddRange(lines);
}
}
// else
// {
// points.AddRange(Waypoints.Select(_ => _.position));
// if (IsClosed)
// points.Add(Waypoints[0].position);
// }
return(points);
}
