Hi, I want to drive a robot on a staright line and when it moves from line the HT compass sensor will idenify it and the robot will correct himself and steer back to the straight line, any Ideas how to program it? example: https://www.youtube.com/watch?v=2Tbc2cIsQqo .