简介:针对舰载条件的捷联惯导粗对准问题,提出了一种简单可行的最优粗对准方法。根据双矢量定姿的原理,分别将两个观测矢量之一作为基准,通过两次三轴姿态测定算法得到两个姿态矩阵,然后根据观测矢量的方差特性加权得到精度最优的姿态阵。阐述了三轴姿态测定算法的基本原理,分析了最优三轴姿态测定算法与基于高斯马尔科夫估计的三轴姿态测定算法的统一性,解析了基于最优三轴姿态测定算法的舰载惯导系统粗对准方案,并对传统三轴姿态测定算法和最优三轴姿态测定算法进行了应用比较。蒙特卡洛50个样本的仿真结果表明,采用最优三轴姿态测定算法明显优于传统三轴姿态测定算法,可使得东向、北向和天向姿态误差角均值分别为4.78??,9.21?和0.29?,标准差分别为0.11?,0.07?和1.08?,水平失准角最大值9.37?,方位失准角最大值2.8?,能够有效确定出载体的粗略姿态,在此基础上能更好实现该状态下的舰载惯导精对准。
简介:针对自由漂浮状态下的空间机械臂系统,研究了基座姿态扰动最小的轨迹规划问题。首先通过正弦函数参数化机械臂各个关节,在机械臂关节角速度、角加速度以及基座姿态变化范围受限的约束条件下,定义了基座姿态扰动最小的目标函数,然后提出了基于混沌粒子群算法的轨迹优化策略,并给出了具体求解步骤。数值算例结果表明,在满足系统的约束条件下,机械臂关节变化平缓,不存在角速度突变的情况,并且比标准粒子群算法具有更快的收敛速度,在优化轨迹下进行运动仿真,结果表明终止时刻基座姿态扰动为1.3708°(三轴合成),而梯形规划的姿态扰动为8.5459°,优化后使得姿态的扰动减小84%,从而说明所提出的算法能够有效减小机械臂运动对基座姿态的扰动。
简介:利用地球物理场进行辅助匹配导航是组合导航技术研究领域的新方向,该技术为水下潜器无源定位提供新的手段。迭代最近等值线算法作为重要的匹配导航算法之一,但存在实时性不强、搜索速度慢等缺点。考虑到以上两方面缺点,采用固定初始序列长度的方式对算法采样结构进行改善并推导出单点迭代公式,同时采用滑动窗搜索方式缩小搜索范围提高算法速度,最终实现实时ICCP算法设计。基于MATLAB平台下实现了实时ICCP算法重力匹配仿真系统,仿真系统采用0.4′×0.4′重力异常数据库。由仿真结果可以看出,该实时ICCP算法能够实现单点迭代,匹配结果能实时跟踪真实航迹且匹配精度能达到一个重力图网格。
简介:为了提高非线性卫星姿态控制系统的滤波性能,在建立了采用磁强计及太阳敏感器的卫星姿态模型的基础上尝试了新兴的粒子滤波(PF)算法对卫星系统进行姿态估计,进而对采用矢量观测的三轴稳定卫星的姿态确定问题进行了滤波算法的实时仿真,并将四元数转换成旋转矢量引入了粒子滤波算法,最后给出了卫星模型在不同粒子数目下的滤波性能比较,并在系统初始误差较大的情况下将粒子滤波算法与EKF滤波算法进行了滤波性能的对照。仿真结果表明,粒子滤波算法对粒子数目具有明显的依赖性,但是当粒子达到一定的数目时,粒子滤波的精度以及滤波稳定性都可以得到保证,尤其是在系统初始误差较大的情况下粒子滤波算法更显示了其优于EKF算法的滤波性能。