c++ vectors in body and constraints were changed to armadillo vectors.