简介:为了实现水下潜器长时间高精度导航定位,同时考虑到传统地形辅助导航系统在先验地形图不可得或者是地形变化不明显的海域(地形不可匹配区域),无法用来修正惯性导航位置误差的问题,提出了一种结合地形和环境特征的水下导航定位方法。在先验地形图可得且地形高程变化明显的可匹配区域,采用地形辅助导航系统来修正惯导位置误差,在先验地形图不可得或者是地形高程变化不明显的不可匹配区域,采用基于海洋环境特征的同步定位与构图算法来修正惯导位置误差。仿真结果表明,该方法在地形可匹配区域以及地形不可匹配区域得到的航迹都比纯惯导得到的轨迹更接近于理想航迹,因此可以用来修正惯导位置误差。
简介:针对带有末端多约束的三维非线性制导问题,设计了一种通用模型预测静态规划制导算法。该制导算法通过向后迭代求解权矩阵微分方程对控制量进行更新,将动态优化问题转化为静态优化问题,计算效率得以提高。阐述了通用模型预测静态规划制导算法的基本原理,详细给出了基于通用模型预测静态规划算法的制导律设计过程。所设计的制导律满足末端法向加速度约束,因此,间接满足末端弹体姿态角约束。仿真时考虑目标的机动方式和落角约束,仿真结果表明,末端位移偏差小于0.5m,末端落角可控制在0.01°范围内,末端法向加速度小于0.01m/s^2,该制导律能够很好地满足末端位移、落角和法向加速度约束。
简介:针对惯导平台连续翻滚自标定中安装误差标定精度不高这一现状,提出了一种解决方案。通过对惯性器件的输出误差模型和安装误差的分析,建立了系统的姿态动力学方程和观测方程,利用输出灵敏度理论分析了系统的可观性,指出加速度计安装误差可观性较差是影响标定精度的主要原因。利用Kalman滤波中的估值方差矩阵计算了安装误差之间的相关系数,计算结果表明可观性差是由安装误差之间的线性相关性造成的,并确定了具体的不可观参数。以加速度计输入轴为基准建立平台坐标系可以减少安装误差项,使所有的安装误差的变得可观。最后的仿真结果表明在新的方案下,安装误差的估值偏差小于5",标定精度得到了显著提高。