diff --git a/VirtualRobot/Dynamics/dynamics.cpp b/VirtualRobot/Dynamics/dynamics.cpp index 22e328d701de4272b3beb35cfb7a1a49831a29c8..0690c10c3d2e68ef062bd46bd89914c9026c11bf 100644 --- a/VirtualRobot/Dynamics/dynamics.cpp +++ b/VirtualRobot/Dynamics/dynamics.cpp @@ -63,7 +63,7 @@ VirtualRobot::Dynamics::Dynamics(RobotNodeSetPtr rns, RobotNodeSetPtr rnsBodies, Eigen::VectorXd Dynamics::getInverseDynamics(const Eigen::VectorXd& q, const Eigen::VectorXd& qdot, const Eigen::VectorXd& qddot) { Eigen::VectorXd tau = Eigen::VectorXd::Zero(Dynamics::model->dof_count); - InverseDynamics(*model.get(), q, qdot, qddot, tau); + getInverseDynamics(q, qdot, qddot, tau); return tau; }