Fix tf bug

sbgisen · May 8, 2024 · a8ebdf2 · a8ebdf2
1 parent 852851c
commit a8ebdf2
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/leg_detector/src/leg_detector.cpp b/leg_detector/src/leg_detector.cpp
@@ -115,7 +115,7 @@ class SavedFeature
     {
       ROS_WARN("TF exception spot 6.");
     }
-    tf::StampedTransform pose(tf::Pose(tf::Quaternion(0.0, 0.0, 0.0, 1.0), loc), loc.stamp_, id_, loc.frame_id_);
+    tf::StampedTransform pose(tf::Pose(tf::Quaternion(0.0, 0.0, 0.0, 1.0), loc), loc.stamp_, loc.frame_id_, id_);
     tfl_.setTransform(pose);
 
     BFL::StatePosVel prior_sigma(tf::Vector3(0.1, 0.1, 0.1), tf::Vector3(0.0000001, 0.0000001, 0.0000001));
@@ -138,7 +138,7 @@ class SavedFeature
 
   void update(tf::Stamped<tf::Point> loc, double probability)
   {
-    tf::StampedTransform pose(tf::Pose(tf::Quaternion(0.0, 0.0, 0.0, 1.0), loc), loc.stamp_, id_, loc.frame_id_);
+    tf::StampedTransform pose(tf::Pose(tf::Quaternion(0.0, 0.0, 0.0, 1.0), loc), loc.stamp_, loc.frame_id_, id_);
     tfl_.setTransform(pose);
 
     meas_time_ = loc.stamp_;