Add Initial PID-controller for following a line