Fix the missing ground wires and improve line following algorithm