位置更新算法
载体的位置常用大地坐标(纬度、经度和椭球高h)来表示。位置随时间的变化可用一组微分方程来描述:
上述微分方程的物理含义解释:
纬度微分/纬度变化,是载体向北跑所引起的;经度微分/经度变化,是载体向东跑引起的;前两各均为正方向;而高程变化,由于我们认为北东地为正方向,高程总是向上的,因此这里要取负号
位置更新就是求解上述微分方程组
惯性导航算法总结
导航状态的时间传递
1.主要研究姿态、速度、位置的微分方程(连续时间)。
2.注意区分是从哪个坐标系中观察的,这与投影到哪个坐标系不同
惯导更新算法
1.主要研究的是姿态、速度、位置的微分方程做离散化时的问题
2.更新算法应保证算法误差远小于惯性传感器带来的误差。系统设计时要针对被测载体的动态水平,平衡好数据更新率和更新算法的精度