高级检索+

基于多速率卡尔曼滤波的植保无人机仿地飞行方法

Terrain Following Flight for Plant Protection UAV Based on Multi-rate Kalman Filter

  • 摘要: 针对四旋翼植保无人机坡地适应性差、作业时定高精度低的问题,提出了一种融合立体视觉、气压计及惯性测量单元(IMU)的多速率卡尔曼滤波估计无人机高度的仿地飞行方法。首先基于无人机实时高度、姿态与最佳视觉检测区域之间的关系,提出了视觉检测区域自适应算法;然后融合多传感器信息建立多速率卡尔曼滤波模型用以估计无人机对地高度;最后通过自主飞行实验对无人机高度估计算法与仿地飞行方法进行验证。实验结果表明,当飞行高度为2 m,飞行速度为1、2、3 m/s时,植保无人机在平坦地面与15°缓坡区域均可实现高度估计平均绝对误差小于20 mm,高度估计标准差小于30 mm;高度控制平均绝对误差小于30 mm,高度控制标准差小于30 mm;本文验证了植保无人机在地形变化场景下仿地飞行的有效性,为植保无人机在复杂地形自动化作业奠定了基础。

     

    Abstract: Aiming at the problems that the quadrotor plant protection unmanned aerial vehicle(UAV) has poor adaptability in sloping land and imprecise height measurement accuracy during operation, a terrain following flight method based on multi-rate Kalman filtering fusion of stereo vision, barometer and inertial measurement unit(IMU) information was proposed to estimate the height of UAV. Firstly, the ZED2 camera was used to obtain the binocular image of the ground below the UAV, and the point cloud information corresponding to the binocular image was calculated through the parallax principle. After analyzing the relationship between the height of the point cloud, the attitude of the UAV and the best visual detection area, an adaptive algorithm for the visual detection area was proposed to select the ground detection area. The accurate visual ground height was obtained by analyzing the point cloud data of the detection area. Secondly, a multi-rate Kalman filter model was established which fused the visual height, barometer and IMU information to estimate the height above the ground of the UAV. Finally, a two-level control system was composed of an NVIDIA microcomputer and a flight controller. The UAV’s height estimation and terrain following flight performance were verified by flight experiments. The height estimation results of remote-control flight showed that the method proposed can achieve height estimation with an absolute average error of 46.8 mm and a standard deviation of 38.2 mm under large height changes. The autonomous terrain following flight experiment showed that when the flight height was set to be 2 m and the speed was 1 m/s, 2 m/s and 3 m/s, respectively, no matter on the flat ground or the gentle slope of 15°, the absolute average error of height estimation was less than 20 mm, and the standard deviation of height estimation was less than 30 mm; the absolute average error of height control was less than 30 mm, and the standard deviation of height control was less than 30 mm. The research result verified the effectiveness of the plant protection UAV in the terrain changing scene, and laid a foundation for the automatic operation of the plant protection UAV in complex terrain.

     

/

返回文章
返回