Agra-GPS / FreePilot_V2-3

Dependencies:   FreePilot PinDetect mbed-src

Fork of FreePilot_V2-2 by Agra-GPS

Revision:
43:e3f064f5eecd
Parent:
42:854d8cc26bbb
Child:
44:e9d5cd98273d
--- a/main.cpp	Mon Mar 09 15:58:28 2015 +0000
+++ b/main.cpp	Mon Mar 09 15:59:41 2015 +0000
@@ -1345,9 +1345,10 @@
             // pc.puts(boomstate);
             lastboom18=boom18;
         }
-        if ( print_euler == 1 && angle_send == 1 ) { //&& reading == 0){
-            lastpitch = 0.8*lastpitch + 0.2 * (toDegrees(get_pitch()*3.5));
-            lastroll = 0.8 * lastroll + 0.2 * toDegrees(get_roll()*3.5);
+        if ( print_euler == 1 && angle_send == 1 ) 
+        { //&& reading == 0){
+            lastpitch = 0.9*lastpitch + 0.1 * (toDegrees(get_pitch()*3.5));
+            lastroll = 0.9 * lastroll + 0.1 * toDegrees(get_roll()*3.5);
 
             double dps = - last_yaw;
             last_yaw =toDegrees( imuFilter.getYaw()) * -1;