为了解决四旋翼飞行器避障系统中激光和超声波传感器测距数据误差较大的问题,设计了一种改进的Sage_Husa自适应Kalman滤波算法。首先,在算法中引入遗忘因子,修正观测噪声协方差,校正数据结果,并使用Sage_Husa法对传统自适应Kalman滤波算法进行简化;然后,针对不同材质的障碍物墙面进行测距实验;最后,将结果与单一传感器和传统Kalman滤波算法的实验结果进行对比。结果显示,改进的Kalman滤波算法使激光和超声波传感器测量数据的融合结果更加稳定、准确,证明该算法能有效提高传感器的测量精度。

四旋翼飞行器机械原理简单,主要由四个螺旋桨和十字架结构机身组成,是典型的强耦合,非线性欠驱动的六自由度系统。四旋翼飞行器利用四个螺旋桨的转速变化,来控制机身的姿态变化。例如绕Y轴的俯仰和沿Y轴的左右移动;绕X轴的横滚和沿X轴的前进与后退;绕Z轴的偏航和沿Z轴的上升与下降。四旋翼飞行器的姿态控制是控制系统的核心部分,是热门研究课题。文章的主要内容如下1.首先对四旋翼飞行器进行了受力分析,通过导航坐标系与机体坐标系之间的变换及Newton-Euler方程对四旋翼飞行器建立运动学模型、动力学模型;2.根据建立的四旋翼飞行器的模型设计研究了基于抗饱和的串联PID控制算法,基于matlab/Simulink中提供的模块对四旋翼飞行器进行模拟仿真实验;3.基于饱和的串联PID控制算法进行仿真实验,结果表明基于抗饱和的串联PID控制算法有良好的动态特...