map dir

f4f4ccb4 · wangdawei · 5f0fb1d5 · f4f4ccb4
Commit f4f4ccb4 authored Jun 03, 2023 by wangdawei
Hide whitespace changes
Inline Side-by-side

Showing with 2 additions and 0 deletions

dispatch.cpp libs/voxel_map/libs/dispatch/dispatch.cpp +2 -0

No files found.
--- a/libs/voxel_map/libs/dispatch/dispatch.cpp
+++ b/libs/voxel_map/libs/dispatch/dispatch.cpp
@@ -49,6 +49,8 @@ void Dispatch::configOffset()
    size_t cnt = 0;
    for(size_t i = 0; i < pointcloud_->size(); i++){
        if(i > 0 && i % 1000000 == 0){
+            LOG(INFO) << "totalPosi: " << totalPosi.transpose()
+                      << " cnt: " << cnt;
            avgPosiVec.push_back(totalPosi / cnt);
            totalPosi = Vector3d::Zero();
            cnt = 0;