Servo

 


  1. #include <Servo.h>
  2. #include <SoftwareSerial.h>

  3. int pos = 0;
  4. int sensorValue = 0;
  5. int i = 0;

  6. Servo servo_9;

  7. void setup()
  8. {
  9.   servo_9.attach(9);
  10.   pinMode(A0, INPUT);
  11.   pinMode(13, OUTPUT);
  12.   Serial.begin(9600);

  13. }

  14. void loop()
  15. {

  16.    sensorValue = analogRead(A0);
  17.    pos = map(sensorValue,0,1023,0,180);
  18.   
  19.   Serial.print("sensorValue ");
  20.   Serial.println(sensorValue);
  21.   Serial.print("pos ");
  22.   Serial.println(pos); 
  23.   
  24.   for (i = 0; i <= pos; i++) {
  25.                       
  26.     // tell servo to go to position in variable 'pos'
  27.     servo_9.write(i);
  28.     // wait 15 ms for servo to reach the position
  29.     delay(15); // Wait for 15 millisecond(s)
  30.   }
  31.   for (i= pos; i >= 0; i --) {
  32.     // tell servo to go to position in variable 'pos'
  33.     servo_9.write(i);
  34.     // wait 15 ms for servo to reach the position
  35.     delay(15); // Wait for 15 millisecond(s)
  36.   }
  37. }


No hay comentarios:

Publicar un comentario

Circuitos y programación