diff --git a/intera_interface/src/intera_motion_interface/motion_waypoint.py b/intera_interface/src/intera_motion_interface/motion_waypoint.py index 23aa437..7c0c435 100644 --- a/intera_interface/src/intera_motion_interface/motion_waypoint.py +++ b/intera_interface/src/intera_motion_interface/motion_waypoint.py @@ -164,9 +164,9 @@ def set_cartesian_pose(self, pose = None, This is used as the nullspace bias if set. """ if pose is None: - self._data.pose = PoseStamped() # empty pose + self._data.pose = PoseStamped() # empty pose else: - self._data.pose = pose + self._data.pose = pose if active_endpoint is None: active_endpoint = MotionWaypoint.get_default_active_endpoint()