in gym_hil/envs/panda_pick_gym_env.py [0:0]
def _is_success(self) -> bool:
"""Check if the task is successfully completed."""
block_pos = self._data.sensor("block_pos").data
tcp_pos = self._data.sensor("2f85/pinch_pos").data
dist = np.linalg.norm(block_pos - tcp_pos)
lift = block_pos[2] - self._z_init
return dist < 0.05 and lift > 0.1