P Control

-Software thresholded camera in the ADC interrupt.
-Line detection function added
-Steering servos use scaled error signal as input