X-Git-Url: https://git.realraum.at/?p=svn42.git;a=blobdiff_plain;f=firmware%2Ftuer.pde;h=0fea4da927b21c34ce4d3c0be7b229b0a124e49e;hp=c4bfcb4ddf32924300bc43f9e7b116b7bda86daa;hb=4ee2501ff864b8e15202ee814e8bafcc0c2adf6c;hpb=4bb3eba50f61cc7f57d0ad279ab310ea5368a88d

diff --git a/firmware/tuer.pde b/firmware/tuer.pde
index c4bfcb4..0fea4da 100644
--- a/firmware/tuer.pde
+++ b/firmware/tuer.pde
@@ -21,6 +21,12 @@ byte next_led = 0;
 #define LIMIT_CLOSED_PIN 19 // A5: limit switch for close
 
 #define AJAR_PIN 14 // input pin for reed relais (door ajar/shut)
+#define SHUT 10
+#define AJAR 5
+byte ajar_last_state = SHUT;
+#define AJAR_LOW_PASS_TAU 200
+byte ajar_low_pass_counter = 0;
+byte ajar_low_pass_last_value = ajar_last_state;
 
 #define MANUAL_OPEN_PIN 12  // keys for manual open and close
 #define MANUAL_CLOSE_PIN 13 // 
@@ -79,18 +85,24 @@ boolean is_closed()
 
 //**********//
 
-void init_ajar()
+byte get_ajar_status()
 {
-  pinMode(AJAR_PIN, INPUT);      // set pin to input
-  digitalWrite(AJAR_PIN, HIGH);  // turn on pullup resistors  
+  byte b = (digitalRead(AJAR_PIN) == LOW) ? SHUT : AJAR;
+  ajar_low_pass_counter = (b == ajar_low_pass_last_value) ? ajar_low_pass_counter+1 : 0;
+  ajar_low_pass_last_value = b;
+  if(ajar_low_pass_counter >= AJAR_LOW_PASS_TAU) {
+    ajar_low_pass_counter = 0;
+    return b;
+  }
+  else
+    return ajar_last_state;
 }
 
-boolean get_ajar_status()  // shut = true, ajar = false
+void init_ajar()
 {
-  if(digitalRead(AJAR_PIN))
-     return false;
-     
-  return true;
+  pinMode(AJAR_PIN, INPUT);      // set pin to input
+  digitalWrite(AJAR_PIN, HIGH);  // turn on pullup resistors  
+  ajar_last_state = get_ajar_status();
 }
 
 //**********//
@@ -388,7 +400,7 @@ ISR(TIMER1_COMPA_vect)
     else if(is_closed())
       Serial.print("closed");
     Serial.print(", idle");
-    if(get_ajar_status())
+    if(get_ajar_status() == SHUT)
       Serial.println(", shut");
     else
       Serial.println(", ajar");
@@ -504,7 +516,7 @@ void start_close()
   start_step_timer();
 }
 
-void print_status()
+void print_status(byte as)
 {
   Serial.print("Status: ");
   if(is_opened())
@@ -521,7 +533,7 @@ void print_status()
   case WAIT: Serial.print(", waiting"); break;
   default: Serial.print(", <undefined state>"); break;
   }
-  if(get_ajar_status())
+  if(as == SHUT)
     Serial.println(", shut");
   else
     Serial.println(", ajar");
@@ -549,6 +561,7 @@ void setup()
     current_state = CLOSING;
     start_step_timer();
   }
+  Serial.println("init complete");
 }
 
 void loop()
@@ -564,8 +577,8 @@ void loop()
     }
     else if (command == CMD_OPEN) {
       if(current_state == IDLE) {
-	if(is_opened())
-	  Serial.println("Already open");
+        if(is_opened())
+          Serial.println("Already open");
         else {
           start_open();
           Serial.println("Ok");
@@ -576,8 +589,8 @@ void loop()
     }
     else if (command == CMD_CLOSE) {
       if(current_state == IDLE) {
-	if(is_closed())
-	  Serial.println("Already closed");
+        if(is_closed())
+          Serial.println("Already closed");
         else {
           start_close();
           Serial.println("Ok");
@@ -588,17 +601,17 @@ void loop()
     }
     else if (command == CMD_TOGGLE) {
       if(current_state == IDLE) {
-	if(is_closed())
-	  start_open();
-	else
-	  start_close();
-	Serial.println("Ok");
+        if(is_closed())
+          start_open();
+        else
+          start_close();
+        Serial.println("Ok");
       }
       else
         Serial.println("Error: Operation in progress");
     }
     else if (command == CMD_STATUS)
-      print_status();
+      print_status(get_ajar_status());
     else
       Serial.println("Error: unknown command");
   }
@@ -610,7 +623,7 @@ void loop()
     Serial.println("close forced manually");
     start_close();
   }
-  if (current_state == IDLE) {
+  if(current_state == IDLE) {
     if(is_opened()) {
       leds_green();
       PORTD = LEDS_ON;
@@ -620,4 +633,9 @@ void loop()
       PORTD = LEDS_ON;
     }
   }
+  byte a = get_ajar_status();
+  if(a != ajar_last_state) {
+    print_status(a);
+    ajar_last_state = a;
+  }
 }