added to grasp planner to point at grasp position for last 25% of timesteps
added raycast pointcloud to kinfu. added camera pose publish to handle detector. see if this works with occluded handle_detector turned on
merged
got rid of raycasting. add planning back in planner
Now adds planes as occlussions.