Lazy Evaluation of Multi-Grasp Goals Guided by Motion Planning in Pick-and-Place Object Manipulation
This work integrates grasp planning and motion planning to jointly solve pick-and-place tasks in cluttered environments, where treating them separately often yields grasp poses the robot cannot reach. Grasp affordances are represented as continuous workspace goal regions that approximate the goal regions defined in configuration space, turning the task into an extended start-to-goal motion planning problem solved with a sampling-based tree planner. Simulated and real-world Franka Emika experiments show improved grasping accuracy and higher manipulation success rates.