Semantic-Aware Particle Filter for Reliable Vineyard Robot Localisation
2509.18342v1
cs.RO, cs.CV
2025-09-25
Авторы:
Rajitha de Silva, Jonathan Cox, James R. Heselden, Marija Popovic, Cesar Cadena, Riccardo Polvara
Резюме на русском
## Контекст
В большинстве структурированных внешних сред, таких как рельефные ландшафты, возможность точной локализации мобильных роботов является критическим аспектом. Однако в виноградниках, где повторяющиеся ряды винограда и перцептивная алиазия создают сложности, традиционные методы основанные на LiDAR часто оказываются неэффективными. Особенностью этой проблемы является то, что во времена зеленого зеления винограда, когда растения еще не очень высоки, и в темноте, когда роботы должны оперировать в условиях ограниченной видимости, локализация становится еще сложнее. Мы предлагаем новый подход, основанный на семантически фильтре частиц, который использует стабильные объектно-уровневые детекции, в частности стволы виноградников и подвязки, чтобы улучшить точность.
## Метод
Мы предложили метод, который включает в себя партикл-фильтр семантического уровня. Детектированные знаковые объекты, такие как стволы виноградников и подвязки, проецируются в плоскость вида сверху (bird’s eye view). Затем эти проекции объединяются с сканными данными LiDAR, чтобы формировать семантические наблюдения. Основная инновация заключается в использовании семантических стен, которые соединяют детектированные объекты в псевдо-структурные ограничения. Это позволяет устранить ситуации, когда робот может быть отклонен из расположения в строю. Для поддержки мировой консистенции в зонах скудных семантических данных, таких как головные участки, мы вводим шумной приоритетный GPS, который может адаптивно поддерживать фильтр.
## Результаты
Мы провели эксперименты в реальном винограднике, чтобы протестировать нашу методику. Наши результаты показали, что наш подход позволяет роботу постоянно оставаться в правильном ряду, даже когда другие способы, например AMCL (Adaptive Monte Carlo Localization), проваливаются. Мы также проводили сравнение с другими методами, в том числе SLAM-методом RTAB-Map, и наши показатели показали выразительное улучшение в локализации. Эксперименты показывают, что наш метод эффективен даже в сложных условиях, таких как ночное время или ряды винограда с низким развитием растений.
## Значимость
Наш метод имеет широкое применение в агротехнологиях, особенно в сегментах, где точная локализация критична, таких как автоматизация роботов в виноградниках. Он предоставляет значительное преимущество перед традиционными методами, такими как LiDAR-based SLAM, в условиях отсутствия семантических признаков. Этот подход может иметь потенциал для улучшения других мобильных роботов в сложных внешних средах, таких как поля,
Abstract
Accurate localisation is critical for mobile robots in structured outdoor
environments, yet LiDAR-based methods often fail in vineyards due to repetitive
row geometry and perceptual aliasing. We propose a semantic particle filter
that incorporates stable object-level detections, specifically vine trunks and
support poles into the likelihood estimation process. Detected landmarks are
projected into a birds eye view and fused with LiDAR scans to generate semantic
observations. A key innovation is the use of semantic walls, which connect
adjacent landmarks into pseudo-structural constraints that mitigate row
aliasing. To maintain global consistency in headland regions where semantics
are sparse, we introduce a noisy GPS prior that adaptively supports the filter.
Experiments in a real vineyard demonstrate that our approach maintains
localisation within the correct row, recovers from deviations where AMCL fails,
and outperforms vision-based SLAM methods such as RTAB-Map.
Ссылки и действия
Дополнительные ресурсы: