简介:为实现无人机高精度高可靠性导航,提出了一种以捷联惯性导航系统(SINS)为主,以地形辅助导航(TAN)、大气数据系统(ADS)及电子磁罗盘(MCP)为辅的组合导航方式。通过分析SINS、TAN、ADS及MCP单一系统的工作原理及输出误差模型,构建了SINS/TAN、SINS/ADS及SINS/MCP系统的状态方程及观测方程,最后采用联邦卡尔曼滤波方式实现了对各组合系统的信息融合。仿真数据对比表明:SINS/TAN系统位置误差较小,但航向误差较大;SINS/ADS系统速度误差较小且比较稳定,但位置误差随时间发散;SINS/MCP系统航向误差方差可达0.3783’,但其位置和速度估计精度不理想;而SINS/TAN/ADS/MCP系统能够克服上述不足,实现所有导航参数误差估计的高精度。
简介:针对四旋翼无人机轨迹追踪问题,提出了一种基于扩张状态观测器的鲁棒滑模控制方法。考虑无人机系统受到内外部扰动、线速度未知等不确定性影响,通过引入扩张状态观测器,对系统不确定因素进行实时估计并给予补偿,实现了系统对扰动的鲁棒性和对环境的高度适应性。同时,滑模控制通过引入切换函数来消除干扰及不确定项,但较大的切换增益会引起系统颤振,因此,干扰和不确定项是颤振的主要来源,利用扩张状态观测器来估计干扰及不确定项并加以补偿,消除了颤振。利用Lyapunov理论,证明了控制系统的稳定性。系统仿真实验结果表明,所提出的控制方法能够保证四旋翼无人机轨迹追踪的鲁棒性,旋翼转速最大跳变幅值降低86.4%-94.5%,提高了系统稳定性。