提价代码

e83ec6ef · oscar · f3efaecb · e83ec6ef
Commit e83ec6ef authored Dec 10, 2021 by oscar
Hide whitespace changes
Inline Side-by-side

Showing with 2 additions and 2 deletions

TrackingRos.cpp TrackingRos.cpp +2 -2

No files found.
--- a/TrackingRos.cpp
+++ b/TrackingRos.cpp
@@ -11,8 +11,8 @@ void CalculateGuassPos(float x, float y,float z,std::vector<std::vector<float>>&
    Eigen::Vector4f svTmp;
    svTmp << x, y, z, 1;
    Eigen::Matrix4f Trans = Eigen::Matrix4f::Zero();
-    for (int i = 0; i < 3; i++) {
-        for (int j = 0; j < 3; j++) {
+    for (int i = 0; i < 4; i++) {
+        for (int j = 0; j < 4; j++) {
            Trans(i, j) = trans[i][j];
        }
    }