Cleaned up and basic timing for robot to turn when integrating with A*
until compass arrives