Closest sample on b-spline

A closest sample on a b-spline, interpolated over the matrix sequence.
To build a matrix sequence I used a parallel transport based on the N control matrices.