heuristic approach to get arm out of the mess when planning fails to retract it
refactored collision environment creation out of generate_valid_poses