#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
}
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
Post a Comment