Updated forward and rotate functions

Implemented position tracking and corrective factors for the forward()
and rotate() functions. Note to self. Don't drive backwards.