Feedback and Refactoring

More motor feedback testing as well as switching over ot writing to
LATCHES