Inverting step procedure to accomidate external forces
Fixed a few bugs, and the units in the config. Need to check sign conventions to re-stabilize
Stable lateral motiongdb ./AppCordeTest
A few more bugfixes and property changes