申请/专利权人：东南大学

申请日：2020-11-25

公开（公告）日：2024-03-15

公开（公告）号：CN112504298B

主分类号：G01C25/00

分类号：G01C25/00

优先权：

专利状态码：有效-授权

法律状态：2024.03.15#授权;2021.04.02#实质审查的生效;2021.03.16#公开

摘要：本发明公开了一种GNSS辅助的DVL误差标定方法，具体包括以下步骤：采集实验数据，包括SINSGNSS组合导航系统输出的和载体姿态角，以及DVL输出的并利用载体姿态将转换至载体坐标系b下，得选取安装偏角误差和刻度因子误差ζ为状态量，建立Kalman滤波状态方程并离散化；利用k‑1时刻反馈修正得到的安装偏角转换矩阵将k时刻的转换至载体坐标系b下，得将k时刻的与的差值作为Kalman滤波的观测量，建立k时刻Kalman滤波量测方程；进行Kalman滤波；利用安装偏角误差估计反馈修正安装偏角转换矩阵并置零安装偏角误差估计；重复后4步，直至安装偏角转换矩阵和刻度因子误差都收敛到各自准确的量。本发明能够非常精确、快速、方便地标定出DVL任意大小的安装偏角以及刻度因子误差。

主权项：1.一种GNSS辅助的DVL误差标定方法，其特征在于，具体包括以下步骤：S1：采集实验数据，包括SINSGNSS组合导航系统输出的载体速度向量在导航坐标系n下的投影和载体姿态角，以及DVL输出的载体速度向量在DVL设备坐标系d下的投影并利用载体姿态将转换至载体坐标系b下，得所述步骤S1具体包括以下过程：S1.1采集实验数据，包括SINSGNSS组合导航系统输出的载体速度向量在导航坐标系n下的投影和载体姿态角，以及DVL输出的载体速度向量在DVL设备坐标系d下的投影S1.2利用载体姿态将SINSGNSS组合导航系统输出的载体速度向量在导航坐标系n下的投影转换至载体坐标系b下，得SINSGNSS组合导航系统输出的载体速度向量在载体坐标系b下的投影 其中，为k时刻导航坐标系n到载体坐标系b的坐标转换矩阵，由k时刻SINSGNSS组合导航系统输出的载体姿态角转换获得；为k时刻SINSGNSS组合导航系统输出的载体速度向量在导航坐标系n下的投影；为k时刻SINSGNSS组合导航系统输出的载体速度向量在载体坐标系b下的投影；S2：选取安装偏角误差和刻度因子误差ζ为状态量，建立Kalman滤波状态方程并离散化；所述步骤S2具体包括以下过程：S2.1选取常量安装偏角误差和刻度因子误差ζ为状态量，建立系统Kalman滤波状态方程： 其中，X为状态向量，为安装偏角误差向量，ζ为刻度因子误差标量；F为系统矩阵，F＝04×4；W为系统噪声向量；S2.2将状态方程离散化：Xk＝Φk,k-1Xk-1+Gk,k-1Wk-1其中，Xk为k时刻的状态向量；Φk,k-1为k-1时刻到k时刻的状态一步转移矩阵，Φk,k-1＝I4×4；Wk-1为k-1时刻的系统噪声向量，Gk,k-1为k-1时刻到k时刻的系统噪声输入矩阵；S3：利用k-1时刻反馈修正得到的安装偏角转换矩阵将k时刻的转换至载体坐标系b下，得DVL输出的载体速度向量在载体坐标系b下的投影所述步骤S3具体包括以下过程：利用k-1时刻反馈修正得到的安装偏角转换矩阵将k时刻DVL输出的载体速度向量在DVL设备坐标系d下的投影转换至载体坐标系b下，得DVL输出的载体速度向量在载体坐标系b下的投影 其中，为k时刻DVL输出的载体速度向量在DVL设备坐标系d下的投影；为k-1时刻反馈修正得到的安装偏角转换矩阵，表示载体坐标系b与k-1时刻估计DVL设备坐标系的转换关系；为k时刻DVL输出的载体速度向量在载体坐标系b下的投影；S4：将k时刻与的差作为Kalman滤波的观测量，建立k时刻Kalman滤波量测方程；S5：进行Kalman滤波；S6：利用安装偏角误差估计反馈修正安装偏角转换矩阵并置零安装偏角误差估计；S7：重复S3～S6，直至安装偏角转换矩阵和刻度因子误差都收敛到一个准确的值。

全文数据：

权利要求：

百度查询： 东南大学 一种GNSS辅助的DVL误差标定方法

免责声明
1、本报告根据公开、合法渠道获得相关数据和信息，力求客观、公正，但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解，仅供参考使用，不能作为本公司承担任何法律责任的依据或者凭证。

阅读全文 双屏查看 官方信息 专利公告 收藏专利 下载PDF 下载WORD