CN119535359A 基于贝叶斯反演的水下融合定位方法 (哈尔滨工业大学(威海))_第1页
CN119535359A 基于贝叶斯反演的水下融合定位方法 (哈尔滨工业大学(威海))_第2页
CN119535359A 基于贝叶斯反演的水下融合定位方法 (哈尔滨工业大学(威海))_第3页
CN119535359A 基于贝叶斯反演的水下融合定位方法 (哈尔滨工业大学(威海))_第4页
CN119535359A 基于贝叶斯反演的水下融合定位方法 (哈尔滨工业大学(威海))_第5页
已阅读5页,还剩23页未读, 继续免费阅读

下载本文档

版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领

文档简介

一种能够有效提高定位精度的基于贝叶斯反演CTD得到的海水温度和海水盐度,进而得到海水中的实时声速信息;利用长基线LBL的四个应答器得到的时延信息结合上一步得到的声速信息和深度信息,反演出AUV的三维位置信息;利用系统INS得到的位置信息与LBL得到的位置信息的差值和惯性导航系统INS的速度信息与DVL得2步骤2:利用长基线LBL的四个应答器得到的时延信息步骤3:利用多普勒测速仪DVL测得AUV的速度信息;利步骤4:将惯性导航系统INS得到的位置信息与长基线LBL得到的位置信息的差值和惯ii3步骤2_2:将四个应答器的坐标和AUV深度信息作为背其中posn是步骤二得到的AUV三维位置,posLBL是经过坐标变换后得到的AUV三维位LBL4步骤4_1:将INS的位置与LBL位置的差值和INS速度与DVL测INSv2步骤4_2:将EKF预测前后的状态向量间的关系式其中,是k_1时刻X的估计值,是利用k_1的状态矩阵推算k时刻的X,是5INS分别为步骤三中利用INS得到的AUV北向、东向和天向的位置信息,6[0002]水下定位是提供自主水下机器人(AutonomousUnderwaterVehicle,AUV)的姿[0003]目前在水下航行时常用的定位方法主要有惯性导航系统(InertialNavigation方法结合扩展卡尔曼滤波算法(ExtendedKalmanFilter,EKF)等来实现单个传感器节点定量预测,进而为精细的油气勘探开发提供可靠支持;在中国专利申请号为7[0012]步骤4:将惯性导航系统INS得到的位置信息与长基线LBL得到的位置信息的差值和惯性导航系统INS的速度信息与多普勒测速仪DVL得到的速度信息的差值作为观测数据,[0017]模型参数为是AUV在载体坐标系下的二维位置信息,得到观测信息8R=再,息z=zDG,di为第i个应答器与AUV之间的距离,且c为水下声是AUV发送声波到接收到第i个应答器声波之间的时间差;[0024]本发明步骤3在经步骤2得到AUV的三维位置后,经过坐标变换后得到在导航坐标LBLc:为载体坐标系与导航坐标系之间的转换矩阵。[0028]本发明步骤3中由DVL得到的二维速度信息和深度计的微分得到的z轴速度信息得9"、"、"分别为x轴、y轴、z轴速度,《"、"、"分别为北向轴、东向、天向速v2盐度(S胤,千分比数)和深度h(m)数据结合声速经验模型,可以得到海水中的实时声速信[0058](2)利用LBL的四个应答器得到的时延信息结合上一步得到的声速信息和深度信[0062]模型参数为是AUV在载体坐标系下的二维位置信息。得到观测信息R,=,再i=1,2,3,4。(x,y,z)是AUV三维位置信息,且由第一步得到A息z=zDG。di为第i个应答器与AUV之间的距离,且c为水下声是AUV发送声波到接收到第i个应答器声波之间的时间差。[0065]然后将四个应答器的坐标和AUV深度信息作为背景信息,实现“时延—距离—坐[0069]由上述步骤可以得到AUV的三维位置,且经过坐标变换后得到在导航坐标系下的LBLc:为载体坐标系与导航坐标系之间的转换矩阵。[0074]由DVL得到的二维速度信息和深度计的微分得到的z轴速度信息可以得到AUV的三"、"、"分别为x轴、y轴、z轴速度,"、"、"分别为北向轴、东向、天向速度。[0078](4)将INS得到的位置信息与LBL得到的位置信息的差值和INS的速度信息与DVL得到的速度信息的差值作为EKF的观测数据,然后进行贝叶斯反演,最终得到目标的位置信v2[0086]然后将EKF预测前后的状态向量间的关系式作为正演模型,在此基础上进行贝叶

温馨提示

  • 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
  • 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
  • 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
  • 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
  • 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
  • 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
  • 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。

评论

0/150

提交评论