Notes

[aerei] / aerei / zeta / zeta_prot / zeta_prot.ino

diff --git a/aerei/zeta/zeta_prot/zeta_prot.ino b/aerei/zeta/zeta_prot/zeta_prot.ino
index 7243b22c7805a11b8f8c4427adb138a95b50b9a5..5e2402411329b728fbeded783be7ee01f2b43ce3 100644 (file)
--- a/aerei/zeta/zeta_prot/zeta_prot.ino
+++ b/aerei/zeta/zeta_prot/zeta_prot.ino
@@ -1,82 +1,28 @@
 /* Zeta prototipo
 
-   Sketch da breadboard, il throttle e' simulato con un potenziometro
-   o con una RX.
-
+Test dei vari LED
 */
 
 #include <common.h>
-enum  { // Stati della FMS
-  idle,    // Throttle a zero
-  normal,  // Th normale
-  full,    // Th massimo
-} state  ;
-
-// Due LED con lampeggio alternato:
-Lampeggiatore right = 13;
-Pwm rpwm = 3;
-
-// Variabili
-const byte thrPin = A3;
-byte thr ;
-int thrIn ;
 
 
+// Due LED con lampeggio alternato:
+Lampeggiatore right = 3;
+Lampeggiatore left = 5;
+const byte rtail = 6;
+const byte ltail = 9;
 
 void setup() {
-  Serial.begin(9600);
-  pinMode(A3, INPUT);
-  randomSeed(analogRead(0));
+  left.Invert() ; // Parte da stato invertito rispetto al default
+  pinMode(rtail,OUTPUT);
+  pinMode(ltail,OUTPUT);
+    
 }
 
 void loop() {
-
-  // Utilizzando un potenziometro
-  //  thrIn = analogRead(3);
-  //  thr = constrain(thrIn / 4 , 0, 255) ;
-
-  // Utilizzando una RX
-  thrIn = pulseIn(thrPin, HIGH, 25000);
-  // Hint: thrIn andrebbe calibrato son un Serial.write
-  thr = constrain(map(thrIn, 960, 2000, 0, 255), 0, 255);
-
-  // FMS dispatcher
-  if ( thr < 10 ) {
-    state = idle ;
-  } else if ( thr > 245 ) {
-    state = full ;
-  } else {
-    state = normal ;
-  }
-
-  switch (state) {
-    case idle:
-      rpwm.UD(2000);
-      right.Blink();
-      break;
-
-    case normal:
-      // Due LED con lampeggio alternato:
-      right.Blink(1120 - 4 * thr );
-      rpwm.lSet(thr);
-      break;
-
-    case full:
-      digitalWrite(3, HIGH);
-      rpwm.Set(0);
-      right.Swap();
-      delay(50);
-      rpwm.Set(255);
-      right.Swap();
-      delay(50);
-      break;
-  }
-
-
-  Serial.print(thrIn);
-  Serial.print("\t thr:");
-  Serial.print(thr);
-  Serial.print("\t state:");
-  Serial.println(state);
-  //  delay(200);
+  // Due LED con lampeggio alternato:
+  right.Blink();
+  left.Blink();
+  digitalWrite(rtail,HIGH);
+  digitalWrite(ltail,HIGH);
 }