Start by IR-controll, correct integration of analog IR sensors and some minor fixes to the code.