Spåra 2D rörlighet med hjälp av Arduino ultraljudssensorer och visualisera i enighet (3 / 4 steg)
Steg 3: Kan skriva Arduino kod
koden kommer att bara läsa de två sensorerna läser gör det till en sträng och skicka till enhet för bearbetning. men istället för att läsa värden i centimeter kommer att vi göra det i millimeter att ge en mjukare rörelse i enighet genom att göra en liten förändring i formeln
CONST int TRIGX = 5;
CONST int ECHOX = 4;
CONST int TRIGY = 7.
CONST int ECHOY = 6;
Ogiltiga inställningar () {
Serial.BEGIN(9600);
pinMode (TRIGX, OUTPUT);
pinMode (ECHOX, indata);
pinMode (TRIGY, OUTPUT);
pinMode (ECHOY, indata); }
Ogiltig loop () {
int dataX = GetUltra(TRIGX,ECHOX);
int dataY = GetUltra(TRIGY,ECHOY);
Serial.flush();
Serial.Print (dataX);
Serial.Print(','); Serial.Print (dataY);
Serial.println();
Delay(20);
}
dubbel GetUltra (int trig, int echo) {
digitalWrite (trig, låg);
delayMicroseconds(2);
digitalWrite (trig, hög);
delayMicroseconds(8);
digitalWrite (trig, låg);
dubbla avståndet = (pulseIn (echo, hög)) * 343.2 / 2000; returnera avstånd;
}