#include <Servo.h>
const int SERVO =9;
const int IR =0; //Ir distance Sensor on Analog pin 0 int
int pin[]={5,6,7};
int k =0;
Servo myServo; //servo objerct
int dist =0; //Quadrant
void setup ()
{

myServo.attach(SERVO);

}
void loop()
{
  for(k=0; k<=100;k+=15)

  dist = readDistance(k);
  delay(10);
}
int readDistance (int pos)
{
  myServo.write(pos); //Move to given position
  delay(600); // wait for servo to move
  int dist = analogRead(IR); // read IR sensor
  dist = map(dist, 50, 500, 0, 255); // scale to read led range
  dist = constrain(dist, 0, 255);
  return dist; // return scaled distance
  }

Comments

Popular posts from this blog