C. S. Bonaventura Kathryn W. Jablokow A Modular Dynamic Simulation Algorithm for Complex Robot Systems. 3226-3233 2004 conf/icra/2004 ICRA http://dx.doi.org/10.1109/ROBOT.2004.1308751 db/conf/icra/icra2004-4.html#BonaventuraJ04