Constrained Manipulation Planning