#define echoPin 13 //echo pin is in digital pin 13
#include <Servo.h>
Servo myservo;
void setup() {
Serial.begin (9600);
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
myservo.attach(9); //servo signal is attached on digital pin 9
}
void loop() {
int duration, distance,pos=0,i;
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
duration = pulseIn(echoPin, HIGH);
distance = (duration/2) / 29.1;
Serial.print(distance);
Serial.println(" cm");
//test the value of distance to make the servo move up
if(distance<10)
{
delay(5000);
myservo.write(90);
}
else{
myservo.write(0);
}
delay(100);
}
//bossb.. oliver...
you may copy it and distribute,,
0 comments:
Post a Comment