#include <Servo.h>
Servo servo;
int pos = 0;
int valorSensor = 0;
int valorCm = 0;
int pinSensor = A0;
void setup()
{
pinMode(pinSensor, INPUT);
Serial.begin(9600);
servo.attach(3);
}
void loop()
{
for (pos = 0; pos <= 180; pos +=1)
{
servo.write(pos);
valorSensor = analogRead(pinSensor);
valorCm = 10650.08 * pow(valorSensor, -0.935) - 10;
Serial.print(pos);
Serial.print(" ");
Serial.println(valorCm);
delay(500);
}
for (pos = 180; pos >= 0; pos -=1)
{
servo.write(pos);
valorSensor = analogRead(pinSensor);
valorCm = 10650.08 * pow(valorSensor, -0.935) - 10;
Serial.print(pos);
Serial.print(" ");
Serial.println(valorCm);
delay(500);
}
}
Comments