Fork of the Constrained Manipulation Planning Suite (CoMPS) by Dmitry Berenson - View it on GitHub