Rastrear el movimiento 2D usando Arduino sensores ultrasónicos y visualizar en la unidad (3 / 4 paso)

Paso 3: Permite escribir el código de Arduino

el código simplemente leerá los dos sensores de lectura de convertirla en una cadena y envían a la unidad de procesamiento. sin embargo, en lugar de leer valores en centímetros lo haremos en milímetros para proporcionar un movimiento más suave en la unidad haciendo un ligero cambio en la fórmula

const int TRIGX = 5;
const int ECHOX = 4;

const int TRIGY = 7;

const int ECHOY = 6;

void setup () {}

Serial.Begin(9600);

pinMode (TRIGX, salida);

pinMode (ECHOX, entrada);

pinMode (TRIGY, salida);

pinMode (ECHOY, entrada); }

void loop () {}

dataX int = GetUltra(TRIGX,ECHOX);

dataY int = GetUltra(TRIGY,ECHOY);

Serial.Flush();

Serial.Print (dataX);

Serial.Print(','); Serial.Print (dataY);

Serial.println();

Delay(20);

}

doble GetUltra (int trig, eco int) {}

digitalWrite (trig, LOW);

delayMicroseconds(2);

digitalWrite (trig, HIGH);

delayMicroseconds(8);

digitalWrite (trig, LOW);

doble distancia = (pulseIn (echo, alto)) * 343.2 / 2000; volver a distancia;

}