Go Down

Topic: Programa con servomotor, pulsadores y HC-SR04 (Read 107 times) previous topic - next topic

Adriansalguero

Tengo el siguiente código, me interesaría añadir dos pulsadores

Pulador 1: pone el servo a 100º y desactiva el sensor
Pulsador 2: pone el servo a 0º y activa el sensor.

no se si es posible la opción de activar y desactivar el sensor...

Code: [Select]


#include <Servo.h>   
Servo servo;     
int trigPin = 2;   
int echoPin = 3;   
int servoPin = 9;

long duration, dist, average;   
long aver[3];   


void setup() {       
    servo.attach(servoPin); 
    pinMode(trigPin, OUTPUT); 
    pinMode(echoPin, INPUT); 
    servo.write(0);       
    delay(1000);
    servo.detach();
}

void measure() { 
digitalWrite(trigPin, LOW);
delayMicroseconds(5);
digitalWrite(trigPin, HIGH);
delayMicroseconds(15);
digitalWrite(trigPin, LOW);
pinMode(echoPin, INPUT);
duration = pulseIn(echoPin, HIGH);
dist = (duration/2) / 29.1;   
}
void loop() {
  for (int i=0;i<=2;i++) {   
    measure();               
   aver[i]=dist;           
    delay(50);             
  }
 dist=(aver[0]+aver[1]+aver[2])/3;   

if ( dist<10 ) {

 servo.attach(servoPin);
  delay(1);
 servo.write(100); 
 delay(5000);     
 servo.write(0);   
 delay(1000);
 servo.detach();     
}
}


Gracias :)

Go Up