bugFix: ros-industrial#61 - fix joint-name remapping in industrial_ro…

…bot_simulator
OrebroUniversity · May 22, 2013 · 31e336a · 31e336a
1 parent 69b9dfe
commit 31e336a
Showing 1 changed file with 2 additions and 1 deletion.
diff --git a/industrial_robot_simulator/industrial_robot_simulator b/industrial_robot_simulator/industrial_robot_simulator
@@ -305,7 +305,7 @@ class IndustrialRobotSimulatorNode():
 
                 for point in msg_in.points:
 
-                    self._to_controller_order(msg_in.joint_names, point)
+                    point = self._to_controller_order(msg_in.joint_names, point)
                     self.motion_ctrl.add_motion_waypoint(point)
 
         except Exception as e:
@@ -332,6 +332,7 @@ class IndustrialRobotSimulatorNode():
         pt_rtn = copy.deepcopy(point)
         pt_rtn.positions = self._remap_order(self.joint_names, keys, point.positions)
 
+        return pt_rtn
 
     def _remap_order(self, ordered_keys, value_keys, values):