Help with IR obstacle avoiding robot with two DC motors, a servo, L298N shield