Geometric Modeling for Robot Task Planning