thomazrb

Controle do Servo - Teste 1

Oct 24th, 2017
168
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 0.74 KB | None | 0 0
  1. #include <Servo.h>
  2.  
  3. Servo servo;
  4.  
  5. int pos = 0;
  6. int valorSensor = 0;
  7. int valorCm = 0;
  8. int pinSensor = A0;
  9.  
  10. void setup()
  11. {
  12.   pinMode(pinSensor, INPUT);
  13.   Serial.begin(9600);
  14.   servo.attach(3);
  15. }
  16.  
  17. void loop()
  18. {
  19.   for (pos = 0; pos <= 180; pos +=1)
  20.   {
  21.     servo.write(pos);
  22.     valorSensor = analogRead(pinSensor);
  23.     valorCm = 10650.08 * pow(valorSensor, -0.935) - 10;
  24.     Serial.print(pos);
  25.     Serial.print(" ");
  26.     Serial.println(valorCm);
  27.     delay(500);
  28.   }
  29.     for (pos = 180; pos >= 0; pos -=1)
  30.   {
  31.     servo.write(pos);
  32.     valorSensor = analogRead(pinSensor);
  33.     valorCm = 10650.08 * pow(valorSensor, -0.935) - 10;
  34.     Serial.print(pos);
  35.     Serial.print(" ");
  36.     Serial.println(valorCm);
  37.     delay(500);
  38.   }
  39. }
Add Comment
Please, Sign In to add comment