Try elapsed time

Author: TadaKazuto

perception/multi_object_tracker/src/multi_object_tracker_core.cpp

@@ -507,9 +507,8 @@ void MultiObjectTracker::sanitizeTracker(
       }
 
       if (delete_candidate_tracker) {
-        /* erase only when prioritized one has a measurement or the other one doesn't */
-        if (sorted_list_tracker[i]->getNoMeasurementCount() <= 0 or 
-            sorted_list_tracker[j]->getNoMeasurementCount() > 0) {
+        /* erase only when prioritized one has later(or equal time) meas than the other one doesn't */
+        if (sorted_list_tracker[i]->getElapsedTimeFromLastUpdate() <= sorted_list_tracker[j]->getElapsedTimeFromLastUpdate()) {
           // Remove from original list_tracker
           list_tracker.remove(sorted_list_tracker[j]);
           // Remove from sorted list