一种发射坐标系下微型自寻的导弹捷联导航方法

摘要

本发明提供的一种发射坐标系下微型自寻的导弹捷联导航方法包括：建立地理坐标系、载体坐标系、发射坐标系；计算初始姿态矩阵和四元数，建立捷联导航算法的初始状态；实时测量角速率和比力；更新地理坐标系下的姿态，并通过坐标转换矩阵，得到发射坐标系下的姿态；更新地理坐标系下的速度和位置，并通过坐标转换矩阵，得到发射坐标系下的速度和位置。本发明基于成熟的地理坐标系作为导航坐标系，计算公式不需要重新推导，大大降低了人力成本，仅需要在此基础上，通过坐标转换矩阵，将地理坐标系下的姿态、速度、位置转换到发射坐标系下的姿态、速度和位置。