git.piffa.net Git - aerei/blob - esempi/snippets/lettura_servo_ch_pulse_millis/lettura_servo_ch_pulse_millis.ino

   1
   2 /* Lettura di un canale servo della RX
   3
   4    Lettura tramite la funzione pulsein
   5    Utilizzabile su qualunque PIN
   6
   7    Il codice e' blocking fin tanto che il segnale passa da RISE a FALL
   8    quindi blocca per 1-2ms a ogni esecuzione. Con la variabile freq
   9    si imposta ogni quanto fare una lettura.
  10
  11
  12 */
  13
  14 #define DEBUG
  15 #include <common.h>
  16
  17 unsigned long currentMillis; // timestamp reference per millis per tutto il loop
  18
  19 // Variabili
  20 const byte chPin = A4; // PIN su cui e' collegato il canale
  21 long unsigned chStamp = 0; // Timestamp per
  22 unsigned int chIn = 1500; // Valore catturato
  23 unsigned int chValue = 1500; // Valore computato
  24 unsigned int freq = 200 ; // Ogni quanti millisecondi leggere il valore
  25 // Attenzione che pulsein e' blocking
  26
  27 void setup() {
  28     // Funzione relativa a calibrazione:
  29 //    mid_point =  calibraTrim(chPin) +10 ; // Con pulse in c'e' una traslazione ~10
  30 #ifdef DEBUG
  31 Serial.begin(9600); // Warning: interrupts e serial potrebbero dare problemi
  32 } ;
  33 #endif
  34
  35 void loop() {
  36     currentMillis = millis(); // Timestamp per tutto il loop
  37
  38 // Lettura ailerons channel ogni 200ms
  39     if (currentMillis - chStamp >= freq) {
  40
  41         chIn = pulseIn(chPin, HIGH, 25000);
  42         if (chIn != 0 && chIn > 1000 && chIn <2000)  {
  43             // get only resonable values
  44             chValue = chIn;
  45             chStamp = currentMillis ;
  46         } ;
  47     };
  48
  49 // do something with    chValue
  50 #ifdef DEBUG
  51     Serial.print(chValue);
  52     Serial.print(" - base: ");
  53     Serial.println(mid_point);
  54     delay(200);
  55 #endif
  56
  57 }