Przemyslaw Herman, Krzysztof Kozlowski: Trajectory optimization in terms of quasi-velocity vector. CDC 2006: 881-886