Sensor ultrassônico controlando servo motor (lixeira)
exemplo de código
// C++ code
//
#include <Servo.h>
int distancia = 0;
long readUltrasonicDistance(int triggerPin, int echoPin)
{
pinMode(triggerPin, OUTPUT); // Clear the trigger
digitalWrite(triggerPin, LOW);
delayMicroseconds(2);
// Sets the trigger pin to HIGH state for 10 microseconds
digitalWrite(triggerPin, HIGH);
delayMicroseconds(10);
digitalWrite(triggerPin, LOW);
pinMode(echoPin, INPUT);
// Reads the echo pin, and returns the sound wave travel time in microseconds
return pulseIn(echoPin, HIGH);
}
Servo servo_8;
void setup()
{
servo_8.attach(8, 500, 2500);
}
void loop()
{
distancia = 0.01723 * readUltrasonicDistance(7, 6);
if (distancia <= 10) {
servo_8.write(90);
delay(5000); // Wait for 5000 millisecond(s)
servo_8.write(0);
}
}
Comentários
Postar um comentário