Krzysztof Kozlowski Standard and Diagonalized lagrangian Dynamics: A Comparison. 2823-2828 1995 conf/icra/1995 ICRA db/conf/icra/icra1995-3.html#Kozlowski95 https://doi.org/10.1109/ROBOT.1995.525683