无固定参考点的载人潜水器在惯性坐标系中的定位方法技术

本发明专利技术是涉及载人潜水器在海洋中定位技术，具体的说是一种无固定参考点的载人潜水器在惯性坐标系中的定位方法。本发明专利技术先确定一个固定坐标，然后确定某时刻的母船和载人潜水器的惯性坐标，载人潜水器这个时刻的位置作为初始值（新的固定坐标系原点），进行载人潜水器的航迹推算，然后把载人潜水器的每点坐标变换到惯性坐标系坐标。本发明专利技术解决了以前因投放固定信标而增加了作业难度、作业时间和作业风险问题。解决了使用固定水声信标，跟踪载人潜水器范围小的问题。

【技术实现步骤摘要】

本专利技术是涉及载人潜水器在海洋中定位技术，具体的说是一种，它在载人潜水器无海底或海面固定参考坐标时，确定载人潜水器在惯性坐标系中的坐标值。
技术介绍
载人潜水器在海洋中运动时，不仅需要实时确定载人潜水器和作业母船之间的相对位置，还需要实时确定载人潜水器在惯性坐标系中的坐标。以往确定载人潜水器在惯性坐标系中的坐标，需要在海底或海面投放一个固定位置的声学水声应答信标，首先通过GPS(全球定位系统)接收机和母船上超短基线定位系统的水声接收基阵，确定固定水声应答信标在惯性坐标系中的坐标，然后测量载人潜水器和固定水声应答信标的相对位置，再把载人潜水器与固定水声应答信标之间相对位置的坐标换算成在惯性坐标系中的坐标。声学水声定位系统主要有三种形式长基线、短基线、超短基线。长基线水声定位系统是在海底一定范围内相隔数千米，布置3只以上水声应答器，组成长基线水声接收基阵。在作业母船安装一只水声接收器，在水下载人潜水器上安装一只水声应答信标，测定母船相对于载人潜水器的位置以及载人潜水器与水声信标的相对位置。长基线水声定位系统定位精度高，不受母船移动的影响，监测范围大。但是作业时，在海底水声应答器的布阵过程很复杂，水声应答器在回收的过程中易丢失，损失会很大。短基线定位系统是在母船上间隔十米以上安装3只水声接收器，组成一个水声接收基阵。在载人潜水器上安装一只水声应答信标，即可在水上监视载人潜水器在水中的位置。在海底投放一只位置固定的水声应答信标，可以确定载人潜水器相对于固定水声应答信标的位置。但是，短基线定位系统在母船上安装3只水声接收器，就要在母船底打三个洞或安装延长支架，对船的航行和维护带来麻烦，所以不是专业的作业母船不能安装短基线定位系统。超短基线定位系统是在母船上安装一个水声接收基阵。水声接收基阵上有5个接收换能器按圆环型布置，相互间隔1厘米左右。在圆环的中间有一个发射换能器。在载人潜水器上安装一只水声应答信标，水声接收基阵可以安装在船侧弦，而不需改造作业船。同样在载人潜水器上安装一只水声应答信标，在海底投放一只位置固定水声应答信标。通过母船上的GPS和超短基线定位系统，确定母船惯性坐标系中的坐标及载人潜水器相对于母船和固定信标之间的相对位置，就可以确定载人潜水器在惯性坐标系中的坐标。超短基线定位系统在安装操作上都很方便。所以在载人潜水器的定位中，常用超短基线定位声纳。但是超短基线定位系统测量范围小，载人潜水器只能在固定水声信标的附近运动。
技术实现思路
为了避免投放固定水声信标的麻烦和解决跟踪范围小的问题，本专利技术提供一种全新的。它通过确定载人潜水器起始点的惯性坐标和对载人潜水器航迹推算，实现大范围的载人潜水器惯性坐标的确定。为了实现上述目的，本专利技术的技术方案是确定固定坐标系(E-XYZ)，其中母船为原点E，EZ指向地心，水平面采用北东坐标系；定义动坐标系(o-xyz)，动坐标系与载人潜水器固联在一起；载人潜水器动坐标系和固定坐标系间的变换可以表示为η·=J(η)V---(1)]]>其中η＝T，V＝T，J(η)=cosθ·cosψ-sinθ0sinθcosψcosθ0001,]]>X、Y、Z表示载人潜水器在固定坐标系中的坐标，u、v、w表示载人潜水器沿动坐标系三轴的速度，θ表示载人潜水器的航向角，ψ表示载人潜水器纵倾角；将固定坐标转化到惯性坐标系中，用经纬度表示载人潜水器的坐标；载人潜水器在惯性坐标系中的经纬度坐标值为 L=Lo-360R·Y---(2),]]>其中，(λ0，L0)是作业母船起始位置的经纬度坐标，由母船上的GPS接收机接收，X，Y是载人潜水器在固定坐标系中的坐标值，R为地球半径，(λ，L)是载人潜水器在惯性坐标系中的坐标；以某一时刻载人潜水器在惯性坐标系中的经纬度坐标(λ1，L1)作为载人潜水器航迹推算的初始值，以这点为新的固定坐标系原点(0，0)，用载人潜水器的坐标变换式(1)进行航迹推算，求出载人潜水器在新的固定坐标中坐标值(x，y)，再用公式(2)求出载人潜水器在惯性坐标系中的经纬度坐标(λ，L)； 所述某一时刻载人潜水器在惯性坐标系中初始值的经纬度坐标(λ1，L1)是通过所述公式(2)计算得到的；求载人潜水器在惯性坐标系中的经纬度坐标(λ，L)时，公式(2)中(X，Y)取(x，y)，(λ0，L0)取(λ1，L1)。本专利技术工作原理为先确定一个固定坐标，然后确定某时刻的母船和载人潜水器的惯性坐标，载人潜水器这个时刻的位置作为初始值，进行载人潜水器的航迹推算，然后把载人潜水器的每点坐标变换到惯性坐标系坐标。本专利技术具有如下优点1.本专利技术解决了以前因投放固定信标而增加了作业难度、作业时间和作业风险问题。2.在7000米的海域投放水声信标，很难保证信标进入指定的范围之内，投放完固定水声信标，还要对信标的位置精确测量，这都需要很多时间，要保证天黑之前完成，作业对海况的要求也很高。在载人潜水器作业完后，要成功的回收固定水声信标，由于深海浪高流急，发现和成功回收信标都很困难，如果回收不成功，就要有几十万的损失。本专利技术不需要投放水下固定信标，避免上述的损失和麻烦。3.本专利技术解决了使用固定水声信标，跟踪载人潜水器范围小的问题。4.水声信标的信号范围有限，而以前的方法(如使用超短基线定位系统和固定信标法)，可以确定的惯性坐标的范围小，可跟踪载人潜水器的活动范围也有限，要求载人潜水器在固定水声信标的信号范围内，才能实现对载人潜水器坐标的确定。采用本专利技术不用投放固定水声信标，理论上可以无限范围内实时确定载人潜水器的惯性坐标，也避免了丢失水声信标的可能。5.本专利技术提出的载人潜水器的定位方法，同样适用于其它的水下机器人，包括自治水下机器人(AUV)和遥控水下机器人(ROV)。附图说明图1为本专利技术固定坐标系和动坐标系示意图。具体实施例方式下面对本专利技术作进一步说明。本专利技术采用超短基线定位系统确定载人潜水器在惯性坐标系中的坐标，不用在海面或海底投放固定水声信标。具体是首先要确定一个固定坐标系(E-XYZ)，原点为E。其中，EZ指向地心，水平面采用北东坐标系，本实施例取母船为固定坐标系的原点E。此外还要定义动坐标系(o-xyz)，动坐标系与载人潜水器固联在一起。如图1所示，原则上，动坐标系原点和坐标轴的方向可以任意选取，为了方便起见，本实施例将ox轴与载人潜水器的主对称轴取向一致，而oy轴与辅助对称轴取向一致，沿动坐标系三轴的速度分别用u，v，w表示，假设载人潜水器的航向角用θ表示，由于载人潜水器可以有纵倾角运动，所以要考虑纵倾角的影响，纵倾角用ψ表示，在坐标推算中不考虑载人潜水器横摇的影响，载人潜水器动坐标系和定坐标系间的变换可以表示为η·=J(η)V---(1)]]>其中，η＝T，V＝T，J(η)=cosθ·cosψ-本文档来自技高网...

