Abstract：Aiming at the problem of large attitude estimation error of wall climbing robot due to the limited application of sensors in the relatively closed and magnetic interference environment, a new attitude estimation method based on inertial measurement unit(IMU) and cylindrical shape constraint is proposed and implemented. Taking advantage of the frequent switching between the moving and stationary states of the wall climbing robot, the angular velocity drift of IMU in the moving state is estimated using the angular velocity output of IMU in the stationary state. With the constant roll angle constrained by the cylinder surface, an extended Kalman filter(EKF) is designed to estimate the attitude of robot and the angular velocity drift of IMU in real time. The experimental results show that this method can reduce the heading angle error in attitude estimation from over 20°to 3.5°, and the pitch angle error is remained within 2ånd the roll angle error is less than 0.5°, which effectively improves the accuracy of the attitude estimation.
[1] MANUEL V,ILYAS M,SRIHARSHA G,et al.Multi-sensor orientation tracking for a facade-cleaning robot[J].Sensors,2020,20(5):1483. [2] 齐有泉,李艳文,陈子明,等.串联九自由度喷涂机器人及其运动学分[J].机械工程学报,2020,56(23):165-171.QI Youquan,LI Yanwen,CHEN Ziming,et al.Design and kinematics'analying of a series nine-degree-of-freedom spraying robot[J].Journal of Mechanical Engineering,2020,56(23):165-171. [3] ZHANG Gang,SHI Yu,GU Yufen,et al.Welding torch attitude-based study of human welder interactive behavior with weld pool in GTAW[J].Robotics and Computer-Integrated Manufacturing,2017,48:145-156. [4] HE Yinshui,YU Zhuohua,LI Jian,et al.Discerning weld seam profiles from strong arc background for the robotic automated welding process via visual attention features[J].Chinese Journal of Mechanical Engineering,2020,33(1):1-12. [5] RICCARDO C,FRANCESCO F,NICCOLÒM,et al.An attitude estimation algorithm for mobile robots under unknown magnetic disturbances[J].IEEE/ASMETransactions on Mechatronics,2016,21(4):1900-1911. [6] DAVIDE F,KEVIN K,DAVIDE S.Dynamic obstacle avoidance for quadrotors with event cameras[J].Science Robotics,2020,5(40):13-27. [7] QIN Tong,LI Peiliang,SHEN Shaojie.Vins-mono:Arobust and versatile monocular visual-inertial state estimator[J].IEEE Transactions on Robotics,2018,34(4):1004-1020. [8] ROSS H,MAANI G,RYAN M,et al.Contact-aided invariant extended Kalman filtering for robot state estimation[J].The International Journal of Robotics Research,2020,39(4):402-430. [9] SAMUEL W,HENRY E,YOSHIKATSU H,et al.Formulation of a new gradient descent MARG orientation algorithm:Case study on robot teleoperation[J].Mechanical Systems and Signal Processing,2019,130:183-200. [10] WU Jin,ZHOU Zebo,FOURATI H,et al.A super fast attitude determination algorithm for consumer-level accelerometer and magnetometer[J].IEEE Transactions on Consumer Electronics,2018,64(3):375-381. [11] DAVID F,RALF M.Comparing holistic and feature-based visual methods for estimating the relative pose of mobile robots[J].Robotics and Autonomous Systems,2017,89:51-74. [12] 邢志伟,朱晓蕊,何超.基于行人行为学习的机器人同时定位与可通行区域制图[J].机械工程学报,2019,55(11):36-45.XING Zhiwei,ZHU Xiaorui,HE Chao.Simultaneous localization and traversable region mapping based on pedestrian behavior learning[J].Journal of Mechanical Engineering,2019,55(11):36-45. [13] YU Hongshan,FU Qiang,YANG Zhengeng,et al.Robust robot pose estimation for challenging scenes with an RGB-D camera[J].IEEE Sensors Journal,2018,19(6):2217-2229. [14] AMEDEO R V,CAUSA F,RENGA A,et al.Multi-UAVcarrier phase differential GPS and vision-based sensing for high accuracy attitude estimation[J].Journal of Intelligent & Robotic Systems,2019,93(1):245-260. [15] JEREMY M,MAX B,SARA S,et al.Real-time pose estimation of a dynamic quadruped in GPS-denied environments for 24-hour operation[J].The International Journal of Robotics Research,2016,35(6):631-653. [16] TU Chunlei,JIN Shanshan,ZHENG Kai,et al.Support and positioning mechanism of a detection robot inside a spherical tank[J].Chinese Journal of Mechanical Engineering,2021,34(1):1-10. [17] HEIKKI H,ARTO V.A DCM based attitude estimation algorithm for low-cost MEMS IMUs[J].International Journal of Navigation & Observation,2015(1):115-133. [18] SHASHI P,PARAG N,VIPAN K,et al.PSO aided adaptive complementary filter for attitude estimation[J].Journal of Intelligent & Robotic Systems,2017,87(3):531-543. [19] WU Zheming,SUN Zhenguo,ZHANG Wenzeng,et al.A novel approach for attitude estimation based on MEMSinertial sensors using nonlinear complementary filters[J].IEEE Sensors Journal,2016,16(10):3856-3864. [20] JIA Yong,LI Suilao,QIN Yongyuan,et al.Error analysis and compensation of MEMS rotation modulation inertial navigation system[J].IEEE Sensors Journal,2018,18(5):2023-2030.
