修正坐标转换bug

7be9cdc3 · Haoshuang · 668c293d · 7be9cdc3
Commit 7be9cdc3 authored Nov 11, 2022 by Haoshuang
Hide whitespace changes
Inline Side-by-side

Showing with 1 addition and 0 deletions

TrackingRos.cpp TrackingRos.cpp +1 -0

No files found.
--- a/TrackingRos.cpp
+++ b/TrackingRos.cpp
@@ -69,6 +69,7 @@ void my_compute_box_3d(Eigen::Vector3d center, double heading, Eigen::Vector3d s
    Trans(0, 3) = center[0];
    Trans(1, 3) = center[1];
    Trans(2, 3) = center[2];
+    Trans(3, 3) = 1.0;

    Eigen::Matrix4d Kit2Ori = Eigen::Matrix4d::Zero();
    for (int i = 0; i < 4; i++) {