Arduino2560四路光电开关循迹源程序.docVIP

Arduino2560 四路光电开关 循迹源程序 河南大学——邵荣 王高潮 王艺 #include DistanceSRF04 Dist; int distance; int EN2 14; int EN3 15; int EN4 16; int EN5 17; int LED1 6; int LED2 7; int EA 3; int EB 5; //black base:a 1 b 0; //white base:a 0 b 1; int a 1; int b 0; // moto speed 130-255 int Speed 150; //int ledPin 8; #define pin_infrared1 12 //pin_infrared1-- left 光电传感器 #define pin_infrared2 13 //pin_infrared2-- right光电传感器 #define pin_infrared3 6 //pin_infrared3-- M_left 光电传感器 #define pin_infrared4 4 //pin_infrared4-- M_right光电传感器 /////////////////////////////////////// void ting vo