Keywish Hummer-Bot, Инструкция по эксплуатации

Страница: 80 / 108

77
Serial . print ( dl );
Serial . print ( " " ); / * Ultrasonic acquisition of the left side of the car and
obstacles distance, and then assigned to dl, then print on the "Serial Monitor" * /
head . write ( 0 ); / * Servo steering from the original 180 degrees to 0 degrees, the
right side of the car * /
delay ( 1000 );
analogWrite ( TrigPin , 0 ); // Low high and low send a short pulse to TrigPin
delayMicroseconds ( 2 );
analogWrite ( TrigPin , 255 );
delayMicroseconds ( 10 );
analogWrite ( TrigPin , 0 );
dr = pulseIn ( EchoPin , HIGH ) / 58.0 ; // Convert the echo time to cm
Serial . print ( "Right distance = " );
Serial . print ( dr );
Serial . print ( " " );
Serial . println (); /*Ultrasonic acquisition of the distance between the right side of
the car and the obstacle, and then assigned to dr, and then print the distance on the
"Serial Monitor" * /
head . write ( 80 ); // head steering back, that is, when the initialization 80
degrees position
if ( dl >= 20 && dl <= 1000 && dl > dr )
{
digitalWrite ( M1 , 0 );
analogWrite ( E1 , 180 ); //the speed value of motorA is 180
digitalWrite ( M2 , 180 ); //the speed value of motorB is 180
analogWrite ( E2 , 0 );
Serial . println ( "Turning left1" );
delay ( 200 ); // determine the left and right distance if the left is larger
than the left
}
else if ( dl >= 1000 )
{
digitalWrite ( M1 , 180 ); //the speed value of motorA is 180
analogWrite ( E1 , 0 );
digitalWrite ( M2 , 0 );
analogWrite ( E2 , 180 ); //the speed value of motorB is 180
Serial . println ( "Turning right1" );
delay ( 200 );