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

   1
   2 /* Lettura di 2 canali servo della RX con interrupts
   3
   4    Lettura tramite i due external interrupt ala Arduino
   5    Utilizzabile solo sui PIN 2-3
   6
   7 */
   8
   9 #include <common.h>
  10 #define DEBUG
  11
  12
  13 // Variabili per interrupt 0 si PIN 2
  14 volatile unsigned int chValue2 = 1500; // Valore computato
  15 volatile unsigned int chStart2 = 1500; // Inizio rilevamento
  16
  17 // Variabili per interrupt 1 su PIN 3
  18 volatile unsigned int chValue3 = 1500; // Valore computato
  19 volatile unsigned int chStart3 = 1500; // Inizio rilevamento
  20
  21 // Variabili per autocalibrazione 0
  22 const byte chPin2 = 2; // PIN per la calibrazione
  23 int mid_point2 = 1500;
  24
  25 // Variabili per autocalibrazione 1
  26 const byte chPin3 = 3; // PIN per la calibrazione
  27 int mid_point3 = 1500;
  28
  29 void setup() {
  30     // Funzione relativa a calibrazione con pulsein:
  31     mid_point2 =  calibraTrim(chPin2) ; // Calibrazione del TRIM attivo sul canale
  32     mid_point3 =  calibraTrim(chPin3) ; // Calibrazione del TRIM attivo sul canale
  33     attachInterrupt(0, chRise2, RISING); // PIN 2 su 328p / 168
  34     attachInterrupt(1, chRise3, RISING); // PIN 3 su 328p / 168
  35 #ifdef DEBUG
  36 Serial.begin(9600);
  37 #endif
  38 } ;
  39
  40 void loop() {
  41 // Il loop fa solo debug
  42 #ifdef DEBUG
  43     Serial.print("PIN2: ");
  44     Serial.print(chValue2);
  45     Serial.print(" -base: ");
  46     Serial.print(mid_point2);
  47
  48     Serial.print(" |-| PIN3:");
  49     Serial.print(chValue3);
  50     Serial.print(" -base: ");
  51     Serial.println(mid_point3);
  52     delay(200);
  53 #endif
  54 }
  55
  56 // Functions
  57 void chRise2() {
  58     attachInterrupt(0, chFall2, FALLING);
  59     chStart2 = micros();
  60 }
  61
  62 void chFall2() {
  63     attachInterrupt(0, chRise2, RISING);
  64     chValue2 = micros() - chStart2;
  65 }
  66 // Seconod iterrupt
  67 void chRise3() {
  68     attachInterrupt(1, chFall3, FALLING);
  69     chStart3 = micros();
  70 }
  71
  72 void chFall3() {
  73     attachInterrupt(1, chRise3, RISING);
  74     chValue3 = micros() - chStart3;
  75 }