public static MatrixD BSpline(MatrixD a, MatrixD b, float t)
{
var up = Vector3D.Lerp(a.Up, b.Up, t);
var bez = new CubicCurve(a, b);
var x = bez.Sample(t);
var fwd = bez.SampleDerivative(t);
return(MatrixD.CreateWorld(x, Vector3D.Normalize(fwd), Vector3D.Normalize(up)));
}
public Vector3D Sample(float t)
{
return(Vector3D.Transform(SphericalExtensions.FromSpherical(_curve.Sample(t)), _matrix));
}