Indy now follows IR beacon like the boss that he is.

Fixed the PID class to have a more intuitive error. Temporary solution to weird flashing motor effect in ROCKPIT state by printing LCD.