Tightly-Coupled LiDAR-IMU-Wheel Odometry with Online Calibration of a Kinematic Model for Skid-Steering Robots (2404.02515v3)
Abstract: Tunnels and long corridors are challenging environments for mobile robots because a LiDAR point cloud should degenerate in these environments. To tackle point cloud degeneration, this study presents a tightly-coupled LiDAR-IMU-wheel odometry algorithm with an online calibration for skid-steering robots. We propose a full linear wheel odometry factor, which not only serves as a motion constraint but also performs the online calibration of kinematic models for skid-steering robots. Despite the dynamically changing kinematic model (e.g., wheel radii changes caused by tire pressures) and terrain conditions, our method can address the model error via online calibration. Moreover, our method enables an accurate localization in cases of degenerated environments, such as long and straight corridors, by calibration while the LiDAR-IMU fusion sufficiently operates. Furthermore, we estimate the uncertainty (i.e., covariance matrix) of the wheel odometry online for creating a reasonable constraint. The proposed method is validated through three experiments. The first indoor experiment shows that the proposed method is robust in severe degeneracy cases (long corridors) and changes in the wheel radii. The second outdoor experiment demonstrates that our method accurately estimates the sensor trajectory despite being in rough outdoor terrain owing to online uncertainty estimation of wheel odometry. The third experiment shows the proposed online calibration enables robust odometry estimation in changing terrains.
- Z. Liu and F. Zhang, “Balm: Bundle adjustment for lidar mapping,” IEEE Robotics and Automation Letters, vol. 6, no. 2, pp. 3184–3191, 2021.
- C. Qin, H. Ye, C. E. Pranata, J. Han, S. Zhang, and M. Liu, “Lins: A lidar-inertial state estimator for robust and efficient navigation,” in 2020 IEEE International Conference on Robotics and Automation (ICRA). IEEE, 2020, pp. 8899–8906.
- W. Xu, Y. Cai, D. He, J. Lin, and F. Zhang, “Fast-lio2: Fast direct lidar-inertial odometry,” IEEE Transactions on Robotics, vol. 38, no. 4, pp. 2053–2073, 2022.
- G. Anousaki and K. J. Kyriakopoulos, “A dead-reckoning scheme for skid-steered vehicles in outdoor environments,” in 2004 IEEE International Conference on Robotics and Automation (ICRA). IEEE, 2004, pp. 580–585.
- A. Mandow, J. L. Martinez, J. Morales, J. L. Blanco, A. Garcia-Cerezo, and J. Gonzalez, “Experimental kinematics for wheeled skid-steer mobile robots,” in 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE, 2007, pp. 1222–1227.
- T. Wang, Y. Wu, J. Liang, C. Han, J. Chen, and Q. Zhao, “Analysis and experimental kinematics of a skid-steering wheeled robot based on a laser scanner sensor,” Sensors, vol. 15, no. 5, pp. 9681–9702, 2015.
- D. Baril, V. Grondin, S.-P. Deschênes, J. Laconte, M. Vaidis, V. Kubelka, A. Gallant, P. Giguere, and F. Pomerleau, “Evaluation of skid-steering kinematic models for subarctic environments,” in 2020 17th Conference on Computer and Robot Vision (CRV). IEEE, 2020, pp. 198–205.
- R. Kümmerle, G. Grisetti, and W. Burgard, “Simultaneous calibration, localization, and mapping,” in 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE, 2011, pp. 3716–3721.
- R. Kümmerle, G. Grisetti, and W. Burgard, “Simultaneous parameter calibration, localization, and mapping,” Advanced Robotics, vol. 26, no. 17, pp. 2021–2041, 2012.
- W. Lee, K. Eckenhoff, Y. Yang, P. Geneva, and G. Huang, “Visual-inertial-wheel odometry with online calibration,” in 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE, 2020, pp. 4559–4566.
- S. Bedín, J. Civera, and M. Nitsche, “Teach and repeat and wheel calibration for lidar-equipped omnidirectional drive robots,” in 2023 European Conference on Mobile Robots (ECMR). IEEE, 2023, pp. 1–6.
- X. Zuo, M. Zhang, Y. Chen, Y. Liu, G. Huang, and M. Li, “Visual-inertial localization for skid-steering robots with kinematic constraints,” in The International Symposium of Robotics Research. Springer, 2019, pp. 741–756.
- X. Zuo, M. Zhang, M. Wang, Y. Chen, G. Huang, Y. Liu, and M. Li, “Visual-based kinematics and pose estimation for skid-steering robots,” IEEE Transactions on Automation Science and Engineering, 2022.
- K. Koide, M. Yokozuka, S. Oishi, and A. Banno, “Voxelized gicp for fast and accurate 3d point cloud registration,” in 2021 IEEE International Conference on Robotics and Automation (ICRA). IEEE, 2021, pp. 11 054–11 059.
- M. Teschner, B. Heidelberger, M. Müller, D. Pomerantes, and M. H. Gross, “Optimized spatial hashing for collision detection of deformable objects.” in Vmv, vol. 3, 2003, pp. 47–54.
- K. Koide, M. Yokozuka, S. Oishi, and A. Banno, “Globally consistent 3d lidar mapping with gpu-accelerated gicp matching cost factors,” IEEE Robotics and Automation Letters, vol. 6, no. 4, pp. 8591–8598, 2021.
- ——, “Globally consistent and tightly coupled 3d lidar inertial mapping,” in 2022 International Conference on Robotics and Automation (ICRA). IEEE, 2022, pp. 5622–5628.
- C. Forster, L. Carlone, F. Dellaert, and D. Scaramuzza, “On-manifold preintegration for real-time visual–inertial odometry,” IEEE Transactions on Robotics, vol. 33, no. 1, pp. 1–21, 2016.
- T. Qin, P. Li, and S. Shen, “Vins-mono: A robust and versatile monocular visual-inertial state estimator,” IEEE Transactions on Robotics, vol. 34, no. 4, pp. 1004–1020, 2018.
- M. Kaess, H. Johannsson, R. Roberts, V. Ila, J. J. Leonard, and F. Dellaert, “isam2: Incremental smoothing and mapping using the bayes tree,” The International Journal of Robotics Research, vol. 31, no. 2, pp. 216–235, 2012.
- Z. Zhang and D. Scaramuzza, “A tutorial on quantitative trajectory evaluation for visual (-inertial) odometry,” in 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE, 2018, pp. 7244–7251.
- Taku Okawara (3 papers)
- Kenji Koide (20 papers)
- Shuji Oishi (20 papers)
- Masashi Yokozuka (20 papers)
- Atsuhiko Banno (17 papers)
- Kentaro Uno (14 papers)
- Kazuya Yoshida (22 papers)