in gym_hil/envs/panda_arrange_boxes_gym_env.py [0:0]
def _is_success(self) -> bool:
"""Check if the task is successfully completed."""
block_sensors, target_sensors = self._get_sensors()
distances = [
np.linalg.norm(block.data - target.data)
for block, target in zip(block_sensors, target_sensors, strict=False)
]
return all(dist < 0.03 for dist in distances)