From 1c1af8b57715a77eeefa6105863b95bcac417e40 Mon Sep 17 00:00:00 2001
From: Jonas Rauber <kit@jonasrauber.de>
Date: Fri, 29 Aug 2014 11:14:11 +0200
Subject: [PATCH] fixed KinematicUnitSimulation

---
 source/RobotAPI/units/KinematicUnitSimulation.cpp | 1 +
 1 file changed, 1 insertion(+)

diff --git a/source/RobotAPI/units/KinematicUnitSimulation.cpp b/source/RobotAPI/units/KinematicUnitSimulation.cpp
index 6f4af469d..f7c0eabf1 100644
--- a/source/RobotAPI/units/KinematicUnitSimulation.cpp
+++ b/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!";
-- 
GitLab