Geometrically Constrained Path Planning for Robotic Grasping with Differential Evolution and Fast Marching Square