1. Forgot to default reset to start pos.
2. Added interface methods to the dynamixel servo class to get/set registers. Not been tested yet.
3. Fixed a bug with the vortex motor velocity where it was not loading correctly after the motor stim changes.
4. Found a bug when trying to run the sim on a different computer it does not reset the motors to start pos. Still trying to track this down.