CN110806209A - 一种水下机器人多设备组合导航系统及方法 - Google Patents

一种水下机器人多设备组合导航系统及方法 Download PDF

Info

Publication number
CN110806209A
CN110806209A CN201911168095.7A CN201911168095A CN110806209A CN 110806209 A CN110806209 A CN 110806209A CN 201911168095 A CN201911168095 A CN 201911168095A CN 110806209 A CN110806209 A CN 110806209A
Authority
CN
China
Prior art keywords
underwater robot
navigation
information
strapdown inertial
speed
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN201911168095.7A
Other languages
English (en)
Inventor
赵嘉媛
严文超
秦工
黄镇
陈舫
李智丽
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hubei Three Gorges Polytechnic
Original Assignee
Hubei Three Gorges Polytechnic
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Hubei Three Gorges Polytechnic filed Critical Hubei Three Gorges Polytechnic
Priority to CN201911168095.7A priority Critical patent/CN110806209A/zh
Publication of CN110806209A publication Critical patent/CN110806209A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/02—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems using reflection of acoustic waves
    • G01S15/50—Systems of measurement, based on relative movement of the target
    • G01S15/58—Velocity or trajectory determination systems; Sense-of-movement determination systems

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Acoustics & Sound (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明属于一种海洋装备，提供了一种水下机器人多设备组合导航系统及方法，包括：捷联惯性导航装置、全球卫星定位系统、多普勒计程仪、深度计、海流计、推进电机、电子海图，多普勒计程仪在水下机器人布放入水后实时获得水下机器人对水底的绝对速度信息和离底高度信息；深度计实时输出的水下机器人航行深度信息，海流计实时输出海流速度和方向；推进电机实时输出推进电机转速，捷联惯性导航装置接收全球卫星定位系统、多普勒计程仪、深度计、海流计、推进电机输出的相关信息后经过组合导航融合算法并读取电子海图的地图信息，实时输出水下机器人位置信息、姿态信息和速度信息，形成水下机器人精确导航定位信息。

Description

一种水下机器人多设备组合导航系统及方法
技术领域
本发明属于海洋装备领域，涉及水下机器人导航技术，特别涉及一种水下机器人多设备组合导航系统及方法。
背景技术
由于海洋海面下环境恶劣，人类的潜水深度受到海水外压等因素影响只能在一定深度内下潜，潜水作业深度有限，水下机器人日益成为海洋资源勘探、海洋生物研究、海洋环境观测、水下目标搜寻与救助打捞等开发海洋的重要工具。
导航设备是水下机器人获取自身定位信息、实现路径规划和导航的基础设备之一，与陆基和空中使用的机器人不同，由于无线电波在水中传播衰减迅速，传统的卫星导航无法在水下机器人装备中使用。
目前水下机器人大多采用惯性导航装置、计程仪、全球卫星定位系统、声学定位系统等设备进行导航定位，声学定位系统需要外界船只跟踪或海域中有较多的声定位信标配合，声学定位作业距离有限，限制了水下机器人使用的灵活性且提高了水下机器人的保障要求，但惯性导航装置在无其他导航设备补偿时定位误差随着水下机器人在水下航行时间逐步累积和发散，因此水下机器人惯性导航装置一般与计程仪配合使用；计程仪在一定水深范围正常打底时输出的速度误差较小，但随着水下机器人向深远海航行，计程仪将无法打底而切换成对流工作模式，对流工作模式时计程仪测试精度急剧下降，直接影响计程仪与惯性导航装置的组合导航定位精度；目前大多水下机器人会采取上浮至水面通过全球卫星定位系统进行校准以消除水下长时间航行带来的导航误差，但由于需要频繁上浮和下潜，将浪费水下机器人能源和有效作业时间，同时降低了水下机器人的隐蔽性。
因此水下机器人长时间在水下自主航行，若需要减少上浮至水面带来的隐蔽性降低、能源消耗增加和作业时间减少，高精度的组合导航技术始终是水下机器人在大深度海域航行需要解决的主要关键技术之一。
CN 110044378A记载了一种用于水下深潜器的光纤捷联惯性导航高精度定位系统及方法，包括全球定位系统模块、捷联惯性导航接收模块、多普勒计程仪、地形地磁传感器、信息融合滤波模块、导航解算模块，所述全球定位系统模块用于在载体入水前确定载体速度、位置及姿态信息；捷联惯性导航接收模块用于在载体入水后测量载体速度、位置及姿态信息；多普勒计程仪用于测量载体速度，地形地磁传感器用于测量载体的位置、姿态信息；信息融合滤波模块用于对捷联惯性导航接收模块输出的载体速度、位置及姿态信息与多普勒计程仪、地形地磁传感器输出的载体速度、位置及姿态信息进行融合、滤波校正；导航解算模块用于将捷联惯性导航接收模块输出的数据和融合校正处理后的数据进行解算处理，得到准确的导航速度、位置、姿态信息。
CN 110068331A记载了一种水下导航定位设备及系统，包括：水听器、处理器以及声源发生器；声源发生器预先固定在水下设备所在水域内的指定位置处，声源发生器用于发送调制声波信号，调制声波信号中携带有发送所述调制声波信号的时间信息；水听器设置在水下设备的外表面上，水听器用于探测声源发生器发送的调制声波信号；处理器与水听器电连接，处理器用于根据水听器接收的调制声波信号中的时间信息确定声源发生器与水听器间的距离，根据声源发生器的位置信息以及声源发生器与水听器间的距离，确定水下设备的水下位置。
CN 105787489A记载了一种一种基于水下地貌图像的匹配导航算法，采用基于水下地貌图像的匹配导航算法，将实时图和待与实时图匹配的基准图都转化为圆形模板，提取两个圆形模板的不变矩特征作为匹配的内容；以实时图与基准图之间的不变矩特征向量的欧氏距离作为相似性度量；欧氏距离最小时所对应的基准图的位置即为实时图的匹配位置；采用粒子群优化算法代替遍历的搜索方式；利用多种群思想改进粒子群优化算法；搜索到实时图的匹配位置后，利用最大互相关法确定航向角。
2008年10月的《指挥控制与仿真》期刊上的文章《GPS坐标系的转换及其在姿态求解中的应用》在欧拉角旋转的基础上推导了导航坐标系以及载体坐标系之间的转换关系，推导出相应的转换矩阵，并在此基础上对载体姿态求定的方法进行了推导与说明。
发明内容
本发明所要解决的技术问题是提供一种水下机器人多设备组合导航系统及方法，针对目前常见水下导航技术存在的问题，将捷联惯性导航装置，全球卫星定位系统，多普勒计程仪，深度计，海流计，推进电机,电子海图，导航计算机等多个设备组合使用，抑制水下机器人深海航行时，计程仪对流模式测试精度不高导致的捷联惯性导航装置与计程仪组合导航精度不高问题，显著提高水下机器人深水区航行的导航精度。
为解决上述技术问题，本发明所采用的技术方案是：一种水下机器人多设备组合导航系统，它包括捷联惯性导航装置，其特征在于，捷联惯性导航装置与全球卫星定位系统、多普勒计程仪、深度计、海流计、推进电机相连；
全球卫星定位系统用于在水下机器人在岸基或布放船只上未下潜前实时获得水下机器人的绝对位置和速度等信息，并发送给捷联惯性导航装置进行粗对准和精对准，获取水下机器人初始经纬度信息并解算姿态矩阵，或上浮后获得水下机器人的绝对位置和速度等信息消除惯性导航装置长时间导航误差；
多普勒计程仪用于在水下机器人布放入水后实时获得水下机器人对水底的绝对速度信息和离底高度信息，多普勒计程仪与捷联惯性导航装置形成水下机器人速度阻尼反馈机制；
深度计用于实时采集水下机器人航行深度信息，并发送给捷联惯性导航装置，深度计与捷联惯性导航装置形成水下机器人高度方向阻尼反馈机制；
海流计用于采集水下机器人在水面下海流速度和方向，并发送给导航捷联惯性导航装置，用于修正推进电机转速静水下对应的航速误差；
推进电机，输出矩推动水下机器人航行，并发送推进电机转速给捷联惯性导航装置，该转速和水下机器人航行速度对应关系可根据理论和水下机器人水下实际航行经验得到；在多普勒计程仪和捷联惯性导航装置组合导航时，以多普勒计程仪和捷联惯性导航装置组合导航时输出的速度信息作为基准，可对推进电机加海流计推断的水下机器人航行速度进行速度刻度因子在线计算，可进一步优化和提升推进电机转速与海流计形成的模型精度。
上述的捷联惯性导航装置包含陀螺仪和加速度计，陀螺仪用于测量水下机器人的角速度率，加速度计用于测量水下机器人的速度信息。
上述的捷联惯性导航装置内前有电子海图，可根据经纬度信息查询水下机器人当前位置的水深、航线障碍物等海图信息，以验证捷联惯性导航装置组合导航计算是否正常。
使用上述系统的一种导航方法，上述的捷联惯性导航装置内置推进电机转速与水下机器人静水匀速航行速度的对应关系，当水下机器人水下航行时，捷联惯性导航装置可根据推进电机转速和接收到海流计输出的海流速度和海流方向信息，可组合多普勒计程仪数据推算出水下机器人X、Y轴航行速度。
水下机器人在浅水航行、多普勒计程仪对底工作时，捷联惯性导航装置与多普勒计程仪、深度计组合导航；水下机器人在深水航行、多普勒计程仪无法有效对底工作时，捷联惯性导航装置与推进电机和海流计、深度计组合导航，由于多普勒计程仪打底深度较低，随着水下机器人航行水域深度加深，一旦超过多普勒计程仪最大打底深度，多普勒计程仪将工作在对流模式，对流模式下测试精度急剧下降从而导致多普勒计程仪与捷联惯性导航装置组合导航精度急剧下降。这时捷联惯性导航装置将根据自身纯惯性导航计算的水下机器人位置信息、姿态信息和速度信息，结合接收的推进电机转速信息、海流计输出的海流速度和方向综合对比，经过卡尔曼滤波后形成精确的组合导航定位信息。
上述导航系统工作的具体步骤为：
步骤S1：水下机器人操控设备操控捷联惯性导航装置上电，自检通过后开始工作。
步骤S2：捷联惯性导航装置根据全球卫星定位系统输出的经纬度、速度等信息进行初始对准，完成捷联惯性导航装置自身的姿态、位置和速度推算并向水下机器人航行控制中心输出导航信息。
步骤S3：捷联惯性导航装置接收到多普勒计程仪输出信息后，在浅水区航行时多普勒计程仪对底工作，捷联惯性导航装置与多普勒计程仪、深度计组合导航，同时对推进电机加海流计输出的组合速度进行误差在线标定，计算出推进电机加海流计输出的组合速度刻度因子。
步骤S4：当水下机器人航行到深水区超过多普勒计程仪打底深度时，捷联惯性导航装置与推进电机加海流计、深度计组合导航。
步骤S5：组合导航输出前调用捷联惯性导航装置内置的电子海图，对水下机器人当前经纬度下的深度、航线障碍物等海图信息等信息进行校验。
步骤S6：校验通过后，捷联惯性导航装置向水下机器人航行控制中心输出组成导航信息，当航行到设定的校准点时，水下机器人上浮到水面进行校准。
步骤S7：当水下机器人自主航行到航路终点或作业完成时，水下机器人上浮等待回收，完成组合导航。
上述的当水下机器人水下航行时，捷联惯性导航装置可根据组合的多普勒计程仪数据推算出水下机器人X、Y轴载体坐标系航行速度
Figure BDA0002287997410000051
同步依据推进电机转速和接收到海流计测量的海流速度和海流方向信息进行水下机器人航行速度Vtz计算，并以
Figure BDA0002287997410000052
对速度Vtz的速度刻度因子进行在线计算。
上述步骤S3的具体计算过程为：
在载体坐标系b系与导航坐标系n系间的变换矩阵为
Figure BDA0002287997410000053
假设水下机器人在航行中遇到地理坐标系下海流流速为Vc，海流流向ψc，则流速Vc在载体坐标系下的分量为
Vxc＝Vccos(ψc-φ)
Vyc＝Vcsin(ψc-φ)
则水下机器人在载体坐标系下的速度分量
Vx＝Vxtz+Vxc＝Vtzcosφ+Vccos(ψc-φ)
Vy＝Vytz+Vxc＝Vtzsinφ+Vcsin(ψc-φ)
在静水和水下机器人平衡时其测试误差来源主要来源于刻度因素误差和随机测量误差，若考虑刻度因子误差和随机误差，推进电机转速与速度值可表示为：
Figure BDA0002287997410000055
式中k为标度因素误差，为随机常数，δVtz为随机测量误差；
Figure BDA0002287997410000056
为捷联惯性导航装置/计程仪导航后在导航坐标系的速度，
Figure BDA0002287997410000057
为导航坐标系到载体坐标系间的转换矩阵。因此可以得出k为标度因素误差方程为：
Figure BDA0002287997410000058
与目前通用的水下机器人导航系统相比，本发明的有益效果是：
1)应用前景广阔，本发明中水下机器人多设备组合导航系统在大多数海洋应用领域，如水下勘探与搜寻、水下大深度远距离科考、海洋地质调查与深海生物学研究等提供重要工程应用技术支持，因为水下机器人自身的高精度导航是水下机器人自身作业和航行的基础和前提。
2)解决大深度导航精度差问题，本发明利用多普勒计程仪在浅水区测速精度高，但针对多普勒计程仪对流时测试精度低的问题，利用推进电机转速对应航速基本恒定、海流计输出的海流速度和方向综合计算，经过卡尔曼滤波后形成精确的组合导航定位信息。当校准发现航路偏差后，惯性导航装置内嵌安装的电子海图软件可进一步验证导航输出的正确与否，提高了组合导航系统的精度。
3)减少能源消耗和作业时间，本发明中利用水下机器人深海航行时推进电机转速对应航速基本恒定、海流计输出的海流速度，经过卡尔曼滤波后形成精确的组合导航精度，可减少水下机器人上浮校准次数增加其隐蔽性降，并减少了频繁上浮下潜引起的能源消耗和有效作业时间减少。
附图说明
下面结合附图和实施例对本发明作进一步说明：
图1为本发明的多设备组合导航系统组成图；
图2为本发明中多设备组合导航原理示意图；
图3为本发明中多设备组合导航控制解算流程图；
图4为捷联惯性导航装置的连接示意图。
图中：捷联惯性导航装置1、全球卫星定位系统2、多普勒计程仪3、深度计4、海流计5、推进电机6、电子海图7。
具体实施方式
如图1中，一种水下机器人多设备组合导航系统，它包括捷联惯性导航装置1，其特征在于，捷联惯性导航装置1与全球卫星定位系统2、多普勒计程仪3、深度计4、海流计5、推进电机6相连；
全球卫星定位系统2用于在水下机器人在岸基或布放船只上未下潜前实时获得水下机器人的绝对位置和速度等信息，并发送给捷联惯性导航装置1进行粗对准和精对准，获取水下机器人初始经纬度信息并解算姿态矩阵，或上浮后获得水下机器人的绝对位置和速度等信息消除惯性导航装置长时间导航误差；
多普勒计程仪3用于在水下机器人布放入水后实时获得水下机器人对水底的绝对速度信息和离底高度信息，多普勒计程仪3与捷联惯性导航装置1形成水下机器人速度阻尼反馈机制；
深度计4用于实时采集水下机器人航行深度信息，并发送给捷联惯性导航装置1，深度计4与捷联惯性导航装置1形成水下机器人高度方向阻尼反馈机制；
海流计5用于采集水下机器人在水面下海流速度和方向，并发送给导航捷联惯性导航装置1，用于修正推进电机转速静水下对应的航速误差；
推进电机6，输出矩推动水下机器人航行，并发送推进电机7转速给捷联惯性导航装置1，该转速和水下机器人航行速度对应关系可根据理论和水下机器人水下实际航行经验得到；在多普勒计程仪3和捷联惯性导航装置1组合导航时，以多普勒计程仪3和捷联惯性导航装置1组合导航时输出的速度信息作为基准，可对推进电机6加海流计5推断的水下机器人航行速度进行速度刻度因子在线计算，可进一步优化和提升推进电机6转速与海流计5形成的模型精度。
上述捷联惯性导航装置1装置中电路结构采用通用架构，其惯性传感器采用中星测控公司CS-IMU-10惯性测量单元，集成了X、Y、Z三轴陀螺仪和加速度计，捷联惯性导航装置计算机板采用深圳盛博的SCM9032系统核心模块+SEM/CSD CAN总线接口模块，基于英特尔N455处理器、CAN通讯接口、串口和网口数据通信接口，可内置操作系统。
上述全球卫星定位系统2为市售的产品，例如深圳北天通讯的BS-7953N GPS接收器。
上述多普勒计程仪3为市售的产品，例如Nortek公司的DVL500khz计程仪。
上述的深度计4为市售的产品，例如seabird公司SBE 50数字式压力传感器。
上述的海流计5为市售的产品，例如TRDI公司OS-38相控阵海洋调查型ADCP。
上述推进电机6为市售的产品，例如济南预立直驱电机有限公司水下500米电机。
如图4中，上述的捷联惯性导航装置1包含陀螺仪和加速度计，陀螺仪用于测量水下机器人的角速度率，加速度计用于测量水下机器人的速度信息。
如图1中，上述的捷联惯性导航装置1内前有电子海图7，可根据经纬度信息查询水下机器人当前位置的水深、航线障碍物等海图信息，以验证捷联惯性导航装置1组合导航计算是否正常。
如图3、4中所示，使用上述系统的一种导航方法，上述的捷联惯性导航装置1内置推进电机6转速与水下机器人静水匀速航行速度的对应关系，当水下机器人水下航行时，捷联惯性导航装置1可根据推进电机6转速和接收到海流计5输出的海流速度和海流方向信息，可组合多普勒计程仪3数据推算出水下机器人X、Y轴航行速度。
水下机器人在浅水航行、多普勒计程仪对底工作时，捷联惯性导航装置1与多普勒计程仪、深度计4组合导航；水下机器人在深水航行、多普勒计程仪无法有效对底工作时，捷联惯性导航装置1与推进电机6和海流计5、深度计4组合导航，由于多普勒计程仪3打底深度较低，随着水下机器人航行水域深度加深，一旦超过多普勒计程仪3最大打底深度，多普勒计程仪3将工作在对流模式，对流模式下测试精度急剧下降从而导致多普勒计程仪3与捷联惯性导航装置1组合导航精度急剧下降。这时捷联惯性导航装置1将根据自身纯惯性导航计算的水下机器人位置信息、姿态信息和速度信息，结合接收的推进电机转速信息、海流计输出的海流速度和方向综合对比，经过卡尔曼滤波后形成精确的组合导航定位信息。
上述导航系统工作的具体步骤为：
步骤S1：水下机器人操控设备操控捷联惯性导航装置1上电，自检通过后开始工作。
步骤S2：捷联惯性导航装置1根据全球卫星定位系统2输出的经纬度、速度等信息进行初始对准，完成捷联惯性导航装置1自身的姿态、位置和速度推算并向水下机器人航行控制中心输出导航信息。
步骤S3：捷联惯性导航装置1接收到多普勒计程仪3输出信息后，在浅水区航行时多普勒计程仪3对底工作，捷联惯性导航装置1与多普勒计程仪3、深度计4组合导航，同时对推进电机6加海流计5输出的组合速度进行误差在线标定，计算出推进电机6加海流计5输出的组合速度刻度因子。
步骤S4：当水下机器人航行到深水区超过多普勒计程仪3打底深度时，捷联惯性导航装置1与推进电机6加海流计5、深度计4组合导航。
步骤S5：组合导航输出前调用捷联惯性导航装置1内置的电子海图7，对水下机器人当前经纬度下的深度、航线障碍物等海图信息等信息进行校验。
步骤S6：校验通过后，捷联惯性导航装置1向水下机器人航行控制中心输出组成导航信息，当航行到设定的校准点时，水下机器人上浮到水面进行校准。
步骤S7：当水下机器人自主航行到航路终点或作业完成时，水下机器人上浮等待回收，完成组合导航。
上述的当水下机器人水下航行时，捷联惯性导航装置1可根据组合的多普勒计程仪3数据推算出水下机器人X、Y轴航行速度
Figure BDA0002287997410000091
同步依据推进电机6转速和接收到海流计5测量的海流速度和海流方向信息进行水下机器人航行速度Vtz计算，并以对速度Vtz的速度刻度因子进行在线计算。
上述步骤S3的具体计算过程为：
在载体坐标系b系与导航坐标系n系间的变换矩阵为
假设水下机器人在航行中遇到地理坐标系下海流流速为Vc，海流流向ψc，则流速Vc在载体坐标系下的分量为
Vxc＝Vccos(ψc-φ)
Vyc＝Vcsin(ψc-φ)
则水下机器人在载体坐标系下的速度分量
Vx＝Vxtz+Vxc＝Vtzcosφ+Vccos(ψc-φ)
Vy＝Vytz+Vxc＝Vtzsinφ+Vcsin(ψc-φ)
Figure BDA0002287997410000094
在静水和水下机器人平衡时其测试误差来源主要来源于刻度因素误差和随机测量误差，若考虑刻度因子误差和随机误差，推进电机转速与速度值可表示为：
Figure BDA0002287997410000095
式中k为标度因素误差，为随机常数，δVtz为随机测量误差；
Figure BDA0002287997410000101
为捷联惯性导航装置/计程仪导航后在导航坐标系的速度，
Figure BDA0002287997410000102
为导航坐标系到载体坐标系间的转换矩阵。因此可以得出k为标度因素误差方程为：
Figure BDA0002287997410000103
得出推进电机转速与海流计测量的海流速度刻度因子后，即可以(1+k)Vtz作为捷联惯性导航装置1在深水航行中的推进电机转速推算的航行速度阻尼，可以避免由于深水航行时多普勒计程仪对流模式下测试精度急剧下降从而导致多普勒计程仪3与捷联惯性导航装置1组合导航精度急剧下降的问题。

