Changeset 271 in flair-src for trunk/lib/FlairMeta

Timestamp:

11/08/18 17:26:24 (5 years ago)

Author:

Sanahuja Guillaume

Message:

warn for all nan/inf torques/thrust

File:

• trunk/lib/FlairMeta/src/UavStateMachine.cpp (modified) (1 diff)

trunk/lib/FlairMeta/src/UavStateMachine.cpp

@@ -180 +180 @@
 
     //check nan/inf problems
-    if(!IsValuePossible(currentTorques.roll,"roll torque")
-       || !IsValuePossible(currentTorques.pitch,"pitch torque")
-       || !IsValuePossible(currentTorques.yaw,"yaw torque")
-       || !IsValuePossible(currentThrust,"thrust")) {
+    bool isValuePossible=true;
+    //test it separately to warn for all problems
+    if(!IsValuePossible(currentTorques.roll,"roll torque")) isValuePossible=false;
+    if(!IsValuePossible(currentTorques.pitch,"pitch torque")) isValuePossible=false;
+    if(!IsValuePossible(currentTorques.yaw,"yaw torque")) isValuePossible=false;
+    if(!IsValuePossible(currentThrust,"thrust")) isValuePossible=false;
+    if(!isValuePossible) {
 
         if(altitudeState==AltitudeState_t::Stopped) {