College of Intelligence Science and Technology, National University of Defense Technology, Changsha 410073, China.
Sensors (Basel). 2019 Mar 18;19(6):1340. doi: 10.3390/s19061340.
There are many algorithms that can be used to fuse sensor data. The complementary filtering algorithm has low computational complexity and good real-time performance characteristics. It is very suitable for attitude estimation of small unmanned aerial vehicles (micro-UAVs) equipped with low-cost inertial measurement units (IMUs). However, its low attitude estimation accuracy severely limits its applications. Though, many methods have been proposed by researchers to improve attitude estimation accuracy of complementary filtering algorithms, there are few studies that aim to improve it from the data processing aspect. In this paper, a real-time first-order differential data processing algorithm is proposed for gyroscope data, and an adaptive adjustment strategy is designed for the parameters in the algorithm. Besides, the differential-nonlinear complementary filtering (D-NCF) algorithm is proposed by combine the first-order differential data processing algorithm with the basic nonlinear complementary filtering (NCF) algorithm. The experimental results show that the first-order differential data processing algorithm can effectively correct the gyroscope data, and the Root Mean Square Error (RMSE) of attitude estimation of the D-NCF algorithm is smaller than when the NCF algorithm is used. The RMSE of the roll angle decreases from 1.1653 to 0.5093, that of the pitch angle decreases from 2.9638 to 1.5542, and that of the yaw angle decreases from 0.9398 to 0.6827. In general, the attitude estimation accuracy of D-NCF algorithm is higher than that of the NCF algorithm.
有许多算法可用于融合传感器数据。互补滤波算法具有计算复杂度低和良好实时性能的特点,非常适合配备低成本惯性测量单元(IMU)的小型无人机(微型无人机)的姿态估计。然而,其低姿态估计精度严重限制了其应用。尽管如此,研究人员已经提出了许多方法来提高互补滤波算法的姿态估计精度,但很少有研究旨在从数据处理方面来提高其精度。本文提出了一种用于陀螺仪数据的实时一阶差分数据处理算法,并为算法中的参数设计了自适应调整策略。此外,通过将一阶差分数据处理算法与基本非线性互补滤波(NCF)算法相结合,提出了差分非线性互补滤波(D-NCF)算法。实验结果表明,一阶差分数据处理算法可以有效地校正陀螺仪数据,并且 D-NCF 算法的姿态估计均方根误差(RMSE)小于使用 NCF 算法时的 RMSE。D-NCF 算法的滚转角 RMSE 从 1.1653 降低到 0.5093,俯仰角 RMSE 从 2.9638 降低到 1.5542,偏航角 RMSE 从 0.9398 降低到 0.6827。总的来说,D-NCF 算法的姿态估计精度高于 NCF 算法。