一种提高水声定位系统定位精度的位置解算方法技术方案

本发明专利技术提供一种提高水声定位系统定位精度的位置解算方法，其通过预先布设在海底的通信信标，接收机定位精度的进行调整，实现接收机位置的快速定位，其特征在于，其接收机位置的快速解算方法包括下列步骤：获取接收机初始坐标；根据所述初始坐标，计算偏导矩阵G与偏差向量B；基于偏导矩阵G与偏差向量B计算接收机坐标误差，对接收机坐标误差进行判断，若所述接收机坐标误差符合阈值要求，则基于接收机坐标误差以及接收机初始坐标，计算最新的接收机坐标。坐标。坐标。

【技术实现步骤摘要】
一种提高水声定位系统定位精度的位置解算方法


[0001]本专利技术涉及水下定位
，尤其涉及一种提高水声定位系统定位精度的位置解算方法。

技术介绍

[0002]海洋在一个国家的战略中处于非常重要的地位。国际贸易的货物流动大部分是通过海洋运输，可以说海洋运输线往往就是一个国家的生命线。海洋中还蕴含着丰富的矿产资源、石油和天然气，可以为国家的发展提供物质保障。此外，海洋对一个国家的政治军事也具有重要的意义。通过海洋，国家军队可以远赴到世界的很多地区。现在，随着海洋开发利用的发展，水下机器人相关技术也有了广泛应用。水下机器人的定位导航是水下机器人的核心技术。现阶段的水下机器人通常靠惯性器件获得自身定位信息，但惯性器件的误差会随着时间推移而累积。因此可以通过在海底布放可以发射定位信号的信标，使水下机器人接收信号来获得持续高精度的定位服务。信标与水下机器人时钟同步模式下，水声定位系统一般采用球面交汇模型解算水下机器人位置。传统的位置解算方法主要是通过降次处理，得到三元一次方程组，然后根据最小二乘法，获取水下机器人位置坐标。但这种方法获取的位置坐标精度一般较差，无法满足高精度水下机器人作业需求。因此，本专利技术提供一种用来提高水声定位系统定位精度的位置求解方法，可以根据定位精度需求来解算水下机器人位置。

技术实现思路

