Add robot tracking
Added straight and turn methods, with psuedo code for the robot tracking.
Encoder methods
Fixing merge issues