Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <Servo.h>
- Servo myServando;
- const int trigPin=9;
- const int echoPin=10;
- const int servoPin=3;
- long duration;
- int distance;
- void setup() {
- pinMode(trigPin,OUTPUT);
- pinMode(echoPin,INPUT);
- myServando.attach(servoPin);
- Serial.begin(9600);
- }
- void loop() {
- ultra();
- myServando.write(0);
- if(distance < 15 && distance >5){
- myServando.write(90);
- }
- else if(distance <30 && distance >16){
- myServando.write(180);
- }
- }
- void ultra(){
- digitalWrite(trigPin, LOW);
- delayMicroseconds(2);
- digitalWrite(trigPin, HIGH);
- delayMicroseconds(10);
- digitalWrite(trigPin, LOW);
- duration = pulseIn(echoPin, HIGH);
- distance= duration*0.034/2;
- Serial.print("Distance: ");
- Serial.println(distance);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement