Lidar positioning and path tracking of a single steering wheel automated guided vehicle forklift

被引:0
|
作者
Yao M. [1 ,2 ,3 ]
Duan J. [1 ,2 ,3 ]
Shao Z. [1 ,2 ,3 ]
Yuan S. [4 ]
Su Y. [1 ,2 ,3 ]
机构
[1] Department of Mechanical Engineering, Tsinghua University, Beijing
[2] State Key Laboratory of Tribology, Tsinghua University, Beijing
[3] Beijing Key Laboratory of Precision/Ultra-Precision Manufacturing Equipment and Control, Tsinghua University, Beijing
[4] Beijing Chieftain Control Engineering Technology Co., Ltd., Beijing
关键词
automated guided vehicle (AGV) forklift; Bézier curve; Lidar positioning; Path tracking; Proportional-integral (PI) control;
D O I
10.16511/j.cnki.qhdxxb.2023.21.022
中图分类号
学科分类号
摘要
[Objective] automated guided vehicle (AGV) forklift is an important material transportation equipment in the industrial field. Its positioning and path-tracking accuracy is an important basis for improving material transportation efficiency, factory automation, and intelligence. Thus, this paper uses a single steering wheel AGV forklift in an indoor structured environment of the pharmaceutical industry as an object, realizing the lidar positioning based on the reflector using the density-based spatial clustering of applications with noise (DBSCAN) and the fast iterative closest point (FICP) algorithms, and designing a proportional-integral (PI) controller to address the path-tracking problem of the AGV forklift. [Methods] First, the kinematics characteristics of the single steering wheel AGV forklift are analyzed, and its kinematics equations and state space equations are established. Subsequently, the DBSCAN and FICP algorithms were used to implement a reflector-based lidar positioning method for an accurate positioning problem. Moreover, a distance-based outlier elimination rule is proposed to address the problem of outliers interfering with the positioning process, which ensures the stability of the positioning results and the robustness of the algorithm. The Kalman filter algorithm is used to fuse the measurement data of the inertial measurement unit (IMU) and the angle sensor to improve the accuracy of the lidar positioning algorithm of the AGV forklift. This study establishes the position error and attitude error in the two core paths of straight lines and arcs based on the geometric relationship for the path-tracking problem. Following that, a PI controller is designed to realize the path tracking of the AGV forklift. Considering curvature discontinuity when the arc of equal curvature is connected with the straight-line path, the arc path based on the third-order Bézier curve was designed in this study. Furthermore, according to the limitation of the AGV forklift in the arc movement process, the parameters of the Bézier curve are analyzed and optimized to avoid the decrease of the path-tracking accuracy caused by the abrupt change of the path curvature. [Results] The experimental verification showed that the lidar positioning algorithm based on DBSCAN and FICP algorithms could achieve ±3 mm positioning accuracy. Stable AGV forklift positioning could be achieved when combined with the outlier elimination rules. Furthermore, the Kalman filter-based fusion of IMU and angle sensor data resulted in accurate AGV forklift positioning. The improved arc path based on the Bézier curve reduced the arc path tracking error by about 72% compared with the equal-curvature arc path. The AGV's position and attitude errors were controlled based on the PI controller, which could control the dynamic tracking accuracy to within 25 mm. Furthermore, the repeated positioning accuracy of the work site reached ±12 mm, meeting the expected design requirements. [Conclusions] This paper studies the lidar positioning and path-tracking technology of a single steering wheel AGV forklift in an indoor structured environment. An accurate and stable lidar positioning algorithm based on DBSCAN and FICP algorithms is realized by introducing outlier elimination rules and the Kalman filter. The AGV forklift's path tracking is realized using the PI controller, and the tracking accuracy of the arc path is improved using the Bézier curve. Finally, the positioning accuracy, path-tracking accuracy, and repeated positioning accuracy of the work site all met the expected design requirements. © 2024 Press of Tsinghua University. All rights reserved.
引用
收藏
页码:117 / 129
页数:12
相关论文
共 31 条
  • [1] ZHANG Z, CHEN J, GUO Q., Application of automated guided vehicles in smart automated warehouse systems: A survey, Computer Modeling in Engineering o- Sciences, 134, 3, pp. 1529-1563, (2023)
  • [2] FU J L, ZHANG H Z, ZHANG J, Et al., Review on AGV scheduling optimization, Journal of System Simulation, 32, 9, pp. 1664-1675, (2020)
  • [3] IVANOV D, TANG C S, DOLGUI A, Et al., Researchers' perspectives on Industry 4. 0: Multi-disciplinary analysis and opportunities for operations management, International Journal of Production Research, 59, 7, pp. 2055-2078, (2021)
  • [4] DOS REIS W P N, COUTO G E, JUNIOR O M., Automated guided vehicles position control: A systematic literature review, Journal of Intelligent Manufacturing, 34, 4, pp. 1483-1545, (2023)
  • [5] HUANG M Q., AGV precise localization and motion control method [D], (2019)
  • [6] LIU P., Research on AGV positioning method and trajectory tracking control in inertial navigation, (2020)
  • [7] HUI Z., Design and research of forklift AGV control system based on magnetic navigation, (2019)
  • [8] SONG Z, WU X Y, XUTT, Et al., A new method of AGV navigation based on Kalman Filter and a magnetic nail localization, Proceedings of 2016 IEEE International Conference on Robotics and Biomimetics (ROBIO), pp. 952-957, (2016)
  • [9] GUAN X J., Research and application of AGV visual navigation and path planning algorithm [D], (2022)
  • [10] ZHANG H Y, CHENG X Q, LIU C, Et al., Visual localization technology of AGV based on global sparse map, Journal of Beijing University of Aeronautics and Astronautics, 45, 1, pp. 218-226, (2019)