自走車程式碼

[Andy87877]

int _ABVAR_1_Speed = 0 ;
int _ABVAR_2_Speed = 0 ;

int ardublockUltrasonicSensorCodeAutoGeneratedReturnCM(int trigPin, int echoPin)
{
long duration;
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(20);
digitalWrite(trigPin, LOW);
duration = pulseIn(echoPin, HIGH);
duration = duration / 59;
if ((duration < 2) || (duration > 300)) return false;
return duration;
}

void setup()
{
pinMode( 11, OUTPUT);
pinMode( 5, OUTPUT);
pinMode( 6, OUTPUT);
pinMode( 10, OUTPUT);
digitalWrite( 4 , LOW );

_ABVAR_1_Speed = 190 ; // left
_ABVAR_2_Speed = 240 ; // right

}

void loop()
{
if (( ( ardublockUltrasonicSensorCodeAutoGeneratedReturnCM( 4 , 7 ) ) > ( 10 ) ))
{
analogWrite(5 , 0);
analogWrite(6 , _ABVAR_1_Speed);
analogWrite(11 , 0);
analogWrite(10 , _ABVAR_2_Speed);
}
if (( ( ( ardublockUltrasonicSensorCodeAutoGeneratedReturnCM( 4 , 7 ) ) < ( 10 ) ) && ( ( ardublockUltrasonicSensorCodeAutoGeneratedReturnCM( 4 , 7 ) ) >= ( 8 ) ) ))
{
analogWrite(5 , 0);
analogWrite(6 , 0);
analogWrite(11 , 0);
analogWrite(10 , 0);
}
if (( ( ardublockUltrasonicSensorCodeAutoGeneratedReturnCM( 4 , 7 ) ) < ( 8 ) ))
{
analogWrite(5 , _ABVAR_1_Speed);
analogWrite(6 , 0);
analogWrite(11 , _ABVAR_2_Speed);
analogWrite(10 , 0);
}
}