Open
Description
evaluateDerivative
on SplineTrajectory
currently returns a tangent vector in the tangent space of the start of the segment, instead of the local ("body") frame. We should use the adjoint transformation to transform the first derivative into the correct frame. I am not sure what the general form of this transformation is for higher-order derivatives.