[0003]本专利技术的目的在于提供一种提高水声定位系统定位精度的位置解算方法，以解决上述
技术介绍
中提出的问题。
[0004]本专利技术是通过以下技术方案实现的：一种提高水声定位系统定位精度的位置解算方法，其通过预先布设在海底的通信信标，接收机定位精度的进行调整，实现接收机位置的快速定位，其特征在于，其接收机位置的快速解算方法包括下列步骤：
[0005]获取接收机初始坐标U0；
[0006]根据所述初始坐标U0，计算偏导矩阵G与偏差向量B；
[0007]基于偏导矩阵G与偏差向量B计算接收机坐标误差，对接收机坐标误差进行判断，若所述接收机坐标误差符合阈值要求，则基于接收机坐标误差以及接收机初始坐标U0，计算最新的接收机坐标。
[0008]可选的，所述接收机初始坐标U0为接收机载体的入水位置、所有信标位置坐标的平均值中的一种或多种。
[0009]可选的，所述偏导矩阵G的计算方式如下：
[0010][0011]式中，(x，y，z)为接收机的位置坐标，(x
(n)
，y
(n)
，z
(n)
)，n＝1，2，
…
，N为第n个所述通信信标的位置坐标，r
(n)
为接收机与通信信标之间的距离。
[0012]可选的，所述偏差向量B的计算方式如下：
[0013][0014]式中，d
(n)
，n＝1，2，
…
，N为第n个信标与接收机的距离。
[0015]可选的，基于偏导矩阵G与偏差向量B通过下式计算接收机坐标误差：
[0016][0017]式中，Δx为x方向上的误差，而Δy为y方向上的误差，Δz为z方向上的误差。
[0018]可选的，对Δx、Δy、Δz预设阈值，若Δx、Δy、Δz之一大于阈值时，通过偏导矩阵G与偏差向量B重新计算接收机坐标误差；
[0019]若Δx、Δy、Δz均小于阈值，则Δx、Δy、Δz符合精度要求。
[0020]可选的，通过下式计算最新的接收机坐标：
[0021][0022]式中，为最新的接收机坐标值。
[0023]与现有技术相比，本专利技术达到的有益效果如下：本专利技术提供的一种用来提高水声定位系统定位精度的位置解算方法，可通过偏导矩阵G与偏差向量B实现接收机在x、y、z三个方向上的误差计算，从而实现接收机自身位置的精确定位，进而提升水下定位的精度，并且与传统的直接估计位置方法相比，本专利技术估计得到的位置定位精度更高。
附图说明
[0024]为了更清楚地说明本专利技术实施例中的技术方案，下面将对实施例描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本专利技术的优选实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这些附图获得其他的附图。
[0025]图1是本专利技术提供一种用来提高水声定位系统定位精度的位置解算方法流程图。
[0026]图2是本专利技术实施例提供的方法估计目标轨迹。
[0027]图3是直接估计法估计目标轨迹。
[0028]图4是本专利技术实施例提供的方法估计目标轨迹坐标均方根误差。
[0029]图5是直接估计法估计目标轨迹坐标均方根误差。
具体实施方式
[0030]为了使得本专利技术的目的、技术方案和优点更为明显，下面将参照附图详细描述根据本专利技术的示例实施例。显然，所描述的实施例仅仅是本专利技术的一部分实施例，而不是本专利技术的全部实施例，应理解，本专利技术不受这里描述的示例实施例的限制。基于本专利技术中描述的本专利技术实施例，本领域技术人员在没有付出创造性劳动的情况下所得到的所有其它实施例都应落入本专利技术的保护范围之内。
[0031]在下文的描述中，给出了大量具体的细节以便提供对本专利技术更为彻底的理解。然而，对于本领域技术人员而言显而易见的是，本专利技术可以无需一个或多个这些细节而得以实施。在其他的例子中，为了避免与本专利技术发生混淆，对于本领域公知的一些技术特征未进行描述。
[0032]应当理解的是，本专利技术能够以不同形式实施，而不应当解释为局限于这里提出的实施例。相反地，提供这些实施例将使公开彻底和完全，并且将本专利技术的范围完全地传递给本领域技术人员。
[0033]在此使用的术语的目的仅在于描述具体实施例并且不作为本专利技术的限制。在此使用时，单数形式的“一”、“一个”和“所述/该”也意图包括复数形式，除非上下文清楚指出另外的方式。还应明白术语“组成”和/或“包括”，当在该说明书中使用时，确定所述特征、整数、步骤、操作、元件和/或部件的存在，但不排除一个或更多其它的特征、整数、步骤、操作、元件、部件和/或组的存在或添加。在此使用时，术语“和/或”包括相关所列项目的任何及所有组合。
[0034]为了彻底理解本专利技术，将在下列的描述中提出详细的结构，以便阐释本专利技术提出的技术方案。本专利技术的可选实施例详细描述如下，然而除了这些详细描述外，本专利技术还可以具有其他实施方式。
[0035]参见图1，一种提高水声定位系统定位精度的位置解算方法，其通信信标锚定于海底，并记录通信信标自身的三维位置坐标，而在水下载体处设有超短基线声学基阵的接收机以及高精度的GPS，通过高精度的GPS获得接收机的初始位置坐标，通过偏导矩阵G与偏差向量B实现接收机误差的校正，从而实现接收机精度的调节，其具体方法包括下列步骤：
[0036]步骤101、获取接收机初始坐标U0；
[0037]步骤102、根据所述初始坐标U0，计算偏导矩阵G与偏差向量B；
[0038]步骤103、基于偏导矩阵G与偏差向量B计算接收机坐标本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种提高水声定位系统定位精度的位置解算方法，其特征在于，其通过预先布设在海底的通信信标，接收机定位精度的进行调整，实现接收机位置的快速定位，其接收机位置的快速解算方法包括下列步骤：获取接收机初始坐标U0；根据所述初始坐标U0，计算偏导矩阵G与偏差向量B；基于偏导矩阵G与偏差向量B计算接收机坐标误差，对接收机坐标误差进行判断，若所述接收机坐标误差符合阈值要求，则基于接收机坐标误差以及接收机初始坐标U0，计算最新的接收机坐标。2.根据权利要求1所述的一种提高水声定位系统定位精度的位置解算方法，其特征在于，所述接收机初始坐标U0为接收机载体的入水位置、所有信标位置坐标的平均值中的一种或多种。3.根据权利要求2所述的一种提高水声定位系统定位精度的位置解算方法，其特征在于，所述偏导矩阵G的计算方式如下：式中，(x,y,z)为接收机的位置坐标，(x
(n)
,y
(n)
,z
(n)
),n＝1,2,
…
,N为第n个所述通信信标的...

【专利技术属性】
技术研发人员：吕成财，沈斌坚，田川，陈瑨，张胜宗，刘国顺，宋元杰，高潭，赵强，
申请(专利权)人：中国科学院深海科学与工程研究所，
类型：发明
国别省市：