| 63 | 0 | 155 |
| 下载次数 | 被引频次 | 阅读次数 |
全向重载自动引导车(Automated Guided Vehicle,AGV)在不同工况下的舵轮形变会造成车轮里程计测量误差,进而降低导航定位精度。建立全向重载AGV的垂向动力学模型与车轮弹性变形模型以定量分析车轮变形,再利用运动学模型将车轮变形对定位误差的影响映射为AGV定位误差模型,基于此模型提出了一种融合车轮里程计和激光雷达信息的方法,其引入平方根扩展卡尔曼滤波器(Square Root Extended Kalman Filter,SREKF),融合激光雷达和轮式里程计的位姿数据,并添加误差补偿项以修正预测模型,从而修正舵轮变形导致的车轮里程计误差。经过仿真验证了重载条件下舵轮产生的变形误差,且实验结果表明采用所提补偿算法能将定位精度提升54.5%。所提算法能提升AGV在一般工况下的定位精度。
Abstract:The deformation of steering wheel in the heavy load condition of omnidirectional Automated Guided Vehicles(AGVs)can cause measurement errors in wheel odometers,which in turn reduces navigation accuracy. A vertical dynamic model and a wheel elasticity deformation model were established for the omnidirectional heavy load AGV,and their effects were mapped to a positioning error model using a kinematic model. Based on this model,a method that integrates wheel odometer and LiDAR information was proposed,which introduces a Square Root Extended Kalman Filter(SREKF)to fuse the pose data from LiDAR and wheel odometer and adds an error compensation term to correct the prediction model,thus correcting the wheel odometer errors caused by heavy load conditions. The simulation verifies the deformation error caused by the steering wheel under heavy load conditions,and experimental results show that the proposed compensation algorithm can improve the positioning accuracy by54.5%. The proposed algorithm can improve the positioning accuracy of AGVs under heavy load conditions.
[1]PANIGRAHI P K,BISOY S K. Localization strategies for autonomous mobile robots:A review[J]. Journal of King Saud University-Computer and Information Sciences,2021,34(8):6019-6039.
[2]BRESSON G,ALSAYED Z,YU L,et al. Simultaneous localization and mapping:A survey of current trends in autonomous driving[J]. IEEE Transactions on Intelligent Vehicles,2017,2(3):194-220.
[3]BORENSTEIN J,FENG L Q. Measurement and correction of systematic odometry errors in mobile robots[J]. IEEE Transactions on Robotics&Automation,1996,12(6):869-880.
[4]张铁,陈伟华,邹焱飚,等.移动机器人里程计系统误差的校正方法[J].华南理工大学学报(自然科学版),2014,42(9):7-11.
[5]BERSANI M,MENTASTI S,DAHAL P,et al. An integrated algorithm for ego-vehicle and obstacles state estimation for autonomous driving[J]. Robotics and Autonomous Systems,2021,139:103662.
[6]YANG H,PARK K,LEE J G,et al. A rotating sonar and a differential encoder data fusion for map-based dynamic positioning[J]. Journal of Intelligent&Robotic Systems,2000,29(3):211-232.
[7]ABBAS T,ARIF M,AHMED W. Measurement and correction of systematic odometry errors caused by kinematics imperfections in mobile robots[C]//International Joint International on Sice-icase. IEEE,2007.
[8]CHO H,KIM E K,JANG E,et al. Improved positioning method for Magnetic Encoder type AGV using Extended Kalman Filter and Encoder Compensation Method[J]. International Journal of Control,Automation and Systems,2017,15(4):1844-1856.
[9]JIANG F,CHEN J,JI S. Panoramic visual-inertial SLAM tightly coupled with a wheel encoder[J]. ISPRS Journal of Photogrammetry and Remote Sensing,2021,182:96-111.
[10]MARTINELLI A. The odometry error of a mobile robot with a synchronous drive system[J]. IEEE Transactions on Robotics&Automation,2002,18(3):399-405.
[11]张亮修,吴光强,王宇.车辆纵-侧-垂向动力学统一建模及实车验证[J].机械工程学报,2019,55(16):144-122.
[12]JIN Y,LUO X. Stochastic optimal active control of a half-car nonlinear suspension under random road excitation[J]. Nonlinear Dynamics,2012,72(1-2):185-195.
[13]ZHANG J,SINGH S. Laser-visual-inertial odometry and mapping with high robustness and low drift[J]. Journal of Field Robotics,2018,35(8):1242-1264.
[14]CHEN L H,PENG C C. A robust 2D-SLAM technology with environmental variation adaptability[J].IEEE Sensors Journal,2019,19(23):11475-11491.
[15]SMIDL V. Advantages of square-root extended kalman filter for sensorless control of AC drives[J].IEEE Transactions on Industrial Electronics,2012,59(11):4189-4196.
基本信息:
中图分类号:TP23
引用信息:
[1]耿郑一,汪步云.全向重载AGV融合定位误差补偿算法研究[J].淮阴工学院学报,2025,34(02):11-18.
基金信息:
安徽省重点研究与开发计划“基于生机多模态信息共融的助力行走型下肢外骨骼机器人产品研发”(202004a05020013)
2023-11-07
2023
2024-04-01
2024-03-28
2024
1
2025-04-15
2025-04-15