git.piffa.net Git - aerei/blob - esempi/calibrazione_servo/calibrazione_servo.ino

   1 /* Calibrazione Trim servo
   2
   3    Esempio su come calibrare il segnale di un servo.
   4    I canali come alettoni / elevatore possono avere un TRIM
   5    (generalmente il throttle non ha un TRIM impostato),
   6    questa funzione nel setup serve per trovare il punto medio
   7    all'avvio dello sketch.
   8
   9 Nota: questa funzione usa PULSEIN in modo da poter lavorare su
  10 qualunque PIN, considerando che in genere viene eseguita
  11 una sola volta nel SETUP.
  12
  13 Se si vuole qualcosa non blocking sostituire PULSEIN con
  14 un interrupt.
  15
  16 */
  17
  18 #include <common.h>
  19
  20 const byte ailPin = A4;
  21
  22 int mid_point = 1500 ; // centro del segnale, trimmato nel setup
  23
  24 void setup() {
  25     Serial.begin(9600); // Se abilitato la calibrazione viene tracciata su seriale
  26     // Abilitando anche DEBUG nella libreria
  27
  28 //    mid_point =  calibraTrim(ailPin) ; // Pin a cui e' collegato il canale
  29 mid_point =  calibraTrim(ailPin,11) ; // + LED di servizio per calibrazione
  30
  31 Serial.print("Valore calibrato: ");
  32 Serial.println(mid_point);
  33
  34     while(1); // Stoppa Arduino
  35 }
  36
  37 void loop() {
  38 }