reachability_checking now returns valid results, although pregrasp approach is still off