test filterByPosition

apps/function/multi_traj_functions.cpp

@@ -196,7 +196,7 @@ void filterByPosition(
             auto period = oneRet.periods.at(periodIndex);
             PointCloudExport periodCloud =
                     getCloudFromPeriod(pointClouds.at(oneRet.index), period);
-            LOG(INFO) << "periodCloud.size(): " << periodCloud.size();
+//            LOG(INFO) << "periodCloud.size(): " << periodCloud.size();
             if(0 == periodCloud.size()){
                 continue;
             }
@@ -214,6 +214,9 @@ void filterByPosition(
                     auto tarPeriod = tarOneRet.periods.at(tarPeriodIndex);
                     PointCloudExport tarPeriodCloud =
                             getCloudFromPeriod(pointClouds.at(tarOneRet.index), tarPeriod);
+                    if(0 == tarPeriodCloud.size()){
+                        continue;
+                    }
                     uint32_t hitCnt = 0;
                     for(const PointExport& query : tarPeriodCloud.points){
                         int result_index;