提交更新

37fe4418 · oscar · ec8430db · 37fe4418
Commit 37fe4418 authored Jan 12, 2022 by oscar
Hide whitespace changes
Inline Side-by-side

Showing with 2 additions and 2 deletions

TrackingRosEx.cpp TrackingRosEx.cpp +2 -2

No files found.
--- a/TrackingRosEx.cpp
+++ b/TrackingRosEx.cpp
@@ -136,8 +136,8 @@ void get_camera_tolidar_loc(float u, float v, float& x, float& y)
        3.81973306e-02, -1.21347206e+00, 5.53062060e+02,
        7.08859171e-05, -2.17867524e-03, 1.00000000e+00;
    auto trans_pos = cam_trans * loc_camera;
-    double h = trans_pos(2);
-    trans_pos = trans_pos / h;
+    double h = trans_pos[2];
+    //trans_pos = trans_pos / h;
    //Eigen::Matrix<double, 3, 3> R;
    //R << -0.602479577065, -0.797206640244, -0.038464091718,
    //    0.796449661255, -0.603639006615, 0.035887073725,