Claims (8)

1.一种水下机器人多设备组合导航系统，它包括捷联惯性导航装置(1)，其特征在于，捷联惯性导航装置(1)与全球卫星定位系统(2)、多普勒计程仪(3)、深度计(4)、海流计(5)、推进电机(6)相连；
所述全球卫星定位系统(2)，用于在水下机器人未下潜前或上浮后实时获得水下机器人的绝对位置信息和速度信息，并发送给捷联惯性导航装置(1)；
所述多普勒计程仪(3)，用于在水下机器人布放入水后实时获得水下机器人对水底的绝对速度信息和离底高度信息，并发送给捷联惯性导航装置(1)；
所述深度计(4)，用于实时采集水下机器人航行深度信息，并发送给捷联惯性导航装置(1)；
所述海流计(5)，用于采集水下机器人在水面下海流速度和方向，并发送给导航捷联惯性导航装置(1)；
所述推进电机(6)，输出扭矩推动水下机器人航行，并发送推进电机(6)转速给捷联惯性导航装置(1)。
2.根据权利要求1所述的一种水下机器人多设备组合导航系统，其特征是：所述的捷联惯性导航装置(1)包含陀螺仪和加速度计，陀螺仪用于测量水下机器人的角速度率，加速度计用于测量水下机器人的速度信息。
3.根据权利要求2所述的一种水下机器人多设备组合导航系统，其特征是：所述的捷联惯性导航装置(1)内置有电子海图(7)，可根据经纬度信息查询水下机器人当前位置水深、航线障碍物等海图信息，以验证捷联惯性导航装置(1)组合导航计算是否正常。
4.使用权利要求1所述系统的一种导航方法，其特征是：所述的捷联惯性导航装置(1)内置推进电机(6)转速与水下机器人静水匀速航行速度的对应关系，当水下机器人水下航行时，捷联惯性导航装置(1)可根据推进电机(6)转速和接收到海流计(5)输出的海流速度和海流方向信息，可组合多普勒计程仪(3)数据推算出水下机器人X、Y轴航行速度。
5.根据权利要求4所述的一种导航方法，其特征在于，水下机器人在浅水航行、多普勒计程仪对底工作时，捷联惯性导航装置(1)与多普勒计程仪、深度计(4)组合导航；水下机器人在深水航行、多普勒计程仪无法有效对底工作时，捷联惯性导航装置(1)与推进电机(6)和海流计(5)、深度计(4)组合导航。
6.根据权利要求5所述的一种导航方法，其特征在于，导航系统工作的具体步骤为：
步骤S1：水下机器人操控设备操控捷联惯性导航装置(1)上电，自检通过后开始工作。
步骤S2：捷联惯性导航装置(1)根据全球卫星定位系统(2)输出的经纬度、速度等信息进行初始对准，完成捷联惯性导航装置(1)自身的姿态、位置和速度推算并向水下机器人航行控制中心输出导航信息。
步骤S3：捷联惯性导航装置(1)接收到多普勒计程仪(3)输出信息后，在浅水区航行时多普勒计程仪(3)对底工作，捷联惯性导航装置(1)与多普勒计程仪(3)、深度计(4)组合导航，同时对推进电机(6)加海流计(5)输出的组合速度进行误差在线标定，计算出推进电机(6)加海流计(5)输出的组合速度刻度因子。
步骤S4：当水下机器人航行到深水区超过多普勒计程仪(3)打底深度时，捷联惯性导航装置(1)与推进电机(6)加海流计(5)、深度计(4)组合导航。
步骤S5：组合导航输出前调用捷联惯性导航装置(1)内置的电子海图(7)，对水下机器人当前经纬度下的深度、航线障碍物等海图信息等信息进行校验。
步骤S6：校验通过后，捷联惯性导航装置(1)向水下机器人航行控制中心输出组成导航信息，当航行到设定的校准点时，水下机器人上浮到水面进行校准。
步骤S7：当水下机器人自主航行到航路终点或作业完成时，水下机器人上浮等待回收，完成组合导航。
7.根据权利要求6所述的一种导航方法，其特征是：所述的当水下机器人水下航行时，捷联惯性导航装置(1)可根据组合的多普勒计程仪(3)数据推算出水下机器人X、Y轴载体坐标系航行速度
Figure FDA0002287997400000021
同步依据推进电机(6)转速和接收到海流计(5)测量的海流速度和海流方向信息进行水下机器人航行速度Vtz计算，并以对速度Vtz的速度刻度因子进行在线计算。
8.根据权利要求7所述的一种导航方法，其特征在于，所述步骤S3的具体计算过程为：
在载体坐标系b系与导航坐标系n系间的变换矩阵为
其中ψ、θ、φ分别为水下机器人横摇、纵摇、航向姿态角；
假设水下机器人在航行中遇到地理坐标系下海流流速为Vc，海流流向ψc，则流速Vc在载体坐标系下的分量为
Vxc＝Vccos(ψc-φ)
Vyc＝Vcsin(ψc-φ)
则水下机器人在载体坐标系下的速度分量
Vx＝Vxtz+Vxc＝Vtzcosφ+Vccos(ψc-φ)
Vy＝Vytz+Vxc＝Vtzsinφ+Vcsin(ψc-φ)
Figure FDA0002287997400000032
在静水和水下机器人平衡时其测试误差来源主要来源于刻度因素误差和随机测量误差，若考虑刻度因子误差和随机误差，推进电机转速与速度值可表示为：
Figure FDA0002287997400000033
式中k为标度因素误差，为随机常数，δVtz为随机测量误差；
为捷联惯性导航装置/计程仪导航后在导航坐标系的速度，
Figure FDA0002287997400000035
为导航坐标系到载体坐标系间的转换矩阵，因此可以得出k为标度因素误差方程为：
Figure FDA0002287997400000036
CN201911168095.7A 2019-11-25 2019-11-25 一种水下机器人多设备组合导航系统及方法 Pending CN110806209A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911168095.7A CN110806209A (zh) 2019-11-25 2019-11-25 一种水下机器人多设备组合导航系统及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911168095.7A CN110806209A (zh) 2019-11-25 2019-11-25 一种水下机器人多设备组合导航系统及方法

