Stap 3: Laat Arduino Code schrijven
de code zal gewoon lezen de twee sensoren lezen maken het tot een tekenreeks en stuur het naar eenheid voor verwerking. echter, in plaats van waarden in centimeters lezen zullen wij het in millimeter te zorgen voor een soepeler verloop van de eenheid door een lichte wijziging in de formule
Const int TRIGX = 5;
Const int ECHOX = 4;
Const int TRIGY = 7;
Const int ECHOY = 6;
void setup () {}
Serial.begin(9600);
pinMode (TRIGX, uitvoer);
pinMode (ECHOX, INPUT);
pinMode (TRIGY, uitvoer);
pinMode (ECHOY, INPUT); }
void loop () {}
int dataX = GetUltra(TRIGX,ECHOX);
int dataY = GetUltra(TRIGY,ECHOY);
Serial.Flush();
Serial.Print (dataX);
Serial.Print(','); Serial.Print (dataY);
Serial.println();
vertraging(20);
}
dubbele GetUltra (int trig, int echo) {}
digitalWrite (trig, laag);
delayMicroseconds(2);
digitalWrite (trig, hoge);
delayMicroseconds(8);
digitalWrite (trig, laag);
dubbele afstand (pulseIn (echo, hoge)) = * 343.2 / 2000; retourneren van afstand;
}