diff --git a/SimDynamics/DynamicsEngine/BulletEngine/BulletRobot.cpp b/SimDynamics/DynamicsEngine/BulletEngine/BulletRobot.cpp index 9b34a3829edade24e82e936d0cc261c3d3b1c6b7..e2779c664759efc71ea337db70e0afffe0489c8d 100644 --- a/SimDynamics/DynamicsEngine/BulletEngine/BulletRobot.cpp +++ b/SimDynamics/DynamicsEngine/BulletEngine/BulletRobot.cpp @@ -900,7 +900,7 @@ void BulletRobot::actuateJoints(btScalar dt) int jointCounter = 0; - while (it!=actuationTargets.end()) + for (; it != actuationTargets.end(); it++) { //BulletObjectPtr drn; //if (it->second.dynNode) @@ -1095,9 +1095,8 @@ void BulletRobot::actuateJoints(btScalar dt) */ #endif } - - it++; } + setPoseNonActuatedRobotNodes(); }