Publications (1)

Publication Number Publication Date
CN110806209A true CN110806209A (zh) 2020-02-18

Family

ID=69491316

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911168095.7A Pending CN110806209A (zh) 2019-11-25 2019-11-25 一种水下机器人多设备组合导航系统及方法

Country Status (1)

Country Link
CN (1) CN110806209A (zh)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111625009A (zh) * 2020-06-05 2020-09-04 上海中车艾森迪海洋装备有限公司 水下机器人在布放回收过程中的自动运动控制方法及装置
CN112363169A (zh) * 2020-10-27 2021-02-12 哈尔滨工程大学 全海深水下机器人及其定位方法
CN112835107A (zh) * 2020-12-31 2021-05-25 华中科技大学 一种海底缆线电磁探测系统及自主水下机器人装备
CN113124865A (zh) * 2021-04-20 2021-07-16 中山大学 一种水下航行器导航定位系统及控制方法
CN113252028A (zh) * 2021-06-28 2021-08-13 深之蓝海洋科技股份有限公司 输水隧洞内机器人的定位方法、电子设备及存储介质
CN113252041A (zh) * 2021-05-11 2021-08-13 大连理工大学 一种适用于小型水下机器人的组合导航方法
CN113790724A (zh) * 2021-09-28 2021-12-14 武汉华中天易星惯科技有限公司 一种基于速度阻尼的惯性/多普勒组合导航方法及系统
CN117032268A (zh) * 2023-10-10 2023-11-10 华中农业大学 一种水下并联机器人智能下潜控制方法及系统

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111625009B (zh) * 2020-06-05 2021-06-25 上海中车艾森迪海洋装备有限公司 水下机器人在布放回收过程中的自动运动控制方法及装置
CN111625009A (zh) * 2020-06-05 2020-09-04 上海中车艾森迪海洋装备有限公司 水下机器人在布放回收过程中的自动运动控制方法及装置
CN112363169B (zh) * 2020-10-27 2022-12-13 哈尔滨工程大学 全海深水下机器人及其定位方法
CN112363169A (zh) * 2020-10-27 2021-02-12 哈尔滨工程大学 全海深水下机器人及其定位方法
CN112835107A (zh) * 2020-12-31 2021-05-25 华中科技大学 一种海底缆线电磁探测系统及自主水下机器人装备
CN113124865A (zh) * 2021-04-20 2021-07-16 中山大学 一种水下航行器导航定位系统及控制方法
CN113124865B (zh) * 2021-04-20 2023-05-26 中山大学 一种水下航行器导航定位系统及控制方法
CN113252041A (zh) * 2021-05-11 2021-08-13 大连理工大学 一种适用于小型水下机器人的组合导航方法
CN113252028A (zh) * 2021-06-28 2021-08-13 深之蓝海洋科技股份有限公司 输水隧洞内机器人的定位方法、电子设备及存储介质
CN113252028B (zh) * 2021-06-28 2021-09-21 深之蓝海洋科技股份有限公司 输水隧洞内机器人的定位方法、电子设备及存储介质
CN113790724A (zh) * 2021-09-28 2021-12-14 武汉华中天易星惯科技有限公司 一种基于速度阻尼的惯性/多普勒组合导航方法及系统
CN117032268A (zh) * 2023-10-10 2023-11-10 华中农业大学 一种水下并联机器人智能下潜控制方法及系统
CN117032268B (zh) * 2023-10-10 2023-12-29 华中农业大学 一种水下并联机器人智能下潜控制方法及系统

