基于改进A*算法的UUV冰下避障航迹规划算法

针对冰下避障航迹规划问题,提出了一种基于改进A*算法的三维冰下避障航迹规划算法.不同于传统的A*航迹规划算法,该算法结合了人工势场航迹规划算法的思想,将水下地形碰撞约束、海冰碰撞约束以及UUV巡航高度约束重新编排.算法分析表明,该避障航迹规划算法能够有效增强UUV冰下避障能力与定深巡航高度控制能力.基于改进的A*冰下避障航迹规划算法,给出了上述约束的设计方法并进行了仿真验证.仿真结果表明,基于上述约束的航迹规划算法具有良好的避障能力、巡航高度控制能力以及航行距离控制能力.     

极区横向地理系空间稳定型惯导算法研究

针对地心惯性系和当地地理系的空间稳定型惯导系统导航算法在极区导航失效的问题,提出了适用于空间稳定型惯导系统的极区导航算法。该算法通过伪经纬网构建了横坐标系参考框架,建立了横向地理系空间稳定型惯导系统力学编排,并在此基础上重新推导了通用的误差模型。最后,通过极点附近区域与穿越极点区域仿真分析了算法的极区有效性。仿真结果表明该算法在极点附近区域解算的伪航向角误差小于3′,伪经度误差小于4′;在穿越极点区域解算的伪纵摇角、伪横摇角误差小于0.3′,伪航向角误差小于3′,伪东向、伪北向速度误差小于1m/s,伪经度、伪纬度误差小于4.2′。该算法克服了极区导航计算溢出、误差放大等问题,提高了系统的极区导航精度,能够满足极区导航要求。