Fusion of Odometry and Ultrasonic Observations for Multi-constraint Graph Optimization SLAM

Xing-wen MIAO , Yu-hong ZHU , Hong-jin ZHU

Science Technology and Engineering ›› 2026, Vol. 26 ›› Issue (14) : 6056 -6063.

PDF
Science Technology and Engineering ›› 2026, Vol. 26 ›› Issue (14) : 6056-6063 DOI: 10.12404/j.issn.1671-1815.2504299
research-article
Fusion of Odometry and Ultrasonic Observations for Multi-constraint Graph Optimization SLAM
Author information +
History +
PDF

Abstract

A robust ultrasonic SLAM algorithm based on multi-constraint graph optimization was proposed to address the issues of positioning drift and poor mapping quality in conventional ultrasonic SLAM systems caused by low sensor resolution in complex environments. To ensure successful line feature extraction, temporal information from consecutive M ultrasonic detections was fused, and a split-merge algorithm was employed to achieve stable line feature extraction. A graph model incorporating odometry motion constraints and ultrasonic observation constraints was constructed, where the weights of each constraint are dynamically adjusted based on sensor uncertainty. The joint optimization problem of pose and features was solved using sparse matrix decomposition and the Levenberg-Marquardt algorithm. Simulation results demonstrate that compared to odometry-based dead reckoning and extended Kalman filter SLAM methods, the average positioning accuracy is improved by approximately 83.8% and 63.5%, respectively, with an average map error of only 1.19 cm and a map coverage rate reaching 96%. An experimental platform was established to further validate the algorithm in real-world environments. This work provides a novel approach for low-cost ultrasonic SLAM systems, suitable for resource-constrained devices or extreme scenarios such as smoke-filled environments.

Graphical abstract

Keywords

graph optimization / SLAM / ultrasonic environmental sensing / split-merge algorithm / line segment features / Levenberg-Marquardt

Cite this article

Download citation ▾
Xing-wen MIAO, Yu-hong ZHU, Hong-jin ZHU. Fusion of Odometry and Ultrasonic Observations for Multi-constraint Graph Optimization SLAM. Science Technology and Engineering, 2026, 26(14): 6056-6063 DOI:10.12404/j.issn.1671-1815.2504299

登录浏览全文

4963

注册一个新账户 忘记密码

References

Funding

PDF (5738KB)

25

Accesses

0

Citation

Detail

Sections
Recommended

/

〈 〉