Changeset 143 in flair-src for trunk/lib/FlairVisionFilter/src/OpticalFlowSpeed.cpp

Timestamp:

02/21/17 16:37:58 (7 years ago)

Author:

Bayard Gildas

Message:

Plop

File:

• trunk/lib/FlairVisionFilter/src/OpticalFlowSpeed.cpp (modified) (2 diffs)

trunk/lib/FlairVisionFilter/src/OpticalFlowSpeed.cpp

@@ -49 +49 @@
 
     input->GetMutex();
-    for(int i=0;i<input->NbFeatures();i++)
-    {
-        if(input->FoundFeature()[i]!=0)
-        {
+    for(int i=0;i<input->NbFeatures();i++) {
+        if(input->FoundFeature()[i]!=0) {
             deplx+=input->PointsB()[i].x-input->PointsA()[i].x;
             deply+=input->PointsB()[i].y-input->PointsA()[i].y;
@@ -59 +57 @@
     }
     input->ReleaseMutex();
+    Time deltaT=data->DataTime()-output->DataTime();
+    output->SetDataTime(data->DataTime());
 
-    if(nb_depl!=0)
-    {
-        output->SetValue(0,0,deplx/nb_depl);
-        output->SetValue(1,0,deply/nb_depl);
+    if(nb_depl!=0) {
+        output->SetValue(0,0,deplx/(nb_depl*deltaT)*1000*1000*1000);
+        output->SetValue(1,0,deply/(nb_depl*deltaT)*1000*1000*1000);
     }
 
-    output->SetDataTime(data->DataTime());
     ProcessUpdate(output);
 }