private void ComputeDistance(int ind)
{
Vector3 p0 = Positions[ClampIndex(ind - 1)];
Vector3 p1 = Positions[ind];
Vector3 p2 = Positions[ClampIndex(ind + 1)];
Vector3 p3 = Positions[ClampIndex(ind + 2)];
float distance = Vector3.Distance(p1, p2);
if (distance > MaxDistanceLimit)
{
Debug.LogWarning("please add more points rather than long distance , max allowed distance is between 2 nodes is:" + MaxDistanceLimit);
return;
}
for (float j = OffsetTrack; j <= distance; j += DistanceOffset)
{
float t = (j) / (distance);
if (t < 0 || t > 1)
{
continue;
}
if (j > distance - DistanceOffset)
{
OffsetTrack = DistanceOffset - (distance - j);
}
SonicPoint point = GetCatmullPoint(t, p0, p1, p2, p3);
Points.Add(point);
}
}
SonicPoint GetCatmullPoint(float t, Vector3 p0, Vector3 p1, Vector3 p2, Vector3 p3)
{
//The coefficients of the cubic polynomial (except the 0.5f * which I added later for performance)
Vector3 a = 2f * p1;
Vector3 b = p2 - p0;
Vector3 c = 2f * p0 - 5f * p1 + 4f * p2 - p3;
Vector3 d = -p0 + 3f * p1 - 3f * p2 + p3;
//The cubic polynomial: a + b * t + c * t^2 + d * t^3
Vector3 pos = 0.5f * (a + (b * t) + (c * t * t) + (d * t * t * t));
Vector3 tan = 0.5f * ((b) + 2 * (c * t) + 3 * (d * t * t));
SonicPoint point = new SonicPoint();
point.Position = pos;
point.Tangent = tan;
return(point);
}
private void ComputeDensity(int ind)
{
Vector3 p0 = Positions[ClampIndex(ind - 1)];
Vector3 p1 = Positions[ind];
Vector3 p2 = Positions[ClampIndex(ind + 1)];
Vector3 p3 = Positions[ClampIndex(ind + 2)];
//How many times should we loop?
int loops = Mathf.FloorToInt(1f / Resolution);
for (int i = 1; i <= loops; i++)
{
//Which t position are we at?
float t = i * Resolution;
//Find the coordinate between the end points with a Catmull-Rom spline
SonicPoint point = GetCatmullPoint(t, p0, p1, p2, p3);
Points.Add(point);
}
}
