@@ -388,15 +388,18 @@ void MultiObjectTracker::sanitizeTracker(
388
388
constexpr double distance_threshold = 5.0 ;
389
389
390
390
// Create sorted list with non-UNKNOWN objects first, then by measurement count
391
- std::vector<std::shared_ptr<Tracker>> sorted_list_tracker (list_tracker.begin (), list_tracker.end ());
392
- std::sort (sorted_list_tracker.begin (), sorted_list_tracker.end (),
393
- [](const std::shared_ptr<Tracker>& a, const std::shared_ptr<Tracker>& b) {
391
+ std::vector<std::shared_ptr<Tracker>> sorted_list_tracker (
392
+ list_tracker.begin (), list_tracker.end ());
393
+ std::sort (
394
+ sorted_list_tracker.begin (), sorted_list_tracker.end (),
395
+ [](const std::shared_ptr<Tracker> & a, const std::shared_ptr<Tracker> & b) {
394
396
bool a_unknown = (a->getHighestProbLabel () == Label::UNKNOWN);
395
397
bool b_unknown = (b->getHighestProbLabel () == Label::UNKNOWN);
396
398
if (a_unknown != b_unknown) {
397
399
return b_unknown; // Put non-UNKNOWN objects first
398
400
}
399
- return a->getTotalMeasurementCount () > b->getTotalMeasurementCount (); // Then sort by measurement count
401
+ return a->getTotalMeasurementCount () >
402
+ b->getTotalMeasurementCount (); // Then sort by measurement count
400
403
});
401
404
402
405
/* delete collision tracker */
@@ -438,8 +441,9 @@ void MultiObjectTracker::sanitizeTracker(
438
441
439
442
if (delete_candidate_tracker) {
440
443
/* erase only when prioritized one has later(or equal time) meas than the other's */
441
- if (sorted_list_tracker[i]->getElapsedTimeFromLastUpdate (time ) <=
442
- sorted_list_tracker[j]->getElapsedTimeFromLastUpdate (time )) {
444
+ if (
445
+ sorted_list_tracker[i]->getElapsedTimeFromLastUpdate (time ) <=
446
+ sorted_list_tracker[j]->getElapsedTimeFromLastUpdate (time )) {
443
447
// Remove from original list_tracker
444
448
list_tracker.remove (sorted_list_tracker[j]);
445
449
// Remove from sorted list
0 commit comments