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

diff --git a/firmware/tuer.pde b/firmware/tuer.pde
index 3813e00..0fea4da 100644
--- a/firmware/tuer.pde
+++ b/firmware/tuer.pde
@@ -21,9 +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 0
-#define AJAR 1
+#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 // 
@@ -84,10 +87,15 @@ boolean is_closed()
 
 byte get_ajar_status()
 {
-  if(digitalRead(AJAR_PIN) == LOW)
-    return SHUT;
-  
-  return AJAR;
+  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;
 }
 
 void init_ajar()
@@ -508,7 +516,7 @@ void start_close()
   start_step_timer();
 }
 
-void print_status()
+void print_status(byte as)
 {
   Serial.print("Status: ");
   if(is_opened())
@@ -525,7 +533,7 @@ void print_status()
   case WAIT: Serial.print(", waiting"); break;
   default: Serial.print(", <undefined state>"); break;
   }
-  if(get_ajar_status() == SHUT)
+  if(as == SHUT)
     Serial.println(", shut");
   else
     Serial.println(", ajar");
@@ -603,7 +611,7 @@ void loop()
         Serial.println("Error: Operation in progress");
     }
     else if (command == CMD_STATUS)
-      print_status();
+      print_status(get_ajar_status());
     else
       Serial.println("Error: unknown command");
   }
@@ -626,9 +634,8 @@ void loop()
     }
   }
   byte a = get_ajar_status();
-  if(a != ajar_last_state)
-  {
-    print_status();
+  if(a != ajar_last_state) {
+    print_status(a);
     ajar_last_state = a;
   }
 }