Add tests for piecewise linear interpolation.
Fix quaternion bug.
Add tests for quaternion spline.