Na podstawie schematu i zdjęć możesz bez problemu skopiować go, softu nie będę udostępniał ze względu na to, że jest rozwijany cały czas oraz zawiera kilka moich sprytnych rozwiązań.
Wzorując się jak ja na kodzie z tej stronki:
http://www.wrighthobbies.net/guides/linefollower.htm
można samemu coś napisać, ale jak już wspominałem wyżej, według mnie w tym kodzie są błędy, które uniemożliwiają bądź utrudniają poprawną pracę linefollowera.