Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- static const int sensor1 = 7;
- static const int sensor2 = 8; //voy a suponer que coloque mal este rastreador
- void setup() {
- Serial.begin(9600);
- }
- void loop() {
- long duracion1, cm1;
- long duracion2, cm2;
- duracion1 = ActivarSensor(sensor1);
- duracion2 = ActivarSensor(sensor2);
- // convertimos el tiempo en distancia!!!
- cm1 = microsegundosACentimetros(duracion1);
- cm2 = microsegundosACentimetros(duracion2);
- Serial.print(cm1);
- Serial.print("cm de sensor 1");
- Serial.println();
- Serial.print(cm2);
- Serial.print("cm de sensor 2");
- Serial.println();
- long diferencia = cm1-cm2;
- Serial.print("Hay un error en la captura de: ");
- Serial.print(abs(diferencia));
- Serial.print("cm.");
- Serial.println();
- delay(100);
- }
- long microsegundosACentimetros(long microseconds) {
- return microseconds / 29 / 2;
- }
- long ActivarSensor(int pin)
- {
- pinMode(pin, OUTPUT);
- digitalWrite(pin, LOW);
- delayMicroseconds(2);
- digitalWrite(pin, HIGH);
- delayMicroseconds(5);
- digitalWrite(pin, LOW);
- pinMode(pin, INPUT);
- return pulseIn(pin, HIGH);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement