Got the line tracer and stop conditions working.
Gains not perfected yet