Working forwards and back
With states!
code cleaning, took out unnecessary code
Attempt to correct difference in motor speed.
Fixed alignment issues