买专利卖专利找龙图腾,真高效! 查专利查商标用IPTOP,全免费!专利年费监控用IP管家,真方便!
摘要:本发明公开了一种SINSDVL组合导航无纬度初始对准方法及装置,获取N时刻的状态估计量,根据状态估计量确定重构观测矢量根据N时刻的重构观测矢量和N2时刻的重构观测矢量计算初始载体坐标系中的重力矢量gb0在N2时刻到N时刻的积分以及初始载体坐标系中的重力矢量gb0在0到N2时刻的积分基于和确定N时刻的纬度估计值;根据纬度估计值生成N时刻载体坐标系和导航坐标系的方向余弦矩阵;本发明推导了惯性系观测矢量与纬度之间的数学关系,实现纬度的高精度估计,利用估计出的纬度信息推导参考矢量,并设计鲁棒滤波有效剔除观测矢量中的野值误差,结合纬度估计过程的中间时刻矢量信息,消除DVL初始速度误差对对准过程的影响。
主权项:1.一种SINSDVL组合导航无纬度初始对准方法,其特征在于,包括以下步骤:获取N时刻的状态估计量,根据所述状态估计量确定重构观测矢量根据N时刻的重构观测矢量和N2时刻的重构观测矢量计算初始载体坐标系中的重力矢量gb0在N2时刻到N时刻的积分以及初始载体坐标系中的重力矢量gb0在0到N2时刻的积分基于和确定N时刻的纬度估计值;根据所述纬度估计值生成N时刻载体坐标系和导航坐标系的方向余弦矩阵。
全文数据:
权利要求:
百度查询: 西北工业大学 西北工业大学深圳研究院 一种SINS/DVL组合导航无纬度初始对准方法
免责声明
1、本报告根据公开、合法渠道获得相关数据和信息,力求客观、公正,但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解,仅供参考使用,不能作为本公司承担任何法律责任的依据或者凭证。