Fork of the Constrained Manipulation Planning Suite (CoMPS) by Dmitry Berenson