Manipulation Planning with Tight Geometric Constraints