Changeset 165 in flair-src for trunk/demos/OpticalFlow/uav/src/DemoOpticalFlow.cpp

Timestamp:

03/07/17 20:26:53 (7 years ago)

Author:

Sanahuja Guillaume

Message:

modifs

File:

• trunk/demos/OpticalFlow/uav/src/DemoOpticalFlow.cpp (modified) (3 diffs)

trunk/demos/OpticalFlow/uav/src/DemoOpticalFlow.cpp

@@ -15 +15 @@
 #include <Uav.h>
 #include <Camera.h>
+#include <V4LCamera.h>
 #include <CvtColor.h>
 #include <OpticalFlow.h>
@@ -123 +124 @@
   uav->GetAhrs()->AddPlot(customReferenceOrientation,DataPlot::Yellow);
   AddDataToControlLawLog(customReferenceOrientation);
+  
+  flagCameraLost=false;
 }
 
@@ -196 +199 @@
 }
 
+void DemoOpticalFlow::ExtraSecurityCheck(void) {
+  if(GetUav()->GetType()=="hds_x8") {
+    if(((V4LCamera*)GetUav()->GetVerticalCamera())->HasProblems() && !flagCameraLost) {
+      flagCameraLost = true;
+      Thread::Err("Camera lost\n");
+      SafeStop();
+      Land();
+    }
+  }
+}
+
 DemoOpticalFlow::~DemoOpticalFlow() {
 }