Kan je de code bekijken , voor een auto met twee sensor.
met een sensor geen probleem , met twee lukt het niet
altijd problemen bij duration = pulseIn( echoPin1, HIGH );
const int trigPin1 = 9 ;
const int echoPin1 = 10 ;
const int trigPin2 = 11 ;
const int echoPin2 = 12 ;
const int revright = 3; //REVerse motion of Left motor
const int fwdleft = 6; //ForWarD motion of Left motor
const int revleft = 5; //REVerse motion of Right motor
const int fwdright = 4;
void setup() {
pinMode(3, OUTPUT);
pinMode(4, OUTPUT);
pinMode(5, OUTPUT);
pinMode(6, OUTPUT);
pinMode(trigPin1, OUTPUT);
pinMode(echoPin1, INPUT );
pinMode(trigPin2, OUTPUT);
pinMode(echoPin2, INPUT );
Serial.begin(9600);
}
void loop() {
digitalWrite(trigPin1 , LOW);
delayMicroseconds(2);
digitalWrite(trigPin1, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin1, LOW);
duration = pulseIn( echoPin1, HIGH );
distance = (duration * 0.0343) / 2;
digitalWrite(trigPin2 , LOW);
delayMicroseconds(2);
digitalWrite(trigPin2, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin2, LOW);
duration = pulseIn( echoPin2, HIGH );
distance = (duration * 0.0343) / 2;
if (distance < 25)
{
digitalWrite(3, LOW);
digitalWrite(4, LOW);
digitalWrite(5, LOW);
digitalWrite(6, LOW);
delay(1000);
digitalWrite(3, HIGH);
digitalWrite(4, LOW);
digitalWrite(5, HIGH);
digitalWrite(6, LOW);
delay(500);
digitalWrite(3, LOW);
digitalWrite(4, LOW);
digitalWrite(5, LOW);
digitalWrite(6, LOW);
delay(2000);
digitalWrite(3, LOW );
digitalWrite(4, LOW );
digitalWrite(5, HIGH );
digitalWrite(6, LOW );
delay(500);
digitalWrite(3, LOW);
digitalWrite(4, LOW);
digitalWrite(5, LOW);
digitalWrite(6, LOW);
delay(1000);
} else {
digitalWrite(3, LOW);
digitalWrite(4, HIGH);
digitalWrite(5, LOW);
digitalWrite(6, HIGH);
}}