From 83c5e060256a2692db3cbbcebd8bad4005f569a3 Mon Sep 17 00:00:00 2001
From: jjulio1234 <jjulio1234@f9c3cf11-9bcb-44bc-f272-b75c42450872>
Date: Wed, 11 Aug 2010 20:43:12 +0000
Subject: [PATCH] Now for Arming/Disarming motors you should wait 2 seconds
 (security feature to prevent disarming during flight)

git-svn-id: https://arducopter.googlecode.com/svn/trunk@73 f9c3cf11-9bcb-44bc-f272-b75c42450872
---
 Arducopter/Arducopter.pde | 31 ++++++++++++++++++++++++++-----
 1 file changed, 26 insertions(+), 5 deletions(-)

diff --git a/Arducopter/Arducopter.pde b/Arducopter/Arducopter.pde
index 8be506b3a4..171b08c777 100644
--- a/Arducopter/Arducopter.pde
+++ b/Arducopter/Arducopter.pde
@@ -227,6 +227,10 @@ int minThrottle = 0;
 char queryType;
 long tlmTimer = 0;
 
+// Arming/Disarming
+uint8_t Arming_counter=0;
+uint8_t Disarming_counter=0;
+
 /* ************************************************************ */
 /* Altitude control... (based on sonar) */
 void Altitude_control(int target_sonar_altitude)
@@ -725,19 +729,36 @@ void loop(){
       command_rx_yaw_diff = 0;
       }
       
-    // Arm motor output
+    // Arm motor output : Throttle down and full yaw right for more than 2 seconds
     if (ch_throttle < 1200) {
       control_yaw = 0;
       command_rx_yaw = ToDeg(yaw);
       command_rx_yaw_diff = 0;
       if (ch_yaw > 1800) {
-        motorArmed = 1;
-        minThrottle = 1100;
+        if (Arming_counter>240){
+          motorArmed = 1;
+          minThrottle = 1100;
+        }
+        else
+          Arming_counter++;
       }
+      else
+        Arming_counter=0;
+      // To Disarm motor output : Throttle down and full yaw left for more than 2 seconds
       if (ch_yaw < 1200) {
-        motorArmed = 0;
-        minThrottle = MIN_THROTTLE;
+        if (Disarming_counter>240){
+          motorArmed = 0;
+          minThrottle = MIN_THROTTLE;
+        }
+        else
+          Disarming_counter++;
       }
+      else
+        Disarming_counter=0;
+    }
+    else{
+      Arming_counter=0;
+      Disarming_counter=0;
     }
       
     // Quadcopter mix