Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <Servo.h>.
- const int trigPin = 10;
- const int echoPin = 11;
- long duration;
- int distance;
- long filterdistance[4];
- Servo myServo;
- long filter;
- int a=0;
- void setup() {
- pinMode(trigPin, OUTPUT);
- pinMode(echoPin, INPUT);
- Serial.begin(9600);
- myServo.attach(12);
- }
- void loop() {
- distance = calculateDistance();
- myServo.write(i);
- while(a=0){
- if(distance<100){
- myServo.write(distance);
- delay(30);
- distance = calculateDistance();
- }
- else{
- myServo.write(100);
- distance = calculateDistance();
- }
- }
- }
- int calculateDistance(){
- for(int i=0;i<5;i++){
- digitalWrite(trigPin, LOW);
- delayMicroseconds(2);
- // Sets the trigPin on HIGH state for 10 micro seconds
- digitalWrite(trigPin, HIGH);
- delayMicroseconds(10);
- digitalWrite(trigPin, LOW);
- duration = pulseIn(echoPin, HIGH); // Reads the echoPin, returns the sound wave travel time in microseconds
- filterdistance[i]= duration*0.034/2;
- filter=filter+filterdistance[i];
- }
- distance=filter/5;
- return distance;
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement