Sonic Sensor and Servo - bossB's Arduino basics

Sonic Sensor and Servo

Friday, January 24, 2014

#define trigPin 12 //trigpin is in digital pin 12
#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