Optimal Reachability and Grasping for a Soft Manipulator