【技术保护点】
一种无固定参考点的载人潜水器在惯性坐标系中的定位方法，其特征在于：确定固定坐标系（Ｅ－ＸＹＺ），其中母船为原点Ｅ，ＥＺ指向地心，水平面采用北东坐标系；定义动坐标系（ｏ－ｘｙｚ），动坐标系与载人潜水器固联在一起；载人潜水器动坐标系和定坐标系间的变换可以表示为：＊＝Ｊ（η）Ｖ（１）其中：η＝［Ｘ，Ｙ，Ｚ］↑［Ｔ］，Ｖ＝［ｕ，ｖ，ｗ］↑［Ｔ］，Ｊ（η）＝＊＊＊，Ｘ、Ｙ、Ｚ表示载人潜水器在固定坐标系中的坐标，ｕ、ｖ、ｗ表示载人潜水器沿动坐标系三轴的速度，θ表示载人潜水器的航向角，ψ表示载人潜水器纵倾角；将固定坐标转化到惯性坐标系中，用经纬度表示载人潜水器的坐标；载人潜水器在惯性坐标系中的经纬度坐标值为：λ＝［λ↓［０］－３６０°／ｃｏｓ（π／１８０Ｌ↓［０］）.Ｘ］／ｃｏｓ（π／１８０Ｌ↓［０］）Ｌ＝Ｌ↓［０］－３６０／Ｒ.Ｙ（２），其中，（λ↓［０］，Ｌ↓［０］）是作业母船起始位置的经纬度坐标，由母船上的ＧＰＳ接收机接收，Ｘ，Ｙ是载人潜水器在固定坐标系中的坐标值，Ｒ为地球半径，（λ，Ｌ）是载人潜水器在惯性坐标系中的坐标；以某一时刻载人潜水器在惯性坐标系中的经纬度坐标（λ↓［１］，Ｌ↓［１］）作为航迹推算的初始值，以这点为新的固定坐标系原点（０，０），用载人潜水器的坐标变换式（１）进行航迹推算，求出载人潜水器在新的固定坐标中坐标值（ｘ，ｙ），再用公式（２）求出载人潜水器在惯性坐标系中的经纬度坐标（λ，Ｌ）。...

【技术特征摘要】

【专利技术属性】
技术研发人员：于开洋，
申请(专利权)人：中国科学院沈阳自动化研究所，
类型：发明
国别省市：89[]