constraint and jacobian matrix A added
Merge branch 'master' of https://github.com/avoldsund/Optimization-project