Changeset 422 in flair-src for trunk/lib/FlairMeta/src/MetaUsRangeFinder.cpp

Timestamp:

Apr 22, 2021, 2:20:26 PM (4 years ago)

Author:

Sanahuja Guillaume

Message:

test pour recaler l'us en fonction de l'orientation

File:

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

trunk/lib/FlairMeta/src/MetaUsRangeFinder.cpp

@@ -40 +40 @@
 MetaUsRangeFinder::MetaUsRangeFinder(UsRangeFinder *us)
     : Object(us, us->ObjectName()) {
+  //TODO: mettre une rotation entre la sortie US et le low pass
+  //pour eviter les fausses mesures quand le drone est orienté
+  /* ex
+  Vector3Df test(0,0,altitude+0.04);
+  Printf("altitude av %f %f %f %f\n",altitude,test.x,test.y,test.z);
+  test.Rotate(currentQuaternion);
+  Printf("altitude ap %f %f %f %f\n",altitude,test.x,test.y,test.z-0.04);
+   */
   this->us = us;
   pbas_z =