Added CoM Collision Contraint (source, header, bindings, test)