Affordance-Aware Task and Motion Planning

We developed a task and motion planning framework that allows a robot to solve high-level manipulation tasks by combining its own motion primitives with the affordances of surrounding objects. The system automatically generates executable plans, checks physical feasibility at the motion level, and adapts to changes in the environment. On a Stretch robot, this enabled flexible task completion, including substituting tools when different objects offered the same affordance.