简介:为了提高非线性卫星姿态控制系统的滤波性能,在建立了采用磁强计及太阳敏感器的卫星姿态模型的基础上尝试了新兴的粒子滤波(PF)算法对卫星系统进行姿态估计,进而对采用矢量观测的三轴稳定卫星的姿态确定问题进行了滤波算法的实时仿真,并将四元数转换成旋转矢量引入了粒子滤波算法,最后给出了卫星模型在不同粒子数目下的滤波性能比较,并在系统初始误差较大的情况下将粒子滤波算法与EKF滤波算法进行了滤波性能的对照。仿真结果表明,粒子滤波算法对粒子数目具有明显的依赖性,但是当粒子达到一定的数目时,粒子滤波的精度以及滤波稳定性都可以得到保证,尤其是在系统初始误差较大的情况下粒子滤波算法更显示了其优于EKF算法的滤波性能。
简介:针对无陀螺或陀螺失效等情况下的飞行器姿态确定问题,基于无冗余姿态描述形式修正Rodrigues参数,提出了仅利用星敏感器矢量观测信息来确定飞行器姿态的UPF(UnscentedParticleFilter)算法。UPF利用UKF(UnscentedKalmanFilter)得到粒子滤波的重要性密度函数,从而克服了标准的粒子滤波没有考虑最新量测信息和UKF只能应用于噪声为高斯分布的不足。修正Rodrigues参数描述飞行器姿态具有简洁高效的特点,通过切换方法避免了奇异性现象。仿真结果表明,该姿态确定算法可以取得比UKF更快的滤波收敛性和更高的滤波精度,并且比四元数算法计算效率提高近10%。
简介:惯性平台安装在舰船的过程中需要将惯性平台坐标系与舰船坐标系进行对准,也就是对惯性平台进行标校。当舰船在倾斜船台上进行建造时,由船台的倾斜角度造成水平测量仪器的测量误差对标校的结果有很大影响,尤其是在测量舰船横摇角时,会由于测量仪器的摆放带来误差。船台的倾斜角度为3°时,边长为100mm的水平测量仪器在测量横摇角时产生0.1°的测量方位误差(即水平测量仪器一端产生0.17mm位移),就会带来18.8″的测量误差。这对于高精度惯性平台的标校是不允许的。文中对在各种不同舰船姿态下,由测量仪器的摆放带来的误差进行了分析归纳。利用双自由度电子水平仪、高精度转台及TM5100A自准直经纬仪,对由于安装面倾斜带来的测量误差进行了验证试验。实验结果与计算结果吻合。
简介:水平姿态误差标定是提高测量船惯性导航系统精度的重要手段。传统的水平精度标定一般只能在实验室或坞内等静态条件下通过高精度水平仪来实现。针对动态条件下水平作差、平台旋转及经纬仪方位俯仰信息联立求解等标定方法存在标定条件苛刻、精度相对较低等局限性,提出了一种基于星体测量的惯导水平姿态标定新技术——俯仰脱靶量求解法,推导了计算公式,并对解算精度进行了系统分析。通过惯导精度鉴定及某次试验任务的检验,其解算精度在5.8″以内,具有较高的置信度。该方法解决了惯导水平姿态动态条件下标定的技术难题,为提高惯导水平姿态精度、实战数据的事后处理以及动态条件下加速度计零位标定提供了依据,对提高航天测量船总体测量精度具有重要意义。
简介:以小型无人机航姿测量系统的微小型化为背景,利用MEMS惯性测量元件研制了一种低成本微型航姿测量系统。针对MEMS器件用于载体航姿测量时精度低、易发散的问题,提出一种计算量小、实时性强的加速度信息、磁场强度信息、陀螺信息的融合方法。采用卡尔曼滤波器对系统的俯仰角、滚转角和航向角的误差进行最优估计;设计数据融合的判别准则,并根据判据的判断结果调整卡尔曼滤波器中的量测信息,使系统可用于小型无人机的定高自主飞行。实验结果表明,系统输出航姿的更新频率可达100Hz,航姿测量误差小于0.6°,航姿标准差小于0.09°;将其应用于某小型固定翼飞行器的飞行控制系统中进行自主飞行实验,完成了预定的飞行任务。
简介:利用单频GPS载波相位差分技术进行动态精密测量时,由于观测历元少,经典LAMBDA算法会出现法矩阵病态导致整周模糊度无法求解。针对这一问题研究了基于TIKHONOV正则化原理的改进LAMBDA算法。通过对双差观测方程系数矩阵进行奇异值分解选取正则化矩阵,改善了法矩阵的病态性,获得了更高精度的浮点解。利用均方误差矩阵替代协方差阵进行LAMBDA求解,提高了模糊度求解的速度和成功率。对连续100组5个历元实测数据计算表明:与原算法相比,改进LAMBDA算法求得的浮点模糊度偏差从36.48周减小到4.08周,搜索效率和成功率分别改进97.74%和100%。