CN109490927B - 一种水下整平架定位系统及其定位方法 - Google Patents
一种水下整平架定位系统及其定位方法 Download PDFInfo
- Publication number
- CN109490927B CN109490927B CN201811600860.3A CN201811600860A CN109490927B CN 109490927 B CN109490927 B CN 109490927B CN 201811600860 A CN201811600860 A CN 201811600860A CN 109490927 B CN109490927 B CN 109490927B
- Authority
- CN
- China
- Prior art keywords
- beacon
- array
- acoustic transceiver
- measuring
- coordinates
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 23
- 239000011159 matrix material Substances 0.000 claims abstract description 46
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims abstract description 9
- 230000033001 locomotion Effects 0.000 claims abstract description 8
- 238000005259 measurement Methods 0.000 claims description 47
- 238000012937 correction Methods 0.000 claims description 16
- 238000012545 processing Methods 0.000 claims description 15
- 238000004364 calculation method Methods 0.000 claims description 9
- 238000013178 mathematical model Methods 0.000 claims description 8
- 230000008569 process Effects 0.000 claims description 4
- 230000035515 penetration Effects 0.000 claims description 2
- 238000003672 processing method Methods 0.000 claims 1
- 230000006870 function Effects 0.000 description 11
- 238000009434 installation Methods 0.000 description 6
- 238000010276 construction Methods 0.000 description 4
- 230000005540 biological transmission Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 230000008447 perception Effects 0.000 description 2
- 230000008859 change Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 230000013011 mating Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008092 positive effect Effects 0.000 description 1
- 230000008054 signal transmission Effects 0.000 description 1
- 239000004575 stone Substances 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Classifications
-
- 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
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
-
- 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/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
-
- 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
- G01S1/00—Beacons or beacon systems transmitting signals having a characteristic or characteristics capable of being detected by non-directional receivers and defining directions, positions, or position lines fixed relatively to the beacon transmitters; Receivers co-operating therewith
- G01S1/02—Beacons or beacon systems transmitting signals having a characteristic or characteristics capable of being detected by non-directional receivers and defining directions, positions, or position lines fixed relatively to the beacon transmitters; Receivers co-operating therewith using radio waves
-
- 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
- G01S1/00—Beacons or beacon systems transmitting signals having a characteristic or characteristics capable of being detected by non-directional receivers and defining directions, positions, or position lines fixed relatively to the beacon transmitters; Receivers co-operating therewith
- G01S1/02—Beacons or beacon systems transmitting signals having a characteristic or characteristics capable of being detected by non-directional receivers and defining directions, positions, or position lines fixed relatively to the beacon transmitters; Receivers co-operating therewith using radio waves
- G01S1/022—Means for monitoring or calibrating
-
- 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/06—Systems determining the position data of a target
-
- 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/86—Combinations of sonar systems with lidar systems; Combinations of sonar systems with systems not using wave reflection
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Acoustics & Sound (AREA)
- Automation & Control Theory (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
本发明公开了一种水下整平架定位系统,包括位于水下的整平架、测量船、定位信标系统、基阵信标系统和基阵信标校准系统;定位信标系统包括若干设置在整平架上的定位信标;基阵信标系统包括若干设置在整平区域四周的基阵信标;基阵信标校准系统,包括用于定位的GPS,用于测量测量船艏向的罗经,用于测量测量船运动姿态的姿态传感器,及用于测量与基阵信标和定位信标之间距离的声学收发器,GPS、罗经、姿态传感器和声学收发器均固定在测量船上;测量船在基阵信标校准时位于基阵信标上方,测量船在整平架定位时位于整平架上方。本发明还公开了一种水下整平架定位方法。本发明实现整平架在水下绝对定位和高精度相对定位,提高了整平作业效率。
Description
技术领域
本发明涉及一种整平架定位系统及定位方法,特别涉及一种水下整平架定位系统及其定位方法。
背景技术
目前,国内越来越多的跨河、跨海通道都采用沉管法修建,其突出优点是埋深浅、截面大,较短的路隧过渡段就可承担大流量的交通,是城市中心区域最适宜的跨河、跨海通道。基础整平是沉管法修建隧道中至关重要的一个工序,通常采用具有升降支腿的大型平台式整平船进行整平作业,其定位均采用两个以上的GPS。但这种平台式整平船造价高昂,操作复杂,制作周期长,一般均为专用工程定制,通用性较差,而且插拔桩存在较高风险,遇到台风撤离程序也较复杂。目前国内已有沉管隧道工程试验采用水下整平架进行基础整平施工,GPS只能在水面以上定位,无法对水下整平架进行定位。
发明内容
本发明为解决公知技术中存在的技术问题而提供一种能够精确定位的水下整平架定位系统及其定位方法。
本发明为解决公知技术中存在的技术问题所采取的技术方案是:一种水下整平架定位系统,包括位于水下的整平架,还包括测量船、定位信标系统、基阵信标系统和基阵信标校准系统;所述定位信标系统包括若干个设置在所述整平架上的定位信标;所述基阵信标系统包括若干个设置在整平区域四周的基阵信标;所述基阵信标校准系统,包括用于定位的GPS,用于测量所述测量船艏向的罗经,用于测量所述测量船运动姿态的姿态传感器,以及用于测量与所述基阵信标和所述定位信标之间距离的声学收发器,所述GPS、所述罗经、所述姿态传感器和所述声学收发器均固定在所述测量船上;所述测量船在基阵信标校准时位于基阵信标上方,所述测量船在整平架定位时位于所述整平架上方。
进一步地,所述定位信标设有四个,分别安装在所述整平架的四个角点上。
进一步地,所述基阵信标布设成长方形阵列。
进一步地,所述长方形阵列的长边侧设置三个所述基阵信标,所述长方形阵列的短边侧设置两个所述基阵信标。
进一步地,其中所述声学收发器安装在所述测量船的舷侧,其入水深度超过船底。
进一步地,还包括数据处理系统,所述数据处理系统接收来自所述GPS、所述罗经、所述姿态传感器和所述声学收发器的信号并处理。
本发明还提供一种利用上述水下整平架定位系统的水下整平架定位方法,该方法包括如下步骤:
步骤一,在整平区域四周布设长方形的基阵信标;
步骤二,在测量船上安装固定GPS、罗经、姿态传感器和声学收发器;
步骤三,用GPS测量其本体的地理坐标,用罗经测量船艏向;用姿态传感器测量船运动姿态;测量GPS和声学收发器的三维偏移量;
步骤四,使测量船位于其中一个基阵信标上方,进行基阵信标的校准,计算各个基阵信标相对大地坐标系的位置坐标;
步骤五,在整平架本体上安装固定定位信标;
步骤六,将整平架放置在水下工程初始区域;
步骤七,使测量船位于整平架上方,用声学收发器测量基阵信标和定位信标之间距离R;
步骤八,根据基阵信标位置和距离R,计算各个定位信标位置,从而确定整平架的位置;
步骤九,移动整平架和测量船,重复步骤六至步骤八直至整平工程结束。
进一步地,所述步骤四的具体方法为,首先根据步骤三测量的数据,计算声学收发器三维坐标位置;再使用声学收发器测量其与各个基阵信标的距离;然后构建以声学收发器三维坐标、各个基阵信标三维坐标以及声学收发器与各个基阵信标间距离为参数的数学模型,求得各个基阵信标三维坐标。
进一步地,计算声学收发器的三维坐标位置的计算公式为式1至式3:
XT=XG+dx*sinH*cosP (式1)
YT=YG+dy*cosH*cosK (式2)
ZT=ZG+dz*cosK*cosP (式3)
其中,式1至式3中:
XT,为声学收发器的X向坐标;
YT,为声学收发器的Y向坐标;
ZT,为声学收发器的Z向坐标;
XG,为GPS的X向坐标;
YG,为GPS的Y向坐标;
ZG,为GPS的Z向坐标;
H,为测量船的艏向;
K,为测量船的横摇角;
P,为测量船的纵摇角;
dx,为声学收发器和GPS间X向偏移量;
dy,为声学收发器和GPS间Y向偏移量;
dz,为声学收发器和GPS间Z向偏移量。
进一步地,所述数学模型按照间接平差的原理,其构建步骤为:
步骤a-1,首先构建声学收发器至某基阵信标之间的距离函数:
L=f(x)+Δl (式4)
步骤a-2,对距离函数进行线性化得到如下公式:
步骤a-3,求得误差方程为:
步骤a-4,测量船沿此基阵信标做圆周运行,每次测量都可以得到声学收发器和此基阵信标之间的距离,设共有n条测量距离,则可构建如下矩阵:
l=BXS (式7)
则有:
XS= (BTB) -1BTl (式8)
其中:
ΔLi=Δli+Li-f(x)i 0, (式10)
则得到基阵信标的坐标为:
其中式4至式14中,
Xs,为声学收发器与基阵信标之间的距离改正数函数;
B,为待求系数;
L,为声学收发器至基阵信标之间斜距离的测量值;
l,为声学收发器至基阵信标之间斜距离真值;
Δl,为声学收发器至基阵信标之间斜距离真值的测量误差;
f(x),为声学收发器至基阵信标之间的距离函数;
Li,为声学收发器至基阵信标之间第i次测量的斜距离的测量值,i=1,n;
Δli,为声学收发器至基阵信标之间第i次测量的斜距离真值的测量误差,i=1,n;
f(x)0 i,为声学收发器至基阵信标之间第i次测量的距离函数,i=1,n;
为声学收发器至基阵信标之间坐标的改正数;
为声学收发器至基阵信标之间坐标的改正数;
为声学收发器至基阵信标之间坐标的改正数;
Xi,为第i次测量时声学收发器的X向坐标,i=1,n;
Yi,为第i次测量时声学收发器的Y向坐标,i=1,n;
Zi,为第i次测量时声学收发器的Z向坐标,i=1,n;
X,为基阵信标坐标的X向坐标的真值;
Y,为基阵信标坐标的Y向坐标的真值;
Z,为基阵信标坐标的Z向坐标的真值;
X0,为基阵信标坐标的X向坐标的近似值;
Y0,为基阵信标坐标的Y向坐标的近似值;
Z0,为基阵信标坐标的Z向坐标的近似值。
本发明具有的优点和积极效果是:通过船载的基阵信标校准系统,将绝对位置传递给每个基阵信标,基阵信标通过相互之间的声学测距和平差处理,得到高精度的相对位置;装在整平架上的定位信标,通过与基阵信标之间的声学测距,交会得到整平架的位置,并实现相邻两幅基础条带之间的精准搭接。从而实现整平架在水下的绝对定位和比较高精度的相对定位,使得整平后基础条带之间的拼接更加精准,提高了整平作业的效率。
附图说明
图1是本发明的工作原理示意图;
图2是本发明中的定位信标系统和基阵信标系统的信标布局示意图。
图中:101、第一基阵信标;102、第二基阵信标;103、第三基阵信标;104、第四基阵信标;105、第五基阵信标;106、第六基阵信标;200、整平架;201、第一定位信标;202、第二定位信标;203、第三定位信标;204、第四定位信标。
具体实施方式
为能进一步了解本发明的发明内容、特点及功效,兹列举以下实施例,并配合附图详细说明如下:
请参见图1至图2,一种水下整平架定位系统,包括位于水下的整平架200,还包括测量船、定位信标系统、基阵信标系统和基阵信标校准系统;所述定位信标系统包括若干个设置在所述整平架200上的定位信标;所述基阵信标系统包括若干个设置在整平区域四周的基阵信标;所述基阵信标校准系统,包括用于定位的GPS,用于测量所述测量船艏向的罗经,用于测量所述测量船运动姿态的姿态传感器,以及用于测量与所述基阵信标和所述定位信标之间距离的声学收发器,所述GPS、所述罗经、所述姿态传感器和所述声学收发器均固定在所述测量船上;所述测量船在基阵信标校准时位于基阵信标上方,所述测量船在整平架200定位时位于所述整平架200上方。所述声学收发器是指发送和接收水下声学信号的换能器,比如Sonardyne Fusion系列的Dunker 6声学收发器等。
进一步地,为便于安装和定位,所述定位信标可设有四个,包括第一定位信标201、第二定位信标202、第三定位信标203以及第四定位信标204,四个所述定位信标可分别对应安装在所述整平架200的四个角点上。即第一定位信标201可位于四个角点的第一个角点上;第二定位信标202可位于四个角点的第二个角点上;第三定位信标203可位于四个角点的第三个角点上;第四定位信标204可位于四个角点的第四个角点上。
进一步地,为便于校准计算定位信标相对基阵信标的位置,所述基阵信标可布设成长方形阵列。进一步地,为便于安装和计算,所述长方形阵列的长边侧可设置三个所述基阵信标,所述长方形阵列的短边侧可设置两个所述基阵信标。如图2所示,可包括第一基阵信标101、第二基阵信标102、第三基阵信标103、第四基阵信标104、第五基阵信标105以及第六基阵信标106;这六个基阵信标排列成长方形,长边可设置三个基阵信标,短边侧可设置两个基阵信标。为沉管是长方形,这样布置可以覆盖整个沉管范围,且便于安装在深挖的基槽中。
进一步地,为便于安装和匹配所述整平架200,所述基阵信标的间距可为40-50m。
进一步地,为提高测量精度,所述基阵信标距水底的高度可为2-2.5m。
进一步地,为减少声波多路径反射干扰,其中所述声学收发器可安装在所述测量船的舷侧,其入水深度可超过船底,即所述声学收发器位于船底的下方。
进一步地,还可包括安装架,所述安装架固定在所述测量船上,所述GPS、所述罗经、所述姿态传感器和声学收发器可分别固定安装在所述安装架上。
进一步地,还可包括如计算机等数据处理系统,所述数据处理系统可接收来自所述GPS、所述罗经、所述姿态传感器和所述声学收发器的信号并处理。数据处理系统可以是计算机,也可以是以微处理器CPU为核心,相应配置存贮器、无线信号收发器等模块,组成能够进行数据处理运算的数据处理系统。
进一步地,还可包括显示器,所述显示器可接收来自所述数据处理系统的信号并显示。
本发明还提供一种利用上述水下整平架定位系统的水下整平架定位方法实施例,该实施例包括如下步骤:
步骤一,在整平区域四周布设长方形的基阵信标;
步骤二,在测量船上安装固定GPS、罗经、姿态传感器和声学收发器;可采用安装架,将GPS、罗经、姿态传感器和声学收发器固定在安装架上,再将安装架固定在测量船上;
步骤三,用GPS测量其本体的地理坐标,用罗经测量船艏向;用姿态传感器测量船运动姿态,包括测量船的横摇角和纵摇角等;测量GPS和声学收发器的三维偏移量;可用尺子,或其他测量装置,来测量GPS中心点至声学收发器的中心点三维偏移量。如果有安装架,则通过安装架两个安装点的三维投影求得;也可以用全站仪,直接观测GPS中心和声学收发器中心的三维坐标,这样就可以得到两个设备的三维相对关系,即三维偏移量。
步骤四,使测量船位于其中一个基阵信标上方,进行基阵信标的校准,计算各个基阵信标相对大地坐标系的位置坐标;
步骤五,在整平架本体上安装固定定位信标;
步骤六,将整平架放置在水下工程初始区域;
步骤七,使测量船位于整平架上方,用声学收发器测量基阵信标和定位信标之间距离R;
步骤八,根据基阵信标位置和距离R,计算各个定位信标位置,从而确定整平架的位置;
步骤九,移动整平架和测量船,重复步骤六至步骤八直至整平工程结束。
进一步地,所述步骤四的具体方法可为,首先根据步骤三测量的数据,计算声学收发器三维坐标位置;再使用声学收发器测量其与各个基阵信标的距离;然后构建以声学收发器三维坐标、各个基阵信标三维坐标以及声学收发器与各个基阵信标间距离为参数的数学模型,求得各个基阵信标三维坐标。
进一步地,计算声学收发器的三维坐标位置的计算公式可为式1至式3:
XT=XG+dx*sinH*cosP (式1)
YT=YG+dy*cosH*cosK (式2)
ZT=ZG+dz*cosK*cosP (式3)
其中,式1至式3中:
XT,为声学收发器的X向坐标;
YT,为声学收发器的Y向坐标;
ZT,为声学收发器的Z向坐标;
XG,为GPS的X向坐标;
YG,为GPS的Y向坐标;
ZG,为GPS的Z向坐标;
H,为测量船的艏向;
K,为测量船的横摇角;
P,为测量船的纵摇角;
dx,为声学收发器和GPS间X向偏移量;
dy,为声学收发器和GPS间Y向偏移量;
dz,为声学收发器和GPS间Z向偏移量。
进一步地,所述数学模型可按照间接平差的原理,其构建步骤可为:
步骤a-1,首先构建声学收发器至某基阵信标之间的距离函数:
L=f(x)+Δl (式4)
步骤a-2,对距离函数进行线性化得到如下公式:
步骤a-3,求得误差方程为:
步骤a-4,测量船沿此基阵信标做圆周运行,每次测量都可以得到声学收发器和此基阵信标之间的距离,设共有n条测量距离,则可构建如下矩阵:
l=BXS (式7)
则有:
XS= (BTB) -1BTl (式8)
其中:
ΔLi=Δli+Li-f(x)i 0, (式10)
则得到基阵信标的坐标为:
其中式4至式14中,
Xs,为声学收发器与基阵信标之间的距离改正数函数;
B,为待求系数;
L,为声学收发器至基阵信标之间斜距离的测量值;
l,为声学收发器至基阵信标之间斜距离真值;
Δl,为声学收发器至基阵信标之间斜距离真值的测量误差;
f(x),为声学收发器至基阵信标之间的距离函数;
Li,为声学收发器至基阵信标之间第i次测量的斜距离的测量值,i=1,n;
Δli,为声学收发器至基阵信标之间第i次测量的斜距离真值的测量误差,i=1,n;
f(x)0 i,为声学收发器至基阵信标之间第i次测量的距离函数,i=1,n;
为声学收发器至基阵信标之间坐标的改正数;
为声学收发器至基阵信标之间坐标的改正数;
为声学收发器至基阵信标之间坐标的改正数;
Xi,为第i次测量时声学收发器的X向坐标,i=1,n;
Yi,为第i次测量时声学收发器的Y向坐标,i=1,n;
Zi,为第i次测量时声学收发器的Z向坐标,i=1,n;
X,为基阵信标坐标的X向坐标的真值;
Y,为基阵信标坐标的Y向坐标的真值;
Z,为基阵信标坐标的Z向坐标的真值;
X0,为基阵信标坐标的X向坐标的近似值;
Y0,为基阵信标坐标的Y向坐标的近似值;
Z0,为基阵信标坐标的Z向坐标的近似值。
本发明的工作原理:
定位信标和基阵信标均可采用英国Sonardyne公司制造的Compatt 6G型号的信标。声学收发器可发送命令给定位信标,要求定位信标进行测距。定位信标发射声学信号至基阵信标,并记录发射时刻t1,基阵信标接收到声学信号后随即返回一个声学信号给定位信标,定位信标记录接收到返回声学信号的时刻t2,则定位信标和基阵信标的距离s=V*(t2-t1)/2,V为水下的声速,即距离等于速度乘以时间。定位信标将得到的距离信号发送给声学收发器,上述所有信号传输均采用无线传输方式。
(1)基阵信标位置的计算
设GPS测量的地理坐标为(XG,YG,ZG),罗经得到的艏向为H,姿态传感器得到的横摇角为K,纵摇角为P,船载声学收发器的地理坐标为(X,Y,Z),声学收发器和GPS间的三维偏移量为(dx,dy,dz),则声学收发器的坐标为:
X=XG+dx*sinH*cosP (式1)
Y=YG+dy*cosH*cosK (式2)
Z=ZG+dz*cosK*cosP (式3)
声学收发器的地理坐标为(X,Y,Z),设待测定的海底基阵信标的坐标为(X0,Y0,Z0),两者之间的斜距离真值为L,测量误差为Δl,f(x)为声学收发器至基阵信标之间的距离函数,L表达为:
L=f(x)+Δl (式4)
对上式线性化得:
则误差方程为:
由n条测量距离构建如下矩阵形式:
l=BXS (式7)
则有:
XS= (BTB) -1BTl (式8)
其中:
ΔLi=Δli+Li-f(x)i 0, (式10)
则可得到基阵信标的坐标为:
采用上述计算方法,以此类推,这样就可得到全部海底基阵信标的坐标。
按照该方法就可以以此计算出六个基阵信标的位置坐标。比如第一基阵信标101的坐标为(X101,Y101,Z101),第二基阵信标102为(X102,Y102,Z102),第三基阵信标103为(X103,Y103,Z103),第四基阵信标104为(X104,Y104,Z104),第五基阵信标105为(X105,Y105,Z105),第六基阵信标106为(X106,Y106,Z106)
(2)定位信标位置的计算
以第一定位信标201位置计算为例进行说明。设第一定位信标201位置坐标为(X201,Y201,Z201),第一基阵信标101的坐标为(X101,Y101,Z101),第二基阵信标102为(X102,Y102,Z102),第三基阵信标103为(X103,Y103,Z103),第四基阵信标104为(X104,Y104,Z104),第五基阵信标105为(X105,Y105,Z105),第六基阵信标106为(X106,Y106,Z106)。
定位信标发出声学信号,被基阵信标感知,基阵信标感知声学信号后通过无线方式向声学收发器等数据处理装置发送感知信号,计算机等数据处理系统根据基阵信标的信号,进行计算得定位信标与基阵信标的实测距离R101的相关参数。
比如:第一定位信标201发出声学信号,被第一基阵信标101感知,第一基阵信标101感知声学信号后通过无线方式向声学收发器等数据处理装置发送感知信号,计算机等数据处理系统根据第一基阵信标101的信号,进行计算得第一定位信标201与第一基阵信标101的实测距离R101的相关参数。
同理:可得到第一定位信标201与第二基阵信标102的实测距离为R102,第一定位信标201与第三基阵信标103的为R103,第一定位信标201与第四基阵信标104的的实测距离为R104,第一定位信标201与第五基阵信标105的的实测距离为R105,第一定位信标201与第六基阵信标106的的实测距离为R106,
则有:
通过解上述方程,根据测量平差理论,就可以得到第一定位信标201的位置坐标,同理依次得到第二定位信标202、第三定位信标203以及第四定位信标204的坐标,可计算得到:第一定位信标201位置坐标为(X201,Y201,Z201),第二定位信标202位置坐标为(X202,Y202,Z202),第三定位信标203位置坐标为(X203,Y203,Z203),第四定位信标204位置坐标为(X204,Y204,Z204),这样整平架200的位置就可以得到。
整平架200定位到沉管隧道整平设计施工区域后,随即开始本幅区域的基础整平作业,整平结束后,整平架200和测量船移动到下一幅区域,基阵信标系统布放在水底,其位置不会发生变动,因此可以精确得到整平架200在两幅区域的相对位置关系,确保碎石沟垄的精准搭接。
以上所述的实施例仅用于说明本发明的技术思想及特点,其目的在于使本领域内的技术人员能够理解本发明的内容并据以实施,不能仅以本实施例来限定本发明的专利范围,即凡本发明所揭示的精神所作的同等变化或修饰,仍落在本发明的专利范围内。
Claims (7)
1.一种水下整平架定位系统,包括位于水下的整平架,其特征在于,还包括测量船、定位信标系统、基阵信标系统和基阵信标校准系统;所述定位信标系统包括若干个设置在所述整平架上的定位信标;所述基阵信标系统包括若干个设置在整平区域四周的基阵信标;所述基阵信标校准系统,包括用于定位的GPS,用于测量所述测量船艏向的罗经,用于测量所述测量船运动姿态的姿态传感器,以及用于测量与所述基阵信标和所述定位信标之间距离的声学收发器,所述GPS、所述罗经、所述姿态传感器和所述声学收发器均固定在所述测量船上;所述测量船在基阵信标校准时位于基阵信标上方,所述测量船在整平架定位时位于所述整平架上方;
还包括数据处理系统,所述数据处理系统接收来自所述GPS、所述罗经、所述姿态传感器和所述声学收发器的信号并处理;
数据处理系统的数据处理方法如下:
首先根据下述数据:GPS的地理坐标、船艏向、船运动姿态、GPS和声学收发器的三维偏移量,计算声学收发器三维坐标位置;再使用声学收发器测量其与各个基阵信标的距离;然后构建以声学收发器三维坐标、各个基阵信标三维坐标以及声学收发器与各个基阵信标间距离为参数的数学模型,求得各个基阵信标三维坐标;
所述数学模型按照间接平差的原理,其构建步骤为:
步骤a-1,首先构建声学收发器至某基阵信标之间的距离函数:
L=f(x)+Δl (式4)
步骤a-2,对距离函数进行线性化得到如下公式:
步骤a-3,求得误差方程为:
步骤a-4,测量船沿此基阵信标做圆周运行,每次测量都可以得到声学收发器和此基阵信标之间的距离,设共有n条测量距离,则可构建如下矩阵:
l=BXS (式7)
则有:
XS=(BTB)-1BTl (式8)
其中:
ΔLi=Δli+Li-f(x)i 0, (式10)
则得到基阵信标的坐标为:
其中式4至式14中,
Xs,为声学收发器与基阵信标之间的距离改正数函数;
B,为待求系数;
L,为声学收发器至基阵信标之间斜距离的测量值;
l,为声学收发器至基阵信标之间斜距离真值;
Δl,为声学收发器至基阵信标之间斜距离真值的测量误差;
f(x),为声学收发器至基阵信标之间的距离函数;
Li,为声学收发器至基阵信标之间第i次测量的斜距离的测量值,i=1,n;
Δli,为声学收发器至基阵信标之间第i次测量的斜距离真值的测量误差,i=1,n;
f(x)0 i,为声学收发器至基阵信标之间第i次测量的距离函数,i=1,n;
为声学收发器至基阵信标之间坐标的改正数;
为声学收发器至基阵信标之间坐标的改正数;
为声学收发器至基阵信标之间坐标的改正数;
Xi,为第i次测量时声学收发器的X向坐标,i=1,n;
Yi,为第i次测量时声学收发器的Y向坐标,i=1,n;
Zi,为第i次测量时声学收发器的Z向坐标,i=1,n;
X,为基阵信标坐标的X向坐标的真值;
Y,为基阵信标坐标的Y向坐标的真值;
Z,为基阵信标坐标的Z向坐标的真值;
X0,为基阵信标坐标的X向坐标的近似值;
Y0,为基阵信标坐标的Y向坐标的近似值;
Z0,为基阵信标坐标的Z向坐标的近似值。
2.根据权利要求1所述的水下整平架定位系统,其特征在于,所述定位信标设有四个,分别安装在所述整平架的四个角点上。
3.根据权利要求1所述的水下整平架定位系统,其特征在于,所述基阵信标布设成长方形阵列。
4.根据权利要求3所述的水下整平架定位系统,其特征在于,所述长方形阵列的长边侧设置三个所述基阵信标,所述长方形阵列的短边侧设置两个所述基阵信标。
5.根据权利要求1所述的水下整平架定位系统,其特征在于,其中所述声学收发器安装在所述测量船的舷侧,其入水深度超过船底。
6.一种利用权利要求1所述的水下整平架定位系统的水下整平架定位方法,其特征在于,包括如下步骤:
步骤一,在整平区域四周布设长方形的基阵信标;
步骤二,在测量船上安装固定GPS、罗经、姿态传感器和声学收发器;
步骤三,用GPS测量其本体的地理坐标,用罗经测量船艏向;用姿态传感器测量船运动姿态;测量GPS和声学收发器的三维偏移量;
步骤四,使测量船位于其中一个基阵信标上方,进行基阵信标的校准,计算各个基阵信标相对大地坐标系的位置坐标;
步骤五,在整平架本体上安装固定定位信标;
步骤六,将整平架放置在水下工程初始区域;
步骤七,使测量船位于整平架上方,用声学收发器测量基阵信标和定位信标之间距离R;
步骤八,根据基阵信标位置和距离R,计算各个定位信标位置,从而确定整平架的位置;
步骤九,移动整平架和测量船,重复步骤六至步骤八直至整平工程结束;
所述步骤四的具体方法为,首先根据步骤三测量的数据,计算声学收发器三维坐标位置;再使用声学收发器测量其与各个基阵信标的距离;然后构建以声学收发器三维坐标、各个基阵信标三维坐标以及声学收发器与各个基阵信标间距离为参数的数学模型,求得各个基阵信标三维坐标;
所述数学模型按照间接平差的原理,其构建步骤为:
步骤a-1,首先构建声学收发器至某基阵信标之间的距离函数:
L=f(x)+Δl (式4)
步骤a-2,对距离函数进行线性化得到如下公式:
步骤a-3,求得误差方程为:
步骤a-4,测量船沿此基阵信标做圆周运行,每次测量都可以得到声学收发器和此基阵信标之间的距离,设共有n条测量距离,则可构建如下矩阵:
l=BXS (式7)
则有:
XS=(BTB)-1BTl (式8)
其中:
ΔLi=Δli+Li-f(x)i 0, (式10)
则得到基阵信标的坐标为:
其中式4至式14中,
Xs,为声学收发器与基阵信标之间的距离改正数函数;
B,为待求系数;
L,为声学收发器至基阵信标之间斜距离的测量值;
l,为声学收发器至基阵信标之间斜距离真值;
Δl,为声学收发器至基阵信标之间斜距离真值的测量误差;
f(x),为声学收发器至基阵信标之间的距离函数;
Li,为声学收发器至基阵信标之间第i次测量的斜距离的测量值,i=1,n;
Δli,为声学收发器至基阵信标之间第i次测量的斜距离真值的测量误差,i=1,n;
f(x)0 i,为声学收发器至基阵信标之间第i次测量的距离函数,i=1,n;
为声学收发器至基阵信标之间坐标的改正数;
为声学收发器至基阵信标之间坐标的改正数;
为声学收发器至基阵信标之间坐标的改正数;
Xi,为第i次测量时声学收发器的X向坐标,i=1,n;
Yi,为第i次测量时声学收发器的Y向坐标,i=1,n;
Zi,为第i次测量时声学收发器的Z向坐标,i=1,n;
X,为基阵信标坐标的X向坐标的真值;
Y,为基阵信标坐标的Y向坐标的真值;
Z,为基阵信标坐标的Z向坐标的真值;
X0,为基阵信标坐标的X向坐标的近似值;
Y0,为基阵信标坐标的Y向坐标的近似值;
Z0,为基阵信标坐标的Z向坐标的近似值。
7.根据权利要求6所述的水下整平架定位方法,其特征在于,计算声学收发器的三维坐标位置的计算公式为式1至式3:
XT=XG+dx*sinH*cosP (式1)
YT=YG+dy*cosH*cosK (式2)
ZT=ZG+dz*cosK*cosP (式3)
其中,式1至式3中:
XT,为声学收发器的X向坐标;
YT,为声学收发器的Y向坐标;
ZT,为声学收发器的Z向坐标;
XG,为GPS的X向坐标;
YG,为GPS的Y向坐标;
ZG,为GPS的Z向坐标;
H,为测量船的艏向;
K,为测量船的横摇角;
P,为测量船的纵摇角;
dx,为声学收发器和GPS间X向偏移量;
dy,为声学收发器和GPS间Y向偏移量;
dz,为声学收发器和GPS间Z向偏移量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811600860.3A CN109490927B (zh) | 2018-12-26 | 2018-12-26 | 一种水下整平架定位系统及其定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811600860.3A CN109490927B (zh) | 2018-12-26 | 2018-12-26 | 一种水下整平架定位系统及其定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109490927A CN109490927A (zh) | 2019-03-19 |
CN109490927B true CN109490927B (zh) | 2024-04-09 |
Family
ID=65712223
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811600860.3A Active CN109490927B (zh) | 2018-12-26 | 2018-12-26 | 一种水下整平架定位系统及其定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109490927B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110309581B (zh) * | 2019-06-27 | 2022-11-01 | 哈尔滨工程大学 | 一种水下潜标位置综合校准测量点快速优化布局方法 |
CN110261824B (zh) * | 2019-07-15 | 2024-03-19 | 交通运输部天津水运工程科学研究所 | 一种基于多信标的超短基线标定系统及标定方法 |
CN111678490B (zh) * | 2020-05-29 | 2022-02-22 | 交通运输部天津水运工程科学研究所 | 一种座底自升式水下整平架监测及调节系统 |
CN112540340B (zh) * | 2020-11-26 | 2024-04-30 | 博雅工道(北京)机器人科技有限公司 | 精度误差补偿方法和基于该方法的自校准声信标定位设备 |
CN115983046B (zh) * | 2023-02-27 | 2023-07-14 | 中交天津港湾工程研究院有限公司 | 一种预测预制结构运动轨迹的水下精准对接方法 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05297138A (ja) * | 1992-04-17 | 1993-11-12 | Oki Electric Ind Co Ltd | 水中航走体の位置検出装置及びその位置検出方法 |
CN101806884A (zh) * | 2010-04-23 | 2010-08-18 | 哈尔滨工程大学 | 基于超短基线的深海信标绝对位置精确定位方法 |
CN103792595A (zh) * | 2014-02-27 | 2014-05-14 | 中国电子科技集团公司第四十一研究所 | 用于定位水下运动磁目标的磁传感器阵列校准方法 |
CN204166132U (zh) * | 2014-10-24 | 2015-02-18 | 天津水运工程勘察设计院 | 一种基于网络的多船水上水下定位系统 |
KR101700044B1 (ko) * | 2015-10-02 | 2017-01-25 | 창원대학교 산학협력단 | 복수의 gps 수신기 및 음향 측심기를 이용한 3차원 수중 지형정보 측량 시스템 및 방법 |
CN106546954A (zh) * | 2016-11-09 | 2017-03-29 | 哈尔滨工程大学 | 一种深海超短基线定位精度检验方法 |
CN107990891A (zh) * | 2016-10-26 | 2018-05-04 | 中国科学院沈阳自动化研究所 | 基于长基线和信标在线标定的水下机器人组合导航方法 |
CN108562872A (zh) * | 2018-03-23 | 2018-09-21 | 淮海工学院 | 一种超短基线水下声学定位校准时异常值探测的方法 |
CN108802737A (zh) * | 2018-05-25 | 2018-11-13 | 哈尔滨工程大学 | 一种用于浅水域水下定位的超短基线系统及校准方法 |
CN209400703U (zh) * | 2018-12-26 | 2019-09-17 | 交通运输部天津水运工程科学研究所 | 一种水下整平架定位系统 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB0900390D0 (en) * | 2009-01-12 | 2009-02-11 | Sonardyne Internat Ltd | Subsea measurement system and method of determining a subsea location-related parameter |
FR3006770B1 (fr) * | 2013-06-05 | 2016-12-09 | Ixblue | Procede et dispositif de metrologie pour la calibration de la geometrie d'un reseau de balises acoustiques sous-marines |
-
2018
- 2018-12-26 CN CN201811600860.3A patent/CN109490927B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH05297138A (ja) * | 1992-04-17 | 1993-11-12 | Oki Electric Ind Co Ltd | 水中航走体の位置検出装置及びその位置検出方法 |
CN101806884A (zh) * | 2010-04-23 | 2010-08-18 | 哈尔滨工程大学 | 基于超短基线的深海信标绝对位置精确定位方法 |
CN103792595A (zh) * | 2014-02-27 | 2014-05-14 | 中国电子科技集团公司第四十一研究所 | 用于定位水下运动磁目标的磁传感器阵列校准方法 |
CN204166132U (zh) * | 2014-10-24 | 2015-02-18 | 天津水运工程勘察设计院 | 一种基于网络的多船水上水下定位系统 |
KR101700044B1 (ko) * | 2015-10-02 | 2017-01-25 | 창원대학교 산학협력단 | 복수의 gps 수신기 및 음향 측심기를 이용한 3차원 수중 지형정보 측량 시스템 및 방법 |
CN107990891A (zh) * | 2016-10-26 | 2018-05-04 | 中国科学院沈阳自动化研究所 | 基于长基线和信标在线标定的水下机器人组合导航方法 |
CN106546954A (zh) * | 2016-11-09 | 2017-03-29 | 哈尔滨工程大学 | 一种深海超短基线定位精度检验方法 |
CN108562872A (zh) * | 2018-03-23 | 2018-09-21 | 淮海工学院 | 一种超短基线水下声学定位校准时异常值探测的方法 |
CN108802737A (zh) * | 2018-05-25 | 2018-11-13 | 哈尔滨工程大学 | 一种用于浅水域水下定位的超短基线系统及校准方法 |
CN209400703U (zh) * | 2018-12-26 | 2019-09-17 | 交通运输部天津水运工程科学研究所 | 一种水下整平架定位系统 |
Non-Patent Citations (3)
Title |
---|
LBL长基线系统精度测试与分析;赵永春;应用技术;第123-124页 * |
超短基线声学定位系统的校准技术研究;唐秋华;吴永亭;丁继胜;杨龙;刘焱雄;;声学技术(第04期);第281-287页 * |
超短基线水声定位系统基阵安装误差校准方法研究;张修志;张吟;;水雷战与舰船防护;20120815(第03期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN109490927A (zh) | 2019-03-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109490927B (zh) | 一种水下整平架定位系统及其定位方法 | |
CN103399326B (zh) | 一种gnss动态测量精度检验系统及方法 | |
CN101441267B (zh) | 海底应答器绝对位置三测点高精度标校方法 | |
CN101334267B (zh) | 数字影像测头矢量坐标变换标定与误差修正方法及其装置 | |
CN101517358B (zh) | 使用室内全球定位系统的三维测量系统和重新标度方法 | |
CN103454619A (zh) | 一种星载微波跟瞄雷达的电轴光学标定系统及其标定方法 | |
CN108151698B (zh) | 一种基于轴线相交法的天线旋转中心标校方法 | |
CN111190204B (zh) | 基于北斗双天线和激光测距仪的实时定位装置及定位方法 | |
CN103983219B (zh) | 一种大尺寸平面度的在位测量方法 | |
CN102080960A (zh) | 基于gps的超高层建筑物垂直度测控方法 | |
CN104563469A (zh) | 一种用于墙面抹灰机器人的垂直度测量与补偿系统及方法 | |
CN108168504B (zh) | 一种基于拟合球心法的天线旋转中心标校方法 | |
CN107576939A (zh) | 一种基于虚拟测距信标的单信标测距定位方法 | |
CN107479078A (zh) | 铁路测量中大地坐标转换为独立平面坐标的方法及系统 | |
CN110824430A (zh) | 基于北斗定位系统的水下定位方法 | |
KR101700044B1 (ko) | 복수의 gps 수신기 및 음향 측심기를 이용한 3차원 수중 지형정보 측량 시스템 및 방법 | |
CN107727118B (zh) | 大型飞行器中的gnc分系统设备姿态测量系统标定方法 | |
CN204831274U (zh) | 一种便携式水平高差测量架及测量装置 | |
JP7219201B2 (ja) | 三次元計測システム | |
CN106772635B (zh) | 一种基于扫描交汇的地下电缆三维定位装置及定位方法 | |
CN102564417A (zh) | 非接触式动态主动定位方法 | |
CN109297453B (zh) | 衬砌台车弧形模板的线形测量方法 | |
CN104316031A (zh) | 线微动等效精密高程观测法 | |
CN209400703U (zh) | 一种水下整平架定位系统 | |
CN102121825A (zh) | 一种利用gps测量跨河水准高差的方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |