一种基于改进蚁群算法的地磁匹配导航算法

本发明公开了一种基于改进蚁群算法的地磁匹配导航算法，属于地磁导航、控制和制导领域。该算法的实现包括以下几个步骤：获取初始位置信息，地磁传感器检测数据的磁测量值，解算磁航向角；蚁群算法参数初始化；把蚂蚁放到初始位置，根据状态转移概率公式转移到下一个节点，直到达到磁测量序列；计算并记录每只蚂蚁的全局相似性度量函数，并更新信息素；达到最大迭代次数时，输出最优蚂蚁路径，即可得到最优地磁导航轨迹。本发明利用蚁群算法的搜索的随机性和正反馈行为，实现向最优解的靠近，通过这种算法求得最优航迹，实现了地磁导航匹配精度的提升。