diff --git a/new_main.py b/new_main.py index 985c21a..3fe0de2 100644 --- a/new_main.py +++ b/new_main.py @@ -99,6 +99,10 @@ class PickAndPlace(object): # approach with a pose the hover-distance above the requested pose approach.position.z = approach.position.z + self._hover_distance joint_angles = self.ik_request(approach) + print('---------') + print('IK Solution:') + print(joint_angles) + print('---------') self._guarded_move_to_joint_position(joint_angles) def _retract(self):