Got rid of position bounds. Tuned parameters for FORCES SQP
Merge branch 'master' into rll3
Fix filling in of bounds
Merge master
Tuned parameters, compared SQP to exact connection