简介:为了实现某型导弹小姿态惯性导航平台射前自标定,分析并建立了精确实用的小姿态导航平台静态误差模型,设计了转动控制与测漂电路,充分利用射向条件和平台稳定性,实现导航平台在全装弹状态下自动转动、锁定和测漂,并以加速度计和陀螺输出作为开环观测量,结合误差模型分离出各误差系数。通过对各种误差进行综合仿真分析,得到标定系数的相对误差不超过4%,其标定时间缩短为借助转台标定所需时间的40,满足了射前标定的精确性和快速性要求。方案在不改变现有装备的情况下,控制平台按照预设轨迹小角度旋转两次,仅分别在三个预设位置同时对三个陀螺进行测漂标定,适合实际导弹发射。
简介:为了提高非线性卫星姿态控制系统的滤波性能,在建立了采用磁强计及太阳敏感器的卫星姿态模型的基础上尝试了新兴的粒子滤波(PF)算法对卫星系统进行姿态估计,进而对采用矢量观测的三轴稳定卫星的姿态确定问题进行了滤波算法的实时仿真,并将四元数转换成旋转矢量引入了粒子滤波算法,最后给出了卫星模型在不同粒子数目下的滤波性能比较,并在系统初始误差较大的情况下将粒子滤波算法与EKF滤波算法进行了滤波性能的对照。仿真结果表明,粒子滤波算法对粒子数目具有明显的依赖性,但是当粒子达到一定的数目时,粒子滤波的精度以及滤波稳定性都可以得到保证,尤其是在系统初始误差较大的情况下粒子滤波算法更显示了其优于EKF算法的滤波性能。
简介:水平姿态误差标定是提高测量船惯性导航系统精度的重要手段。传统的水平精度标定一般只能在实验室或坞内等静态条件下通过高精度水平仪来实现。针对动态条件下水平作差、平台旋转及经纬仪方位俯仰信息联立求解等标定方法存在标定条件苛刻、精度相对较低等局限性,提出了一种基于星体测量的惯导水平姿态标定新技术——俯仰脱靶量求解法,推导了计算公式,并对解算精度进行了系统分析。通过惯导精度鉴定及某次试验任务的检验,其解算精度在5.8″以内,具有较高的置信度。该方法解决了惯导水平姿态动态条件下标定的技术难题,为提高惯导水平姿态精度、实战数据的事后处理以及动态条件下加速度计零位标定提供了依据,对提高航天测量船总体测量精度具有重要意义。
简介:制导炮弹控制系统要求炮弹飞行姿态测量信息具有良好的准确性和实时性。为解决制导炮弹飞行姿态的高精度滤波估计问题,根据外弹道攻角运动方程和MEMS角速度陀螺测量方程分别建立姿态角滤波系统状态模型和量测模型。考虑实际陀螺随机白噪声的影响,结合弹载全球定位系统信息及地面弹道试验数据,并利用非线性卡尔曼滤波估计方法,对制导炮弹飞行姿态进行了滤波估计。为提高滤波估计效率,对比了Unscented卡尔曼滤波和一种混合卡尔曼滤波两种非线性滤波估计方法,滤波估计结果表明两种方法得到的姿态精度均能满足测量要求,而运算效率后者相对前者可提高约6%,稳定性也较好,因此在工程上更实用。
简介:圆锥误差和量化误差是激光捷联惯性导航系统姿态解算误差的两个最主要的误差源.从分析圆锥误差产生的机理出发,分别分析了以角度和角速度为计算参数的圆锥误差补偿算法,并对量化误差对圆锥误差补偿算法的影响进行了研究.通过理论分析和数字仿真,得出在实际工程应用中,采用角速度为输入信息的激光捷联惯性导航系统姿态算法应该在考虑量化误差的情况下,采用以角速度为计算参数的圆锥误差补偿算法.
简介:针对无陀螺或陀螺失效等情况下的飞行器姿态确定问题,基于无冗余姿态描述形式修正Rodrigues参数,提出了仅利用星敏感器矢量观测信息来确定飞行器姿态的UPF(UnscentedParticleFilter)算法。UPF利用UKF(UnscentedKalmanFilter)得到粒子滤波的重要性密度函数,从而克服了标准的粒子滤波没有考虑最新量测信息和UKF只能应用于噪声为高斯分布的不足。修正Rodrigues参数描述飞行器姿态具有简洁高效的特点,通过切换方法避免了奇异性现象。仿真结果表明,该姿态确定算法可以取得比UKF更快的滤波收敛性和更高的滤波精度,并且比四元数算法计算效率提高近10%。
简介:针对声矢量传感器姿态变化难以准确测量导致目标测向精度低的现状,设计一种微型MEMS姿态传感器,并将其封装在声矢量传感器内部,实现基于MEMS姿态传感器的声矢量传感器设计。首先根据声矢量传感器姿态测量与校正原理,采用四元数姿态解算方法及扩展卡尔曼滤波器设计MEMS姿态传感器,并对其进行姿态精度测试;然后基于MEMS姿态传感器进行声矢量传感器样机设计、制作、参数测试;最后对样机进行了海上实验,结果表明,通过姿态校正后声矢量传感器目标方位估计精度与GPS推算方位精度一致,验证了利用MEMS姿态传感器设计声矢量传感器的可行性。
简介:针对带有末端多约束的三维非线性制导问题,设计了一种通用模型预测静态规划制导算法。该制导算法通过向后迭代求解权矩阵微分方程对控制量进行更新,将动态优化问题转化为静态优化问题,计算效率得以提高。阐述了通用模型预测静态规划制导算法的基本原理,详细给出了基于通用模型预测静态规划算法的制导律设计过程。所设计的制导律满足末端法向加速度约束,因此,间接满足末端弹体姿态角约束。仿真时考虑目标的机动方式和落角约束,仿真结果表明,末端位移偏差小于0.5m,末端落角可控制在0.01°范围内,末端法向加速度小于0.01m/s^2,该制导律能够很好地满足末端位移、落角和法向加速度约束。
简介:针对舰载条件的捷联惯导粗对准问题,提出了一种简单可行的最优粗对准方法。根据双矢量定姿的原理,分别将两个观测矢量之一作为基准,通过两次三轴姿态测定算法得到两个姿态矩阵,然后根据观测矢量的方差特性加权得到精度最优的姿态阵。阐述了三轴姿态测定算法的基本原理,分析了最优三轴姿态测定算法与基于高斯马尔科夫估计的三轴姿态测定算法的统一性,解析了基于最优三轴姿态测定算法的舰载惯导系统粗对准方案,并对传统三轴姿态测定算法和最优三轴姿态测定算法进行了应用比较。蒙特卡洛50个样本的仿真结果表明,采用最优三轴姿态测定算法明显优于传统三轴姿态测定算法,可使得东向、北向和天向姿态误差角均值分别为4.78??,9.21?和0.29?,标准差分别为0.11?,0.07?和1.08?,水平失准角最大值9.37?,方位失准角最大值2.8?,能够有效确定出载体的粗略姿态,在此基础上能更好实现该状态下的舰载惯导精对准。