Test servomotori usando tastiera del pc Tutorials - Azionamenti Domenica 29 Gennaio 2012 18:10 Scritto da Mario A

Ecco un semplice sketch da uploadare sul proprio Arduino per testare i servomotori usando la tastiera del pc e il Serial Monitor dell'Arduino IDE. Tasto 0 per angolo 0 Tasto s per centro 90 gradi Tasto a per -10 gradi Tasto d per + 10 gradi Usare il Serial Monitor per inserire i singoli tasti e premere invio per ogni comando. Ricordarsi di includere la libreria Servo.h prima di avviare l'upload.

// Sketch prova servi con tastiera
//  Aprire Serial Monitor
//   Tasti  a  s  d  0

Servo myServo;
const int servoPin = 9; // servo connesso a 9 
int angle = 90; // inizializza a 90
#define ANGLE_STEP 10     // passi da 10

void setup() {
  Serial.begin(9600);
  myServo.attach(servoPin);
  myServo.write(angle);  // centra il servo
}


void loop() {
  char ch;
  if(Serial.available()) {
    char ch = Serial.read();
    switch(ch){

      case('a' ): {
        Serial.println("SINISTRA");
        if(angle > ANGLE_STEP) {
          angle = angle - ANGLE_STEP;  // step a sx
        } else {
          angle = 0; 
        }
        myServo.write(angle);
      }
      break;

      case('d' ): {
        Serial.println("DESTRA");
        if(angle < 180 - ANGLE_STEP) {
          angle = angle + ANGLE_STEP; // step a dx
        } else {
          angle = 180; 
        }
        myServo.write(angle);
      }
      break;

      case('0'): {
        Serial.println("A ZERO");    // a zero
        myServo.write(5);     // messo solo perché il servo balla
        angle = 0;
      }
      break;

      case('s' ): {
        Serial.println("CENTRO");
        myServo.write(90);           // a 90
        angle = 90;  
      }
      break;
    }
  } 
}
// FINE