简介:惯性导航系统(INS)以其自主的工作能力广泛应用于军事武备的导航、制导与控制系统和国民经济的诸多领域.它的主要缺点是定位误差随其工作时间的增长而增大.对惯导系统的误差进行估计和补偿是在保证性能价格比的前提下,提高惯性导航系统精度的有效途径.目前,对惯导系统的误差修正均采用外信息(如GPS的输出信息)校正,即在INS工作的全部时间内,定期地利用GPS输出的速度和位置信息与INS输出的相应信息的差值作为观测量,对INS误差进行估计和补偿.Kalman滤波的方法广泛地应用于惯导系统的误差修正初始对准.本文研究了当地水平惯导系统的的误差估计和补偿问题.分析结果表明,采用Kalman滤波的方法,可以精确地估计惯导系统的误差(包括陀螺漂移和加速度计零偏),误差估计的精度高,并且估计的方差阵收敛快.
简介:制导炮弹控制系统要求炮弹飞行姿态测量信息具有良好的准确性和实时性。为解决制导炮弹飞行姿态的高精度滤波估计问题,根据外弹道攻角运动方程和MEMS角速度陀螺测量方程分别建立姿态角滤波系统状态模型和量测模型。考虑实际陀螺随机白噪声的影响,结合弹载全球定位系统信息及地面弹道试验数据,并利用非线性卡尔曼滤波估计方法,对制导炮弹飞行姿态进行了滤波估计。为提高滤波估计效率,对比了Unscented卡尔曼滤波和一种混合卡尔曼滤波两种非线性滤波估计方法,滤波估计结果表明两种方法得到的姿态精度均能满足测量要求,而运算效率后者相对前者可提高约6%,稳定性也较好,因此在工程上更实用。
简介:传递对准是机载主惯导对子惯导进行初始化的过程,机翼变形对快速传递对准滤波精度有显著影响.讨论了传递对准中机翼变形的不同估计方法,通过分析建模过程比较了各种方法的特点及其适用范围.然后建立快速传递对准仿真环境,用“速度加姿态”匹配方式进行仿真,比较了不同方法所能达到的精度.最终从对准精度、快速性、模型依赖度、计算量等方面,对各种传递对准中机翼弹性变形的处理方法进行了比较总结,结果表明,将弹性变形当作有色噪声且使用卡尔曼滤波量测扩增法进行传递对准滤波器设计时,在估计精度和计算量方面达到最好折衷.所得结论为快速传递对准弹性变形的处理提供了工程应用参考.
简介:采用卡尔曼滤波方法进行动基座对准过程中,载体挠曲运动等因素会导致系统噪声、量测噪声的不确定性,即系统参数的不确定性。将多模型估计理论应用于捷联系统动基座对准过程中,可以有效抑制系统不确定性因素的影响。建立了捷联惯导系统误差模型和引入外部位置、速度信息的量测模型,针对对准过程中系统噪声和量测噪声不确定的情况建立了多模型自适应估计器。在同等条件下进行了单一模型对准和利用多模型估计理论进行对准的仿真比较,结果显示:基于多模型估计的对准完成后捷联系统具有更高的导航精度;由此说明,动基座对准过程中,系统参数不确定的情况下,多模型估计器有更好的适用性。
简介:针对多飞行器协同拦截机动目标过程中的目标状态估计问题,提出了一种多飞行器对目标加速度的一致性协同估计方法。构建了多飞行器分布式协同估计结构,将扩张状态观测器和一致性理论相结合,设计了分布式协同一致性估计器。利用扩张状态观测器对目标状态进行估计,在此基础上利用一致性理论为各飞行器设计协调控制量,通过局部信息交换使得各飞行器得到一致的估计值,实现对目标加速度的精确估计。利用稳定性判定理论对一致性估计器的误差和收敛性能进行了分析,并将设计的一致性协同估计方法应用到协同拦截系统中进行了仿真验证。仿真结果显示,在不同的目标机动形式下,对目标加速度估计误差始终小于0.5m/s2,因此设计的一致性估计方法能够实现对目标加速度的精确估计,且具有较强的鲁棒性。
简介:针对CNS/INS组合导航系统中缩短初始对准时间的问题,设计了一种CNS/INS组合导航系统组合对准新方法。在CNS/INS姿态四元数组合算法的基础上,推导CNS/INS组合系统线性化状态方程,分析了INS和CNS姿态四元数差值构建量测方程。利用递推最小二乘原理实现了对该组合系统的信息融合,设计了基于该估计原理的组合导航系统初始对准方法,考虑到大气层内动基座条件下对于星敏感器造成的干扰因素增加了加权处理环节,最后通过仿真实验验证了递推加权最小二乘法在处理组合导航系统初始对准中的有效性。仿真结果表明在微晃基座条件下,与传统的滤波方法相比较该估计方法能够有效地缩短约25%的对准时间。
简介:针对1点RANSAC(RandomSampleConsensus)单目视觉EKF(ExtendedKalmanFilter)算法中的滤波发散问题,分析了滤波发散的产生原因,提出了一种基于渐消记忆滤波的1点RANSAC单目视觉姿态估计算法。该算法通过在EKF滤波方程中引入加权因子,逐渐加大当前数据的权重,相应地减少旧数据的权重,有效地扼制了算法中的滤波发散问题。最后通过两组验证性实验验证说明了算法的有效性。实验结果表明:该算法能够有效地解决1点RANSAC单目视觉EKF算法中的滤波发散问题,具有更高的精度。第一组双轴联动实验,航向角的平均误差减小2.4158?,俯仰角平均误差减小0.1782?;第二组偏航轴大角度转动实验,摄像机航向角的估计误差一直保持在1.5?以内。
简介:基于Sigma-deltaModulator(Σ△M)原理的数字闭环微机械加速度计不仅实现了力反馈闭环控制,同时直接完成信号的模数转换。基于全差分式电容微加速度设计了一种2-2级联式(MASH)高阶Σ△M闭环系统——MASH_(2-2),并与传统的单环路二阶、四阶Σ△M闭环系统(SD2、SD4)进行了仿真分析比较,研制了原理样机。微加速度计是基于结构层厚度50mm的SOI硅片通过DRIE刻蚀、气态HF释放等一系列微加工工艺得到,系统电路以数字化方式集成在FPGA中。常压下测试结果表明,样机的灵敏度为0.876V/g,噪声基底为-110dB,零偏不稳定性为20mg,静态温漂为40.8mg/℃,量程为±20g。
简介:在双轴旋转式SINS中,惯性元件常值漂移误差对系统的影响可以得到调制,但安装误差和标度因数误差对系统的影响无法得到调制,同时这些误差会与旋转角速率耦合,引起速度锯齿波等误差从而降低了系统的各项性能指标。为了减少这种影响,分析了光学陀螺双轴旋转式SINS误差传播特性,利用奇异值分解法对系统的可观测程度进行了分析,经分析,与转动轴相关的安装误差和标度因数误差的可观测度较好,据此设计了系统的自主标定方案及滤波算法,进行了数字仿真和半实物仿真验证试验。试验结果表明,利用设计的自主标定方案,在1h内能估计出转轴上两个陀螺的标度因数误差及与转轴相关的四个安装误差,估计精度能达到95%以上。导航试验验证表明,利用自主标定的参数,相对于传统标定方法,使系统定位精度提高了20%。
简介:为了实际实现具有良好跟踪精度和抗干扰能力的惯性平台稳定回路,建立了平台伺服电机的离散时间模型,设计了由单片机和高速DSP组成的数字控制系统,与惯性平台组成了基于采样数据的平台稳定控制回路,研究了离散变结构控制趋近律的选取方法,采用改进趋近律设计了离散变结构控制律,提出了一种数字式平台稳定回路的离散变结构控制方法,通过实物实验得出了平台伺服电机转轴摩擦力矩模型系数的估计值,并将其引入到控制系统中。仿真实验结果表明,该回路系统对于摩擦力矩和系统参数不确定性具有一定的抗干扰性能,对于阶跃干扰力矩输入具有良好的动态特性,且静态力矩刚度提高到1.2×10^4N·m/rad,系统对于斜坡和加速度输入信号实现了平稳跟踪,跟踪误差最大值分别为0.0056rad和0.0597rad。
简介:提出了一种基于期望模式修正(EMA)的改进交互式多模型(IMM)算法。该算法主要解决自主水下航行器(AUV)复杂工作环境下量测噪声统计特性未知或易发生变化时的状态估计问题,其核心思想是将期望模式修正机制和交互式多模型滤波算法相结合,利用状态估计过程中的获取的模型概率进行决策,得到更加接近与系统真实模式的期望模型集合,再通过期望模型集合滤波结果对固定模型集合滤波结果进行修正。与传统的交互式多模型算法相比,提出的基于期望模式修正的交互式多模型算法可以捕捉到系统模式更细微的变化。仿真结果表明,该算法可以大幅提高AUV组合导航系统的估计精度和稳定性。
简介:为实现多枚导弹协同攻击机动目标,基于具有推力可控能力的导弹,提出了一种带落角约束的多导弹分布式协同制导律。将制导律的设计分离为视线方向和视线法向上两个部分:视线方向上基于多智能体协同控制理论和超螺旋控制算法,设计制导律控制导弹剩余时间在有限时间内趋于一致;视线法向上运用零化视线角速率思想和有限时间滑模控制理论,设计制导律控制导弹击中目标的同时满足落角约束。并针对两部分制导律中存在的目标机动信息,分别设计非齐次干扰观测器进行估计。仿真结果表明,提出的制导律能够有效完成协同攻击任务,脱靶量和落角误差分别控制在0.13m和0.02°以内,并且有效抑制了抖振现象,有利于提高导弹自动驾驶仪的跟踪精度。