fixed KinematicUnitSimulation

source/RobotAPI/units/KinematicUnitSimulation.cpp

@@ -206,6 +206,7 @@ void KinematicUnitSimulation::setJointAngles(const NameValueMap& targetJointAngl
                 targetJointAngle = std::min<float>(targetJointAngle, jointInfos[targetJointName].limitHi);
             }
             iterJoints->second.angle = targetJointAngle;
+            actualJointAngles[targetJointName] = iterJoints->second.angle;
         }
         else
             ARMARX_WARNING << "Joint not found!";