Similar Documents

Publication Publication Date Title
CN210719199U (zh) 一种水下机器人多设备组合导航系统
CN110806209A (zh) 一种水下机器人多设备组合导航系统及方法
CN104316045B (zh) 一种基于sins/lbl的auv水下交互辅助定位系统及定位方法
CN104457754B (zh) 一种基于sins/lbl紧组合的auv水下导航定位方法
CN109782323B (zh) 一种深海水下自主航行器导航定位及校准方法
CN102829777B (zh) 自主式水下机器人组合导航系统及方法
CN106767793A (zh) 一种基于sins/usbl紧组合的auv水下导航定位方法
CN110006433A (zh) 海底油气管检测机器人的组合导航定位系统及方法
CN106643709B (zh) 一种海上运载体的组合导航方法及装置
CN107390177B (zh) 一种基于纯测向的被动水下声学定位方法
CN111829512B (zh) 一种基于多传感器数据融合的auv导航定位方法及系统
CN102288170B (zh) 一种水下航行器内电子罗盘的校正方法
CN105547290B (zh) 一种基于超短基线定位系统的从潜器导航方法
CN111350214B (zh) 多波束水下钢管桩桩位测量方法
CN105486313A (zh) 一种基于usbl辅助低成本sins系统的定位方法
CN107990891A (zh) 基于长基线和信标在线标定的水下机器人组合导航方法
CN104776847B (zh) 一种适用于水下导航系统单点估计陀螺漂移的方法
CN109855649B (zh) 一种水下滑翔机平台运动轨迹被动确定方法
CN103900609A (zh) 一种船用惯性导航系统的航向精度实时检测系统及检测方法
CN105547289A (zh) 一种水下航行器组合导航系统及导航信息融合方法
CN104697520A (zh) 一体化无陀螺捷联惯导系统与gps系统组合导航方法
CN112540371A (zh) 一种近底多波束坐标转换处理方法
CN104061930A (zh) 基于捷联惯性制导和多普勒计程仪的导航方法
CN111735455A (zh) 基于改进的高斯距离迭代算法对接回收组合导航方法
Allotta et al. Localization algorithm for a fleet of three AUVs by INS, DVL and range measurements

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination