简介:针对风场对临近空间伪卫星导航精度影响的问题,提出伪卫星抗风场干扰自主导航算法,以提高伪卫星的导航精度。首先,将风场模型加入伪卫星SINS/CNS/SAR组合导航的量测模型中,建立风场干扰下的SINS/CNS/SAR组合导航系统模型;然后,设计自适应UPF非线性滤波算法,将该算法用于SINS/CNS/SAR组合导航解算中,分别在考虑风场干扰和不考虑风场干扰的情况下,利用UKF、UPF和自适应UPF算法对临近空间伪卫星组合导航系统误差进行估计。仿真结果表明,在考虑风场干扰的条件下,提出的自适应UPF算法在东向、北向和天向的速度误差均控制在±0.21m/s以内,误差大小分别是现有的UKF和UPF的1/5和1/3。该算法能有效抑制风场对导航解算精度的影响,提高伪卫星的定位精度。
简介:基于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。
简介:针对自由漂浮状态下的空间机械臂系统,研究了基座姿态扰动最小的轨迹规划问题。首先通过正弦函数参数化机械臂各个关节,在机械臂关节角速度、角加速度以及基座姿态变化范围受限的约束条件下,定义了基座姿态扰动最小的目标函数,然后提出了基于混沌粒子群算法的轨迹优化策略,并给出了具体求解步骤。数值算例结果表明,在满足系统的约束条件下,机械臂关节变化平缓,不存在角速度突变的情况,并且比标准粒子群算法具有更快的收敛速度,在优化轨迹下进行运动仿真,结果表明终止时刻基座姿态扰动为1.3708°(三轴合成),而梯形规划的姿态扰动为8.5459°,优化后使得姿态的扰动减小84%,从而说明所提出的算法能够有效减小机械臂运动对基座姿态的扰动。
简介:基于Krein空间的鲁棒Kalman滤波器与通过其它方法建立的鲁棒Kalman滤波器相比有较高稳态精度。文中将基于Krein空间的鲁棒Kalman滤波方法用于导弹捷联惯导系统动基座传递对准,并与标准Kalman滤波进行了比较。仿真结果表明,在垂直比力参数存在摄动的情况下,如果基于Krein空间的鲁棒Kalman滤波器的参数选取适当,它的精度鲁棒性优于标准Kalman滤波。
简介:在双轴旋转式SINS中,惯性元件常值漂移误差对系统的影响可以得到调制,但安装误差和标度因数误差对系统的影响无法得到调制,同时这些误差会与旋转角速率耦合,引起速度锯齿波等误差从而降低了系统的各项性能指标。为了减少这种影响,分析了光学陀螺双轴旋转式SINS误差传播特性,利用奇异值分解法对系统的可观测程度进行了分析,经分析,与转动轴相关的安装误差和标度因数误差的可观测度较好,据此设计了系统的自主标定方案及滤波算法,进行了数字仿真和半实物仿真验证试验。试验结果表明,利用设计的自主标定方案,在1h内能估计出转轴上两个陀螺的标度因数误差及与转轴相关的四个安装误差,估计精度能达到95%以上。导航试验验证表明,利用自主标定的参数,相对于传统标定方法,使系统定位精度提高了20%。
简介:为了实际实现具有良好跟踪精度和抗干扰能力的惯性平台稳定回路,建立了平台伺服电机的离散时间模型,设计了由单片机和高速DSP组成的数字控制系统,与惯性平台组成了基于采样数据的平台稳定控制回路,研究了离散变结构控制趋近律的选取方法,采用改进趋近律设计了离散变结构控制律,提出了一种数字式平台稳定回路的离散变结构控制方法,通过实物实验得出了平台伺服电机转轴摩擦力矩模型系数的估计值,并将其引入到控制系统中。仿真实验结果表明,该回路系统对于摩擦力矩和系统参数不确定性具有一定的抗干扰性能,对于阶跃干扰力矩输入具有良好的动态特性,且静态力矩刚度提高到1.2×10^4N·m/rad,系统对于斜坡和加速度输入信号实现了平稳跟踪,跟踪误差最大值分别为0.0056rad和0.0597rad。
简介:提出了一种基于期望模式修正(EMA)的改进交互式多模型(IMM)算法。该算法主要解决自主水下航行器(AUV)复杂工作环境下量测噪声统计特性未知或易发生变化时的状态估计问题,其核心思想是将期望模式修正机制和交互式多模型滤波算法相结合,利用状态估计过程中的获取的模型概率进行决策,得到更加接近与系统真实模式的期望模型集合,再通过期望模型集合滤波结果对固定模型集合滤波结果进行修正。与传统的交互式多模型算法相比,提出的基于期望模式修正的交互式多模型算法可以捕捉到系统模式更细微的变化。仿真结果表明,该算法可以大幅提高AUV组合导航系统的估计精度和稳定性。
简介:为实现多枚导弹协同攻击机动目标,基于具有推力可控能力的导弹,提出了一种带落角约束的多导弹分布式协同制导律。将制导律的设计分离为视线方向和视线法向上两个部分:视线方向上基于多智能体协同控制理论和超螺旋控制算法,设计制导律控制导弹剩余时间在有限时间内趋于一致;视线法向上运用零化视线角速率思想和有限时间滑模控制理论,设计制导律控制导弹击中目标的同时满足落角约束。并针对两部分制导律中存在的目标机动信息,分别设计非齐次干扰观测器进行估计。仿真结果表明,提出的制导律能够有效完成协同攻击任务,脱靶量和落角误差分别控制在0.13m和0.02°以内,并且有效抑制了抖振现象,有利于提高导弹自动驾驶仪的跟踪精度。