public static Vector3 InterpConstantSpeed(Spline.Path pts, float t, EasingType ease, bool easeIn, bool easeOut)
{
t = Spline.Ease(t, ease, easeIn, easeOut);
if (pts.Length == 0)
{
return(Vector3.zero);
}
if (pts.Length == 1)
{
return(pts[0]);
}
if (pts.Length == 2)
{
return(Vector3.Lerp(pts[0], pts[1], t));
}
if (pts.Length == 3)
{
return(QuadBez.Interp(pts[0], pts[2], pts[1], t));
}
if (pts.Length == 4)
{
return(CubicBez.Interp(pts[0], pts[3], pts[1], pts[2], t));
}
return(CRSpline.InterpConstantSpeed(Spline.Wrap(pts), t));
}
public static void GizmoDraw(Vector3 st, Vector3 en, Vector3 ctrl, float t)
{
Gizmos.color = Color.red;
Gizmos.DrawLine(st, ctrl);
Gizmos.DrawLine(ctrl, en);
Gizmos.color = Color.white;
Vector3 to = st;
for (int i = 1; i <= 20; i++)
{
float t2 = (float)i / 20f;
Vector3 vector = QuadBez.Interp(st, en, ctrl, t2);
Gizmos.DrawLine(vector, to);
to = vector;
}
Gizmos.color = Color.blue;
Vector3 vector2 = QuadBez.Interp(st, en, ctrl, t);
Gizmos.DrawLine(vector2, vector2 + QuadBez.Velocity(st, en, ctrl, t));
}