CN110261824B - 一种基于多信标的超短基线标定***及标定方法 - Google Patents
一种基于多信标的超短基线标定***及标定方法 Download PDFInfo
- Publication number
- CN110261824B CN110261824B CN201910635423.3A CN201910635423A CN110261824B CN 110261824 B CN110261824 B CN 110261824B CN 201910635423 A CN201910635423 A CN 201910635423A CN 110261824 B CN110261824 B CN 110261824B
- Authority
- CN
- China
- Prior art keywords
- usbl
- transducer
- coordinate
- coordinate system
- matrix
- 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 30
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims abstract description 41
- 238000012360 testing method Methods 0.000 claims abstract description 35
- 238000005259 measurement Methods 0.000 claims abstract description 32
- 230000030279 gene silencing Effects 0.000 claims abstract description 17
- 238000005452 bending Methods 0.000 claims abstract description 15
- 238000012937 correction Methods 0.000 claims abstract description 14
- 230000008030 elimination Effects 0.000 claims abstract description 13
- 238000003379 elimination reaction Methods 0.000 claims abstract description 13
- 239000011159 matrix material Substances 0.000 claims description 144
- 238000006243 chemical reaction Methods 0.000 claims description 12
- 230000009466 transformation Effects 0.000 claims description 6
- 230000008569 process Effects 0.000 claims description 4
- 101150037531 sinR gene Proteins 0.000 claims 2
- 238000010276 construction Methods 0.000 abstract description 2
- 238000009434 installation Methods 0.000 description 8
- 238000004364 calculation method Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000013016 damping Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000013307 optical fiber Substances 0.000 description 1
- 230000008092 positive effect Effects 0.000 description 1
- 230000000630 rising effect Effects 0.000 description 1
- 238000005096 rolling process Methods 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
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/18—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using ultrasonic, sonic, or infrasonic waves
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
本发明公开了一种基于多信标的超短基线标定***,包括换能器、姿态仪、全站仪、声速计、消声试验水池以及多个信标;多个信标布置在消声试验水池的池底;换能器和姿态仪,两者固定连接且两者的艏向相近,两者均浸入消声试验水池的水中;消声试验水池外设有两个已知坐标的控制点;全站仪以控制点作为坐标参考点对每个信标、换能器和姿态仪进行三维坐标测量;声速计测量水池内的声速剖面,对换能器的坐标测量结果进行声线弯曲修正。本发明还提供一种基于多信标的超短基线标定方法。本发明通过一体化安装的超短基线换能器和姿态仪,在室内水池通过多信标进行精确标定,节约时间,在海上应急救捞施工中,极大地提高水下定位的工作效率。
Description
技术领域
本发明涉及一种超短基线标定***及标定方法,特别涉及一种基于多信标的超短基线标定***及标定方法。
背景技术
目前,超短基线水下定位时,需要GPS、姿态仪、声速计等辅助设备才能得到信标的绝对位置。实际工作中,各种设备所在的坐标系并不能保证在同一坐标下,各设备所在的坐标系之间存在位置偏差和角度偏差,如GPS天线和换能器中心点存在位置偏差,换能器和姿态仪之间会存在三轴的角度偏差等。GPS天线和换能器通过测杆刚性连接在一起后,其位置偏差可以通过全站仪精确测得;水下声学定位时的声线弯曲,可以通过声速计精确测得;而换能器和姿态仪之间的三轴角度偏差,即艏向Heading偏差、纵摇Pitch偏差和横摇Roll偏差却很难直接得到。传统方法是将所有设备安装到船上后,使船舶沿特定线路运行,通过迭代计算得到安装的角度偏差值,但这种方法极大的影响实际工程效率,其准确性也难以保证。
发明内容
本发明为解决公知技术中存在的技术问题而提供一种高效的基于多信标的超短基线标定***及标定方法。
本发明为解决公知技术中存在的技术问题所采取的技术方案是:一种基于多信标的超短基线标定***,包括换能器、姿态仪、全站仪、声速计、消声试验水池以及多个信标;所述多个信标布置在所述消声试验水池的池底;所述换能器和所述姿态仪,两者固定连接且两者的艏向相近,两者均浸入所述消声试验水池的水中;所述消声试验水池外设有两个已知坐标的控制点;所述全站仪以所述控制点作为坐标参考点对每个所述信标、所述换能器和所述姿态仪进行三维坐标测量;所述声速计测量水池内的声速剖面,对所述换能器的坐标测量结果进行声线弯曲修正。
进一步地,所述信标为五个,其中四个所述信标布设在正方形的四个角点,一个所述信标布设在正方形的中心点。
进一步地,所述消声试验水池的水深≥6m,所述中心点至所述角点距离为3~5m。
进一步地,还包括一对法兰;所述换能器和所述姿态仪,两者并排接入该对法兰之间,且两者的同侧端面均与该对法兰的其中一个法兰固接。
进一步地,所述控制点坐标系为CGCS2000坐标系下的空间直角坐标。
本发明还提供了一种基于多信标的超短基线标定方法,该方法为:设置消声试验水池,将多个信标布设在池底,将相互固定连接且艏向相近的换能器和姿态仪均浸入消声试验水池的水中,在消声试验水池外设有两个已知坐标的控制点;采用全站仪以控制点作为坐标参考点对每个信标、换能器和姿态仪进行三维坐标测量;采用声速计测量水池内的声速剖面,对换能器的坐标测量结果进行声线弯曲修正;换能器以一定的频率重复测量信标位置并得到多个观测值,根据测量平差原理列出观测值的误差方程式,求解方程得到换能器角度值,将计算得出的换能器角度值与姿态仪实际测量值之间的差值作为标定值。
进一步地,将姿态仪的数据输入到换能器中,同时按照计算的校准值对其姿态数据进行修正,启动换能器测量信标的位置,将换能器测量值与全站仪的观测值进行比较,以检验标定值的准确性。
进一步地,采用五个信标,在正方形的四个角点各布设一个信标,作为公共点;在正方形的中心点布设一个信标,作为检查点。
进一步地,由全站仪测量得到信标、换能器和姿态仪的坐标均为CGCS2000坐标,由换能器测量并经声线弯曲修正得到的信标坐标是以换能器中心点为原点的相对坐标,经过坐标转换后,列出观测值的误差方程式。
进一步地,设CGCS2000坐标系为O-XCGCS YCGCS ZCGCS,设以换能器中心点为原点的相对坐标系为O-XUSBLYUSBLZUSBL,列出观测值的误差方程式的具体步骤为:
步骤一,保持OZUSBL轴不动,将O-XUSBL轴和O-YUSBL轴旋转角度H,旋转后的坐标轴设为OX′、OY′、OZ′,则有:
式中:
X′为绕O-XUSBL和O-YUSBL轴旋转角度H后X坐标;
Y′为绕O-XUSBL和O-YUSBL轴旋转角度H后Y坐标;
Z′为绕O-XUSBL和O-YUSBL轴旋转角度H后Z坐标;
XUSBL为换能器坐标系下的X坐标;
YUSBL为换能器坐标系下的Y坐标;
ZUSBL为换能器坐标系下的Z坐标;
H为Z轴旋转角度;
步骤二,保持O Y′轴不动,将OX′轴和OZ′轴旋转角度R,旋转后的坐标轴设为OX″、OY″、OZ″,则有:
式中:
X′为绕O-XUSBL和O-YUSBL轴旋转角度H后X坐标;
Y′为绕O-XUSBL和O-YUSBL轴旋转角度H后Y坐标;
Z′为绕O-XUSBL和O-YUSBL轴旋转角度H后Z坐标;
X″为绕OX′和OZ′轴旋转角度R后的X坐标;
Y″为绕OX′和OZ′轴旋转角度R后的Y坐标;
Z″为绕OX′和OZ′轴旋转角度R后的Z坐标;
R为Y轴旋转角度;
步骤三,保持OX″轴不动,将OY″轴和OZ″轴旋转角度P,旋转后的坐标轴设为OXCGCS、OYCGCS、OZCGCS,则有:
式中:
XCGCS为信标的CGCS2000坐标系下的X坐标;
YCGCS为信标的CGCS2000坐标系下的Y坐标;
ZCGCS为信标的CGCS2000坐标系下的Z坐标;
X″为绕OX′和OZ′轴旋转角度R后的X坐标;
Y″为绕OX′和OZ′轴旋转角度R后的Y坐标;
Z″为绕OX′和OZ′轴旋转角度R后的Z坐标;
P为X轴旋转角度;
步骤四,将式1-1代入式1-2,再代入式1-3,换能器中心点在CGCS2000坐标系及以换能器中心点为原点的相对坐标系中的坐标差值即为全站仪测量得到的换能器中心点的CGCS2000坐标,设其为(XT,YT,ZT),则有:
其中:
r1,1=cos H cos R;
r1,2=cos H sin R sin P+sin H cos P;
r1,3=sin H sin P-cos H sin R cos P;
r2,1=-sin H cos R;
r2,2=cos H cos P-sin H sin R sin P;
r2,3=sin H sin R cos P+cos H sin P;
r3,1=sin R;
r3,2=-cos R sin P;
r3,3=cos R cos P;
式中:
XCGCS为信标的CGCS2000坐标系下的X坐标;
YCGCS为信标的CGCS2000坐标系下的Y坐标;
ZCGCS为信标的CGCS2000坐标系下的Z坐标;
XUSBL为换能器坐标系下的X坐标;
YUSBL为换能器坐标系下的Y坐标;
ZUSBL为换能器坐标系下的Z坐标;
r1,1为矩阵第1行第1列的数值;
r1,2为矩阵第1行第2列的数值;
r1,3为矩阵第1行第3列的数值;
r2,1为矩阵第2行第1列的数值;
r2,2为矩阵第2行第2列的数值;
r2,3为矩阵第2行第3列的数值;
r3,1为矩阵第3行第1列的数值;
r3,2为矩阵第3行第2列的数值;
r3,3为矩阵第3行第3列的数值;
H为Z轴旋转角度;
P为X轴旋转角度;
R为Y轴旋转角度;
XT为换能器中心点的CGCS2000坐标系下的X坐标;
YT为换能器中心点的CGCS2000坐标系下的Y坐标;
ZT为换能器中心点的CGCS2000坐标系下的Z坐标;
步骤五,设旋转矩阵对式1-4进行泰勒级数展开,忽略二次项及其以上项,可得:
其中
其中:
T11=-sin R cos PdR-cos R sin HdH;
T12=(-sin P sin H+cos P sin R cos H)dP+(cos P cos H-sin P sin R sinH)dH+sin P cos R cos HdR;
T13=(cos P sin H+sin P sin R cos H)dP+(sin P cos H+cos P sin R sin H)dH+cos P cos R cos HdR;
T21=sin R sin HdR-cos R cos HdH;
T22=(-sin P cos H+cos P sin R sin H)dP-(cos P sin H-cos P sin R cosH)dH+sin P cos R sin HdR;
T23=(cos P cos H+sin P sin R sin H)dP-(sin P sin H+cos P sin R cos H)dH-cos P cos R sin HdR;
T31=cos RdR;
T32=-cos P cos RdP+sin P sin RdR;
T33=-sin P cos RdP-cos P sin RdR;
式中:
XCGCS为信标的CGCS2000坐标系下的X坐标;
YCGCS为信标的CGCS2000坐标系下的Y坐标;
ZCGCS为信标的CGCS2000坐标系下的Z坐标;
XUSBL为换能器坐标系下的X坐标;
YUSBL为换能器坐标系下的Y坐标;
ZUSBL为换能器坐标系下的Z坐标;
H为Z轴旋转角度;
P为X轴旋转角度;
R为Y轴旋转角度;
r1,1为矩阵第1行第1列的数值;
r1,2为矩阵第1行第2列的数值;
r1,3为矩阵第1行第3列的数值;
r2,1为矩阵第2行第1列的数值;
r2,2为矩阵第2行第2列的数值;
r2,3为矩阵第2行第3列的数值;
r3,1为矩阵第3行第1列的数值;
r3,2为矩阵第3行第2列的数值;
r3,3为矩阵第3行第3列的数值;
XT为换能器中心点的CGCS2000坐标系下的X坐标;
YT为换能器中心点的CGCS2000坐标系下的Y坐标;
ZT为换能器中心点的CGCS2000坐标系下的Z坐标;
T为旋转矩阵;
T0为旋转矩阵初值;
dT为旋转矩阵的导数;
T11为旋转矩阵第1行第1列的数值;
T12为旋转矩阵第1行第2列的数值;
T13为旋转矩阵第1行第3列的数值;
T21为旋转矩阵第2行第1列的数值;
T22为旋转矩阵第2行第2列的数值;
T23为旋转矩阵第2行第3列的数值;
T31为旋转矩阵第3行第1列的数值;
T32为旋转矩阵第3行第2列的数值;
T33为旋转矩阵第3行第3列的数值;
步骤六,将式1-5进行变换,则有:
其中:
其中:
B11=sin R cos H(YUSBL cos P+ZUSBL sin P)+sin H(ZUSBL cos P-YUSBL sin P);
B12=cos R cos H(YUSBL sin P+ZUSBL cos P)-XUSBL sin R cos P;
B13=XUSBL cos R sin H+sin R sin H(ZUSBL cos P-YUSBL sin P)+cos H(YUSBL cosP+ZUSBL sin P);
B21=cos H(ZUSBL cos P-YUSBL sin P)+sin R sin H(YUSBL cos P+ZUSBL sin P);
B22=XUSBL sin R sin H+cos R sin H(YUSBL sin P-ZUSBL cos P);
B23=-XUSBL cos R cos H-sin H(YUSBL cos P+ZUSBL sin P)+cos P sin R cos H(YUSBL-ZUSBL);
B31=-cos R(YUSBL cos P+ZUSBL sin P);
B32=XUSBL cos R+sin R(YUSBL sin P-ZUSBL cos P);
B33=0;
式中:
XCGCS为信标的CGCS2000坐标系下的X坐标;
YCGCS为信标的CGCS2000坐标系下的Y坐标;
ZCGCS为信标的CGCS2000坐标系下的Z坐标;
XUSBL为换能器坐标系下的X坐标;
YUSBL为换能器坐标系下的Y坐标;
ZUSBL为换能器坐标系下的Z坐标;
XT为换能器中心点的CGCS2000坐标系下的X坐标;
YT为换能器中心点的CGCS2000坐标系下的Y坐标;
ZT为换能器中心点的CGCS2000坐标系下的Z坐标;
H为Z轴旋转角度;
P为X轴旋转角度;
R为Y轴旋转角度;
T0为旋转矩阵初值;
dT为旋转矩阵的导数;
为待求的未知数;
dP为X轴旋转角度的导数;
dR为Y轴旋转角度的导数;
dH为Z轴旋转角度的导数;
B为误差方程系数矩阵;
B11为系数矩阵第1行第1列的数值;
B12为系数矩阵第1行第2列的数值;
B13为系数矩阵第1行第3列的数值;
B21为系数矩阵第2行第1列的数值;
B22为系数矩阵第2行第2列的数值;
B23为系数矩阵第2行第3列的数值;
B31为系数矩阵第3行第1列的数值;
B32为系数矩阵第3行第2列的数值;
B33为系数矩阵第3行第3列的数值;
步骤七,按照最小二乘原理,将式1-6化为误差方程:
式中,
其中:
XCGCS为信标的CGCS2000坐标系下的X坐标;
YCGCS为信标的CGCS2000坐标系下的Y坐标;
ZCGCS为信标的CGCS2000坐标系下的Z坐标;
XUSBL为换能器坐标系下的X坐标;
YUSBL为换能器坐标系下的Y坐标;
ZUSBL为换能器坐标系下的Z坐标;
XT为换能器中心点的CGCS2000坐标系下的X坐标;
YT为换能器中心点的CGCS2000坐标系下的Y坐标;
ZT为换能器中心点的CGCS2000坐标系下的Z坐标;
T0为旋转矩阵初值;
V为测量误差值;
为待求的未知数;
B为误差方程系数矩阵;
l为在CGCS2000坐标系及以换能器中心点为原点的相对坐标系中的坐标差值。
本发明具有的优点和积极效果是:通过一体化安装的超短基线换能器和姿态仪,在室内水池通过多信标进行精确标定,得到超短基线换能器和姿态仪的角度安装偏差。在海上应急救捞施工中,可以避免繁琐的安装校准工作,节约时间,极大地提高水下定位的工作效率。
附图说明
图1是本发明的***结构示意图;
图2是本发明中的信标分布与控制点分布示意图。
图中:1、第一控制点;2、换能器;3、姿态仪;4、消声试验水池;5、全站仪;6、第二控制点;7、声速计;8、第一信标;9、第二信标;10、第五信标;11、第三信标;12、第四信标。
具体实施方式
为能进一步了解本发明的发明内容、特点及功效,兹列举以下实施例,并配合附图详细说明如下:
为能进一步了解本发明的发明内容、特点及功效,兹列举以下实施例,并配合附图详细说明如下:
请参见图1至图2,一种基于多信标的超短基线标定***,包括换能器2、姿态仪3、全站仪5、声速计7、消声试验水池4以及多个信标;所述多个信标布置在所述消声试验水池4的池底;所述换能器2和所述姿态仪3,两者固定连接且两者的艏向相近,两者均浸入所述消声试验水池4的水中;所述消声试验水池4外设有两个已知坐标的控制点;所述控制点包括第一控制点1和第二控制点6;所述全站仪5以所述控制点作为坐标参考点对每个所述信标、所述换能器2和所述姿态仪3进行三维坐标测量;即所述全站仪5将已知坐标的第一控制点1和第二控制点6作为坐标参考点,对每个所述信标、所述换能器2和所述姿态仪3进行三维坐标测量。所述声速计7测量水池内的声速剖面,对所述换能器2的坐标测量结果进行声线弯曲修正。所述声速计7测量水池内的声速剖面方法可为将声速计7从水面逐渐放到水底,测垂向剖面的声速。
换能器2用于测量信标的坐标,换能器2可采用超短基线型换能器,可选现有技术中的产品,比如可选型号为Sonardyne Ranger2型等换能器。
姿态仪3用于测量换能器2三轴姿态角度,可选现有技术中的产品,比如可选iXBlue公司生产的Octans3000型等姿态仪,Octans3000型姿态仪基于iXBlue的光纤罗经技术,Octans3000可输出艏向、纵横摇、升沉、转速以及加速度。
全站仪5用于测量信标和换能器2的三维坐标,可选现有技术中的产品,比如可选Leica TS06型等全站仪。采用全站仪5可精确测量信标和换能器2中心点的坐标。
声速计7用于测量水中的声速,可选现有技术中的产品,比如可选HY1200型等声速计。
信标用于收发换能器2的声学信号,可选现有技术中的产品,比如可选WSM6G型等信标。
请参见图1,所述信标可为五个,其中四个所述信标可布设在正方形的四个角点,一个所述信标布可设在正方形的中心点。可在正方形的四个角点可各布设一个信标,如图中第一信标8、第二信标9、第三信标11、第四信标12布置在正方形的四个角点,作为公共点;在正方形的中心点可布设一个信标,如第五信标10,将其作为检查点。
所述消声试验水池4的水深可≥6m,上述正方形的中心点至正方形的角点距离可为3~5m。
进一步地,该***还可包括一对法兰;所述换能器2和所述姿态仪3,两者可并排接入该对法兰之间,且两者的同侧端面均与该对法兰的其中一个法兰固接。所述换能器2和所述姿态仪3,两者的两侧端面共同与相同的法兰固接,能够保证两者的位置相对稳定。通过一对法兰将换能器2和姿态仪3刚性连接在一起,所述法兰的精度能确保换能器2和姿态仪3每次拆卸再安装之后两者的三轴角度偏差不发生改变。
进一步地,所述控制点坐标系可为CGCS2000坐标系下的空间直角坐标。
上述***,通过法兰将换能器2和姿态仪3刚性连接在一起,在一消声试验水池4布设信标阵,来标定换能器2三轴角度偏差;一对法兰的精度要确保换能器2和姿态仪3每次拆卸再安装之后两者的三轴角度偏差不发生改变,同时换能器2的艏向和姿态仪3的艏向大致对齐。采用全站仪5精确测量信标和换能器2中心点的坐标。向消声试验水池4内注水,使信标和换能器2全部浸入水中。采用声速计7测量消声试验水池4内的声速剖面,对超短基线的声学定位换能器2进行声线弯曲改正。
本发明还提供了一种基于多信标的超短基线标定方法实施例,该标定方法为:设置消声试验水池4,将多个信标布设在池底,将相互固定连接且艏向相近的换能器2和姿态仪3均浸入消声试验水池4的水中,在消声试验水池4外设有两个已知坐标的控制点;采用全站仪5以控制点作为坐标参考点对每个信标、换能器2和姿态仪3进行三维坐标测量;采用声速计7测量水池内的声速剖面,对换能器2的坐标测量结果进行声线弯曲修正;换能器2以一定的频率重复测量信标位置并得到多个观测值,根据测量平差原理列出观测值的误差方程式,求解方程得到换能器2角度值,将计算得出的换能器2角度值与姿态仪3实际测量值之间的差值作为标定值。
进一步地,可将姿态仪3的数据输入到换能器2中,同时按照计算的校准值对其姿态数据进行修正,启动换能器2测量信标的位置,可将换能器2测量值与全站仪5的观测值进行比较,以检验标定值的准确性。
进一步地,可采用五个信标,在正方形的四个角点可各布设一个信标,如图中第一信标8、第二信标9、第三信标11、第四信标12布置在正方形的四个角点,作为公共点;在正方形的中心点可布设一个信标,如第五信标10,将其作为检查点。
进一步地,由全站仪5测量得到信标、换能器2和姿态仪3的坐标可均为CGCS2000坐标,由换能器2测量并经声线弯曲修正得到的信标坐标是以换能器2中心点为原点的相对坐标,可经过坐标转换后,列出观测值的误差方程式。
考虑到换能器2艏向校准涉及到真北方向,因此在标定校准前需要在水池周边建立两个控制点,控制点坐标系为CGCS2000坐标系下的空间直角坐标。控制点的坐标北和真北方向存在偏差角,即子午线收敛角γ,其计算方法如下:
γ=(L-L0)SinG (1)
式1中:L0为中央子午线的经度,L、G分别是校准地点的经度和纬度。
真北方位角就是坐标北方位角和子午线收敛角之和,由于距离中央子午线越远,子午线收敛角越大,在标定超短基线艏向时必须考虑子午线收敛角γ的影响。
可采用全站仪5精确测量信标和换能器2中心点等的坐标,可设信标坐标为(Xqi,Yqi,Zqi),其中i代表信标序号,比如i=1,2,3,4,5,分别代表第一信标8至第五信标10。向水池内注水,使信标和换能器2全部浸入水中。采用声速计7测量水池内的声速剖面,对超短基线的换能器2声学定位进行声线弯曲改正。
可将第一信标8、第二信标9、第三信标11、第四信标12作为两个坐标系的公共点,将第五信标10作为检查点。由于超短基线的换能器2可以一定的频率重复测量信标位置,因此可以得到多个观测值,这样就可以根据测量平差原理列出观测值的误差方程式,组成并解算法方程,从而求得转换参数,即H(艏向Heading)、P(纵倾Pitch)和R(横倾Roll)等角度值。全站仪5观测得到的换能器2艏向是以坐标北为零方向,而姿态仪3得到的艏向是以真北为零方向,设γ为子午线收敛角,因此艏向的标定值H标为:
H标=H+γ (2)
上述计算得到的角度值与姿态仪3实际测量值之间的差值,就是换能器2和姿态仪3一体化安装后的三轴偏差,即安装标定值。
可将姿态仪3的数据输入到超短基线的换能器2中,同时可按照计算的校准值对其姿态数据进行修正,可启动换能器2测量某一个或几个信标的位置,比如测量第五信标10的位置,可将超短基线的换能器2的测量值与全站仪5的观测值进行比较,以检验安装标定值的准确性。
由全站仪5测量得到信标、换能器2和姿态仪3的坐标均为CGCS2000坐标,由超短基线的换能器2测量并经声线弯曲修正得到的信标坐标是以换能器2中心点为原点的相对坐标,所以要通过坐标转换才能得到三个旋转角,即H(艏向Heading)、P(纵倾Pitch)和R(横倾Roll)。在三维空间直角坐标系中,两个坐标系的变换需要在三个坐标平面上,分别通过三次转轴才能完成。经过坐标转换后,可列出观测值的误差方程式。
可设CGCS2000坐标系为O-XCGCS YCGCS ZCGCS,设以换能器2中心点为原点的相对坐标系为O-XUSBLYUSBLZUSBL,列出观测值的误差方程式的具体步骤可如下:
步骤一,可保持OZUSBL轴不动,可将O-XUSBL轴和O-YUSBL轴旋转角度H,旋转后的坐标轴可设为OX′、OY′、OZ′,则有:
式中:
X′为绕O-XUSBL和O-YUSBL轴旋转角度H后X坐标;即X坐标绕O-XUSBL和O-YUSBL轴旋转角度H后的坐标为X′;
Y′为绕O-XUSBL和O-YUSBL轴旋转角度H后Y坐标;即Y坐标绕O-XUSBL和O-YUSBL轴旋转角度H后的坐标为Y′;
Z′为绕O-XUSBL和O-YUSBL轴旋转角度H后Z坐标;即Z坐标绕O-XUSBL和O-YUSBL轴旋转角度H后的坐标为Z′;
XUSBL为换能器坐标系下的X坐标;即XUSBL为换能器中心点为原点的坐标系下的X坐标;
YUSBL为换能器坐标系下的Y坐标;即YUSBL为换能器中心点为原点的坐标系下的Y坐标;
ZUSBL为换能器坐标系下的Z坐标;即ZUSBL为换能器中心点为原点的坐标系下的Z坐标;
H为Z轴旋转角度;
步骤二,可保持O Y′轴不动,可将OX′轴和OZ′轴旋转角度R,旋转后的坐标轴可设为OX″、OY″、OZ″,则有:
/>
式中:
X′为绕O-XUSBL和O-YUSBL轴旋转角度H后X坐标;
Y′为绕O-XUSBL和O-YUSBL轴旋转角度H后Y坐标;
Z′为绕O-XUSBL和O-YUSBL轴旋转角度H后Z坐标;
X″为绕OX′和OZ′轴旋转角度R后的X坐标;即X坐标绕OX′和OZ′轴旋转角度R后的坐标为X″;
Y″为绕OX′和OZ′轴旋转角度R后的Y坐标;即Y坐标绕OX′和OZ′轴旋转角度R后的坐标为Y″;
Z″为绕OX′和OZ′轴旋转角度R后的Z坐标;即Z坐标绕OX′和OZ′轴旋转角度R后的坐标为Z″;
R为Y轴旋转角度;
步骤三,可保持OX″轴不动,可将OY″轴和OZ″轴旋转角度P,旋转后的坐标轴可设为OXCGCS、OYCGCS、OZCGCS,则有:
式中:
XCGCS为信标的CGCS2000坐标系下的X坐标;
YCGCS为信标的CGCS2000坐标系下的Y坐标;
ZCGCS为信标的CGCS2000坐标系下的Z坐标;
X″为绕OX′和OZ′轴旋转角度R后的X坐标;
Y″为绕OX′和OZ′轴旋转角度R后的Y坐标;
Z″为绕OX′和OZ′轴旋转角度R后的Z坐标;
P为X轴旋转角度;
步骤四,可将式1-1代入式1-2,再代入式1-3,换能器中心点在CGCS2000坐标系及以换能器中心点为原点的相对坐标系中的坐标差值即为全站仪测量得到的换能器中心点的CGCS2000坐标,可设其为(XT,YT,ZT),则可有:
其中:
r1,1=cos H cos R;
r1,2=cos H sin R sin P+sin H cos P;
r1,3=sin H sin P-cos H sin R cos P;
r2,1=-sin H cos R;
r2,2=cos H cos P-sin H sin R sin P;
r2,3=sin H sin R cos P+cos H sin P;
r3,1=sin R;
r3,2=-cos R sin P;
r3,3=cos R cos P;
式中:
XCGCS为信标的CGCS2000坐标系下的X坐标;
YCGCS为信标的CGCS2000坐标系下的Y坐标;
ZCGCS为信标的CGCS2000坐标系下的Z坐标;
XUSBL为换能器坐标系下的X坐标;
YUSBL为换能器坐标系下的Y坐标;
ZUSBL为换能器坐标系下的Z坐标;
r1,1为矩阵第1行第1列的数值;
r1,2为矩阵第1行第2列的数值;
r1,3为矩阵第1行第3列的数值;
r2,1为矩阵第2行第1列的数值;
r2,2为矩阵第2行第2列的数值;
r2,3为矩阵第2行第3列的数值;
r3,1为矩阵第3行第1列的数值;
r3,2为矩阵第3行第2列的数值;
r3,3为矩阵第3行第3列的数值;
H为Z轴旋转角度;
P为X轴旋转角度;
R为Y轴旋转角度;
XT为换能器中心点的CGCS2000坐标系下的X坐标;
YT为换能器中心点的CGCS2000坐标系下的Y坐标;
ZT为换能器中心点的CGCS2000坐标系下的Z坐标;
步骤五,对于大角度的坐标转换,可采用非线性模型来代替线性模型进行参数求解,
可设旋转矩阵可对式1-4进行泰勒级数展开,可忽略二次项及其以上项,可得:
其中
其中:
T11=-sin R cos PdR-cos R sin HdH;
T12=(-sin P sin H+cos P sin R cos H)dP+(cos P cos H-sin P sin R sinH)dH+sin P cos R cos HdR;
T13=(cos P sin H+sin P sin R cos H)dP+(sin P cos H+cos P sin R sin H)dH+cos P cos R cos HdR;
T21=sin R sin HdR-cos R cos HdH;
T22=(-sin P cos H+cos P sin R sin H)dP-(cos P sin H-cos P sin R cosH)dH+sin P cos R sin HdR;
T23=(cos P cos H+sin P sin R sin H)dP-(sin P sin H+cos P sin R cos H)dH-cos P cos R sin HdR;
T31=cos RdR;
T32=-cos P cos RdP+sin P sin RdR;
T33=-sin P cos RdP-cos P sin RdR;
式中:
XCGCS为信标的CGCS2000坐标系下的X坐标;
YCGCS为信标的CGCS2000坐标系下的Y坐标;
ZCGCS为信标的CGCS2000坐标系下的Z坐标;
XUSBL为换能器坐标系下的X坐标;
YUSBL为换能器坐标系下的Y坐标;
ZUSBL为换能器坐标系下的Z坐标;
H为Z轴旋转角度;
P为X轴旋转角度;
R为Y轴旋转角度;
r1,1为矩阵第1行第1列的数值;
r1,2为矩阵第1行第2列的数值;
r1,3为矩阵第1行第3列的数值;
r2,1为矩阵第2行第1列的数值;
r2,2为矩阵第2行第2列的数值;
r2,3为矩阵第2行第3列的数值;
r3,1为矩阵第3行第1列的数值;
r3,2为矩阵第3行第2列的数值;
r3,3为矩阵第3行第3列的数值;
XT为换能器中心点的CGCS2000坐标系下的X坐标;
YT为换能器中心点的CGCS2000坐标系下的Y坐标;
ZT为换能器中心点的CGCS2000坐标系下的Z坐标;
T为旋转矩阵;
T0为旋转矩阵初值;
dT为旋转矩阵的导数;
T11为旋转矩阵第1行第1列的数值;
T12为旋转矩阵第1行第2列的数值;
T13为旋转矩阵第1行第3列的数值;
T21为旋转矩阵第2行第1列的数值;
T22为旋转矩阵第2行第2列的数值;
T23为旋转矩阵第2行第3列的数值;
T31为旋转矩阵第3行第1列的数值;
T32为旋转矩阵第3行第2列的数值;
T33为旋转矩阵第3行第3列的数值;
步骤六,可将式1-5进行变换,则有:
其中:
其中:
B11=sin R cos H(YUSBL cos P+ZUSBL sin P)+sin H(ZUSBL cos P-YUSBL sin P);
B12=cos R cos H(YUSBL sin P+ZUSBL cos P)-XUSBL sin R cos P;
B13=XUSBL cos R sin H+sin R sin H(ZUSBL cos P-YUSBL sin P)+cos H(YUSBL cosP+ZUSBL sin P);
B21=cos H(ZUSBL cos P-YUSBL sin P)+sin R sin H(YUSBL cos P+ZUSBL sin P);
B22=XUSBL sin R sin H+cos R sin H(YUSBL sin P-ZUSBL cos P);
B23=-XUSBL cos R cos H-sin H(YUSBL cos P+ZUSBL sin P)+cos P sin R cos H(YUSBL-ZUSBL);
B31=-cos R(YUSBL cos P+ZUSBL sin P);
B32=XUSBL cos R+sin R(YUSBL sin P-ZUSBL cos P);
B33=0;
式中:
XCGCS为信标的CGCS2000坐标系下的X坐标;
YCGCS为信标的CGCS2000坐标系下的Y坐标;
ZCGCS为信标的CGCS2000坐标系下的Z坐标;
XUSBL为换能器坐标系下的X坐标;
YUSBL为换能器坐标系下的Y坐标;
ZUSBL为换能器坐标系下的Z坐标;
XT为换能器中心点的CGCS2000坐标系下的X坐标;
YT为换能器中心点的CGCS2000坐标系下的Y坐标;
ZT为换能器中心点的CGCS2000坐标系下的Z坐标;
H为Z轴旋转角度;
P为X轴旋转角度;
R为Y轴旋转角度;
T0为旋转矩阵初值;
dT为旋转矩阵的导数;
为待求的未知数;
dP为X轴旋转角度的导数;
dR为Y轴旋转角度的导数;
dH为Z轴旋转角度的导数;
B为误差方程系数矩阵;
B11为系数矩阵第1行第1列的数值;
B12为系数矩阵第1行第2列的数值;
B13为系数矩阵第1行第3列的数值;
B21为系数矩阵第2行第1列的数值;
B22为系数矩阵第2行第2列的数值;
B23为系数矩阵第2行第3列的数值;
B31为系数矩阵第3行第1列的数值;
B32为系数矩阵第3行第2列的数值;
B33为系数矩阵第3行第3列的数值;
步骤七,可按照最小二乘原理,将式1-6化为误差方程:
式中,
其中:
XCGCS为信标的CGCS2000坐标系下的X坐标;
YCGCS为信标的CGCS2000坐标系下的Y坐标;
ZCGCS为信标的CGCS2000坐标系下的Z坐标;
XUSBL为换能器坐标系下的X坐标;
YUSBL为换能器坐标系下的Y坐标;
ZUSBL为换能器坐标系下的Z坐标;
XT为换能器中心点的CGCS2000坐标系下的X坐标;
YT为换能器中心点的CGCS2000坐标系下的Y坐标;
ZT为换能器中心点的CGCS2000坐标系下的Z坐标;
T0为旋转矩阵初值;
V为测量误差值;
为待求的未知数;
B为误差方程系数矩阵;
l为在CGCS2000坐标系及以换能器2中心点为原点的相对坐标系中的坐标差值。
可利用4个信标的坐标,再可通过最小二乘进行迭代计算,即可求解参数的最优估值。求取转换参数过程可如下:
1)将3个参数初值取为:H0=0,P0=0,R0=0。
2)将参数初值代入式1-6,计算误差方程系数矩阵B,组成式1-7的误差方程。
3)利用最小二乘方法求取参数的改正数k代表迭代计算次数。
4)将本次得到的改正值与设定的阈值进行比较,若小于阈值则迭代结束,否则用前
一次迭代得到的转换参数近似值,加本次迭代值,作为新的转换参数近似值,
5)重复上述步骤2)至步骤3),直到获得满足要求的转换参数估值。
下面是本发明的一个具体实施例及其工作原理:
布设在消声试验水池4底部的五个信标,信标上方的超短基线换能器2,以及消声试验水池4外侧的2个控制点。所述消声试验水池4,其水深为6m;所述信标阵有五个信标组成,布设成正四边形,中心点一个信标,四角各一个信标,位于四角的信标分别为第一信标8、第二信标9、第三信标11、第四信标12;位于中心点的信标为第五信标10,中心点至角点距离优选为3.464m,即第一信标8、第二信标9、第三信标11及第四信标12距离第五信标10距离优选3.464m。
通过一对法兰将换能器2和姿态仪3刚性连接在一起,换能器2和姿态仪3上下并排放置,接在一对法兰之间,法兰的精度能确保换能器2和姿态仪3每次拆卸再安装之后两者的三轴角度偏差不发生改变,同时换能器2的艏向和姿态仪3的艏向大致对齐。
考虑到换能器2艏向校准涉及到真北方向,因此在标定校准前需要在水池周边建立两个控制点,控制点坐标系为CGCS2000坐标系下的空间直角坐标。控制点的坐标北和真北方向存在偏差角,即子午线收敛角γ,其计算方法如下:
γ=(L-L0)SinB (1)
式1中:L0为中央子午线的经度,L、B分别是校准地点的经度和纬度。
采用全站仪5精确测量五个信标和换能器2中心点的坐标,设信标坐标为(Xqi,Yqi,Zqi)(i=1,2,3,4,5,分别代表五个信标)。向水池内注水,使信标和换能器2全部浸入水中。采用声速计7测量水池内的声速剖面,对超短基线的换能器2声学定位进行声线弯曲改正。
全站仪5测量得到的信标和换能器2的坐标可均为CGCS2000坐标系的坐标,超短基线换能器2测量得到的信标坐标是以换能器2中心点为原点的相对坐标,需要通过坐标转换得到三个旋转角,即H(艏向Heading)、P(纵倾Pitch)和R(横倾Roll)。在三维空间直角坐标系中,两个坐标系的变换需要在三个坐标平面上,分别通过三次转轴才能完成。
第一信标8、第二信标9、第三信标11、第四信标12作为两个坐标系的公共点,第五信标10作为检查点。由于超短基线换能器2可以一定的频率重复测量信标位置,因此可以得到多个观测值,这样就可以根据测量平差原理列出观测值的误差方程式,组成并解算法方程,从而求得转换参数,即即H(艏向Heading)、P(纵倾Pitch)和R(横倾Roll)等角度值。全站仪5观测得到的换能器2艏向是以坐标北为零方向,而姿态仪3得到的艏向是以真北为零方向,因此艏向的标定值H标为:
H标=H+γ (2)
上述计算得到的角度值与姿态仪3实际测量值之间的差值,就是换能器2和姿态仪3一体化安装后的三轴偏差,即安装标定值。
最后将姿态仪3的数据输入到超短基线***中,同时按照计算的校准值对其姿态数据进行改正,启动换能器2测量信标的位置,将超短基线测量值与全站仪5的观测值进行比较,以检验安装标定值的准确性。
以上所述的实施例仅用于说明本发明的技术思想及特点,其目的在于使本领域内的技术人员能够理解本发明的内容并据以实施,不能仅以本实施例来限定本发明的专利范围,即凡本发明所揭示的精神所作的同等变化或修饰,仍落在本发明的专利范围内。
Claims (10)
1.一种基于多信标的超短基线标定***,其特征在于,包括换能器、姿态仪、全站仪、声速计、消声试验水池以及多个信标;所述多个信标布置在所述消声试验水池的池底;所述换能器和所述姿态仪,两者固定连接且两者的艏向相近,两者均浸入所述消声试验水池的水中;所述消声试验水池外设有两个已知坐标的控制点;所述全站仪以所述控制点作为坐标参考点对每个所述信标、所述换能器和所述姿态仪进行三维坐标测量;所述声速计测量水池内的声速剖面,对所述换能器的坐标测量结果进行声线弯曲修正。
2.根据权利要求1所述的基于多信标的超短基线标定***,其特征在于,所述信标为五个,其中四个所述信标布设在正方形的四个角点,一个所述信标布设在正方形的中心点。
3.根据权利要求2所述的基于多信标的超短基线标定***,其特征在于,所述消声试验水池的水深≥6m,所述中心点至所述角点距离为3~5m。
4.根据权利要求1所述的基于多信标的超短基线标定***,其特征在于,还包括一对法兰;所述换能器和所述姿态仪,两者并排接入该对法兰之间,且两者的同侧端面均与该对法兰的其中一个法兰固接。
5.根据权利要求1所述的基于多信标的超短基线标定***,其特征在于,所述控制点坐标系为CGCS2000坐标系下的空间直角坐标。
6.一种基于多信标的超短基线标定方法,其特征在于,设置消声试验水池,将多个信标布设在池底,将相互固定连接且艏向相近的换能器和姿态仪均浸入消声试验水池的水中,在消声试验水池外设有两个已知坐标的控制点;采用全站仪以控制点作为坐标参考点对每个信标、换能器和姿态仪进行三维坐标测量;采用声速计测量水池内的声速剖面,对换能器的坐标测量结果进行声线弯曲修正;换能器以一定的频率重复测量信标位置并得到多个观测值,根据测量平差原理列出观测值的误差方程式,求解方程得到换能器角度值,将计算得出的换能器角度值与姿态仪实际测量值之间的差值作为标定值。
7.根据权利要求6所述的基于多信标的超短基线标定方法,其特征在于,将姿态仪的数据输入到换能器中,同时按照计算的校准值对其姿态数据进行修正,启动换能器测量信标的位置,将换能器测量值与全站仪的观测值进行比较,以检验校准值的准确性。
8.根据权利要求6所述的基于多信标的超短基线标定方法,其特征在于,采用五个信标,在正方形的四个角点各布设一个信标,作为公共点;在正方形的中心点布设一个信标,作为检查点。
9.根据权利要求6所述的基于多信标的超短基线标定方法,其特征在于,由全站仪测量得到信标、换能器和姿态仪的坐标均为CGCS2000坐标,由换能器测量并经声线弯曲修正得到的信标坐标是以换能器中心点为原点的相对坐标,经过坐标转换后,列出观测值的误差方程式。
10.根据权利要求9所述的基于多信标的超短基线标定方法,其特征在于,设CGCS2000坐标系为O-XCGCS YCGCS ZCGCS,设以换能器中心点为原点的相对坐标系为O-XUSBLYUSBLZUSBL,列出观测值的误差方程式的具体步骤为:
步骤一,保持OZUSBL轴不动,将O-XUSBL轴和O-YUSBL轴旋转角度H,旋转后的坐标轴设为OX′、OY′、OZ′,则有:
式中:
X′为绕O-XUSBL和O-YUSBL轴旋转角度H后X坐标;
Y′为绕O-XUSBL和O-YUSBL轴旋转角度H后Y坐标;
Z′为绕O-XUSBL和O-YUSBL轴旋转角度H后Z坐标;
XUSBL为换能器坐标系下的X坐标;
YUSBL为换能器坐标系下的Y坐标;
ZUSBL为换能器坐标系下的Z坐标;
H为Z轴旋转角度;
步骤二,保持O Y′轴不动,将OX′轴和OZ′轴旋转角度R,旋转后的坐标轴设为OX″、OY″、OZ″,则有:
式中:
X′为绕O-XUSBL和O-YUSBL轴旋转角度H后X坐标;
Y′为绕O-XUSBL和O-YUSBL轴旋转角度H后Y坐标;
Z′为绕O-XUSBL和O-YUSBL轴旋转角度H后Z坐标;
X″为绕OX′和OZ′轴旋转角度R后的X坐标;
Y″为绕OX′和OZ′轴旋转角度R后的Y坐标;
Z″为绕OX′和OZ′轴旋转角度R后的Z坐标;
R为Y轴旋转角度;
步骤三,保持OX″轴不动,将OY″轴和OZ″轴旋转角度P,旋转后的坐标轴设为OXCGCS、OYCGCS、OZCGCS,则有:
式中:
XCGCS为信标的CGCS2000坐标系下的X坐标;
YCGCS为信标的CGCS2000坐标系下的Y坐标;
ZCGCS为信标的CGCS2000坐标系下的Z坐标;
X″为绕OX′和OZ′轴旋转角度R后的X坐标;
Y″为绕OX′和OZ′轴旋转角度R后的Y坐标;
Z″为绕OX′和OZ′轴旋转角度R后的Z坐标;
P为X轴旋转角度;
步骤四,将式1-1代入式1-2,再代入式1-3,信标在CGCS2000坐标系及以换能器中心点为原点的相对坐标系中的坐标差值即为全站仪测量得到的换能器中心点的CGCS2000坐标,设其为(XT,YT,ZT),则有:
其中:
r1,1=cosHcosR;
r1,2=cosHsinRsinP+sinHcosP;
r1,3=sinHsinP-cosHsinRcosP;
r2,1=-sinHcosR;
r2,2=cosHcosP-sinHsinRsinP;
r2,3=sinHsinRcosP+cosHsinP;
r3,1=sinR;
r3,2=-cosRsinP;
r3,3=cosRcosP;
式中:
XCGCS为信标的CGCS2000坐标系下的X坐标;
YCGCS为信标的CGCS2000坐标系下的Y坐标;
ZCGCS为信标的CGCS2000坐标系下的Z坐标;
XUSBL为换能器坐标系下的X坐标;
YUSBL为换能器坐标系下的Y坐标;
ZUSBL为换能器坐标系下的Z坐标;
r1,1为矩阵第1行第1列的数值;
r1,2为矩阵第1行第2列的数值;
r1,3为矩阵第1行第3列的数值;
r2,1为矩阵第2行第1列的数值;
r2,2为矩阵第2行第2列的数值;
r2,3为矩阵第2行第3列的数值;
r3,1为矩阵第3行第1列的数值;
r3,2为矩阵第3行第2列的数值;
r3,3为矩阵第3行第3列的数值;
H为Z轴旋转角度;
P为X轴旋转角度;
R为Y轴旋转角度;
XT为换能器中心点的CGCS2000坐标系下的X坐标;
YT为换能器中心点的CGCS2000坐标系下的Y坐标;
ZT为换能器中心点的CGCS2000坐标系下的Z坐标;
步骤五,设旋转矩阵对式1-4进行泰勒级数展开,忽略二次项及其以上项,可得:
其中
其中:
T11=-sinRcosPdR-cosRsinHdH;
T12=(-sinPsinH+cosPsinRcosH)dP+(cosPcosH-sinPsinRsinH)dH+sinPcosRcosHdR;
T13=(cosPsinH+sinPsinRcosH)dP+(sinPcosH+cosPsinRsinH)dH+cosPcosRcosHdR;
T21=sinRsinHdR-cosRcosHdH;
T22=(-sinPcosH+cosPsinRsinH)dP-(cosPsinH-cosPsinRcosH)dH+sinPcosRsinHdR;
T23=(cosPcosH+sinPsinRsinH)dP-(sinPsinH+cosPsinRcosH)dH-cosPcosRsinHdR;
T31=cosRdR;
T32=-cosPcosRdP+sinPsinRdR;
T33=-sinPcosRdP-cosPsinRdR;
式中:
XCGCS为信标的CGCS2000坐标系下的X坐标;
YCGCS为信标的CGCS2000坐标系下的Y坐标;
ZCGCS为信标的CGCS2000坐标系下的Z坐标;
XUSBL为换能器坐标系下的X坐标;
YUSBL为换能器坐标系下的Y坐标;
ZUSBL为换能器坐标系下的Z坐标;
H为Z轴旋转角度;
P为X轴旋转角度;
R为Y轴旋转角度;
r1,1为矩阵第1行第1列的数值;
r1,2为矩阵第1行第2列的数值;
r1,3为矩阵第1行第3列的数值;
r2,1为矩阵第2行第1列的数值;
r2,2为矩阵第2行第2列的数值;
r2,3为矩阵第2行第3列的数值;
r3,1为矩阵第3行第1列的数值;
r3,2为矩阵第3行第2列的数值;
r3,3为矩阵第3行第3列的数值;
XT为换能器中心点的CGCS2000坐标系下的X坐标;YT为换能器中心点的CGCS2000坐标系下的Y坐标;ZT为换能器中心点的CGCS2000坐标系下的Z坐标;T为旋转矩阵;
T0为旋转矩阵初值;
dT为旋转矩阵的导数;
T11为旋转矩阵的导数矩阵的第1行第1列的数值;T12为旋转矩阵的导数矩阵的第1行第2列的数值;T13为旋转矩阵的导数矩阵的第1行第3列的数值;T21为旋转矩阵的导数矩阵的第2行第1列的数值;T22为旋转矩阵的导数矩阵的第2行第2列的数值;T23为旋转矩阵的导数矩阵的第2行第3列的数值;T31为旋转矩阵的导数矩阵的第3行第1列的数值;T32为旋转矩阵的导数矩阵的第3行第2列的数值;T33为旋转矩阵的导数矩阵的第3行第3列的数值;步骤六,将式1-5进行变换,则有:
其中:
其中:
B11=sinRcosH(YUSBLcosP+ZUSBLsinP)+sinH(ZUSBLcosP-YUSBLsinP);
B12=cosRcosH(YUSBLsinP+ZUSBLcosP)-XUSBLsinRcosP;
B13=XUSBLcosRsinH+sinRsinH(ZUSBLcosP-YUSBLsinP)+cosH(YUSBLcosP+ZUSBLsinP);
B21=cosH(ZUSBLcosP-YUSBLsinP)+sinRsinH(YUSBLcosP+ZUSBLsinP);
B22=XUSBLsinRsinH+cosRsinH(YUSBLsinP-ZUSBLcosP);
B23=-XUSBLcosRcosH-sinH(YUSBLcosP+ZUSBLsinP)+cosPsinRcosH(YUSBL-ZUSBL);
B31=-cosR(YUSBLcosP+ZUSBLsinP);
B32=XUSBLcosR+sinR(YUSBLsinP-ZUSBLcosP);
B33=0;
式中:
XCGCS为信标的CGCS2000坐标系下的X坐标;
YCGCS为信标的CGCS2000坐标系下的Y坐标;
ZCGCS为信标的CGCS2000坐标系下的Z坐标;
XUSBL为换能器坐标系下的X坐标;
YUSBL为换能器坐标系下的Y坐标;
ZUSBL为换能器坐标系下的Z坐标;
XT为换能器中心点的CGCS2000坐标系下的X坐标;
YT为换能器中心点的CGCS2000坐标系下的Y坐标;
ZT为换能器中心点的CGCS2000坐标系下的Z坐标;
H为Z轴旋转角度;
P为X轴旋转角度;
R为Y轴旋转角度;
T0为旋转矩阵初值;
dT为旋转矩阵的导数;
为待求的未知数;
dP为X轴旋转角度的导数;
dR为Y轴旋转角度的导数;
dH为Z轴旋转角度的导数;
B为误差方程系数矩阵;
B11为系数矩阵第1行第1列的数值;
B12为系数矩阵第1行第2列的数值;
B13为系数矩阵第1行第3列的数值;
B21为系数矩阵第2行第1列的数值;
B22为系数矩阵第2行第2列的数值;
B23为系数矩阵第2行第3列的数值;
B31为系数矩阵第3行第1列的数值;
B32为系数矩阵第3行第2列的数值;
B33为系数矩阵第3行第3列的数值;
步骤七,按照最小二乘原理,将式1-6化为误差方程:
式中,
其中:
XCGCS为信标的CGCS2000坐标系下的X坐标;
YCGCS为信标的CGCS2000坐标系下的Y坐标;
ZCGCS为信标的CGCS2000坐标系下的Z坐标;
XUSBL为换能器坐标系下的X坐标;
YUSBL为换能器坐标系下的Y坐标;
ZUSBL为换能器坐标系下的Z坐标;
XT为换能器中心点的CGCS2000坐标系下的X坐标;
YT为换能器中心点的CGCS2000坐标系下的Y坐标;
ZT为换能器中心点的CGCS2000坐标系下的Z坐标;
T0为旋转矩阵初值;
V为测量误差值;
为待求的未知数;
B为误差方程系数矩阵;
l为在CGCS2000坐标系及以换能器中心点为原点的相对坐标系中的坐标差值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910635423.3A CN110261824B (zh) | 2019-07-15 | 2019-07-15 | 一种基于多信标的超短基线标定***及标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910635423.3A CN110261824B (zh) | 2019-07-15 | 2019-07-15 | 一种基于多信标的超短基线标定***及标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110261824A CN110261824A (zh) | 2019-09-20 |
CN110261824B true CN110261824B (zh) | 2024-03-19 |
Family
ID=67926058
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910635423.3A Active CN110261824B (zh) | 2019-07-15 | 2019-07-15 | 一种基于多信标的超短基线标定***及标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110261824B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114397644B (zh) * | 2021-12-23 | 2024-05-28 | 山东科技大学 | 一种基于四元数法的超短基线安装误差校准方法 |
Citations (28)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
SU1123929A1 (ru) * | 1983-04-21 | 1984-11-15 | Предприятие П/Я А-7499 | Способ разметки теоретических линий набора и контурных линий секций корпуса судна |
US6138495A (en) * | 1997-12-31 | 2000-10-31 | Ultraguide Ltd. | Calibration method and apparatus for calibrating position sensors on scanning transducers |
CN1818710A (zh) * | 2006-03-15 | 2006-08-16 | 哈尔滨工程大学 | 8基元超短基线定位***相位测量***及其校准方法 |
CN101078627A (zh) * | 2007-06-28 | 2007-11-28 | 北京航空航天大学 | 一种基于陀螺全站仪-激光标靶的盾构机自动导向***的在线标定方法 |
CN101441267A (zh) * | 2008-12-30 | 2009-05-27 | 哈尔滨工程大学 | 海底应答器绝对位置三测点高精度标校方法 |
CN101782639A (zh) * | 2009-01-16 | 2010-07-21 | 日电(中国)有限公司 | 用于对定位设备进行标定的方法、设备和*** |
CN102495420A (zh) * | 2011-12-13 | 2012-06-13 | 大连海事大学 | 一种水下目标精确定位***及方法 |
KR20120104135A (ko) * | 2012-09-05 | 2012-09-20 | 한국해양연구원 | 수중 위치추적 시스템의 캘리브레이션 방법 |
CN103926563A (zh) * | 2014-04-15 | 2014-07-16 | 哈尔滨工程大学 | 一种超短基线五基元接收基阵及其水声定位方法 |
CN103927442A (zh) * | 2014-04-15 | 2014-07-16 | 哈尔滨工程大学 | 一种基于测角变换的超短基线安装角度误差抗粗差校准方法 |
CN204536546U (zh) * | 2015-03-05 | 2015-08-05 | 天津水运工程勘察设计院 | 一种水下管道膨胀弯法兰的测量装置 |
CN105301556A (zh) * | 2015-11-30 | 2016-02-03 | 江苏中海达海洋信息技术有限公司 | 超短基线安装误差校准装置及其方法 |
CN105388457A (zh) * | 2015-12-03 | 2016-03-09 | 山东科技大学 | 一种基于等效声速梯度的长基线水声定位方法 |
CN205246863U (zh) * | 2015-11-30 | 2016-05-18 | 江苏中海达海洋信息技术有限公司 | 基于iTrack-UB系列超短基线水声定位***的声头装置 |
JP2016113744A (ja) * | 2014-12-10 | 2016-06-23 | 株式会社本間組 | 水中構造物の据付装置と据付方法 |
CN106546956A (zh) * | 2016-10-25 | 2017-03-29 | 中国海洋石油总公司 | 一种超短基线接收基阵基元位置的精确标定方法 |
CN106546954A (zh) * | 2016-11-09 | 2017-03-29 | 哈尔滨工程大学 | 一种深海超短基线定位精度检验方法 |
CN106767676A (zh) * | 2016-11-23 | 2017-05-31 | 中国地质大学(武汉) | 一种空间垂向分布点位置测量方法及*** |
CN107132520A (zh) * | 2017-05-03 | 2017-09-05 | 江苏中海达海洋信息技术有限公司 | 一种基于水声超短基线定位***的声线修正方法及*** |
CN107928705A (zh) * | 2017-12-14 | 2018-04-20 | 暨南大学 | 一种基于电磁定位技术的超声探头标定方法与标定装置 |
CN107957579A (zh) * | 2016-10-14 | 2018-04-24 | 苏州触达信息技术有限公司 | 一种被测物体的状态参数确定方法和*** |
CN108413983A (zh) * | 2017-12-21 | 2018-08-17 | 中国船舶重工集团公司第七0七研究所 | 一种sins/usbl一体化定位***安装误差标定的机械方法 |
CN108594238A (zh) * | 2018-03-21 | 2018-09-28 | 哈尔滨工程大学 | 基于瞬态信号的水声换能器电声性能校准装置及校准方法 |
CN109031256A (zh) * | 2018-07-03 | 2018-12-18 | 交通运输部天津水运工程科学研究所 | 多波束测深仪测深与扫宽性能校准方法 |
CN109490927A (zh) * | 2018-12-26 | 2019-03-19 | 天津水运工程勘察设计院 | 一种水下整平架定位***及其定位方法 |
CN109490835A (zh) * | 2018-12-26 | 2019-03-19 | 江苏中海达海洋信息技术有限公司 | 一种超短基线水声定位******误差的水池校准方法 |
CN109737956A (zh) * | 2018-12-17 | 2019-05-10 | 东南大学 | 一种基于双应答器的sins/usbl相位差紧组合导航定位方法 |
CN210572711U (zh) * | 2019-07-15 | 2020-05-19 | 天津水运工程勘察设计院 | 一种基于多信标的超短基线标定*** |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7677078B2 (en) * | 2006-02-02 | 2010-03-16 | Siemens Medical Solutions Usa, Inc. | Line-based calibration of ultrasound transducer integrated with a pose sensor |
US7760587B2 (en) * | 2007-01-04 | 2010-07-20 | Ocean Acoustical Services and Instrumentation Systems (OASIS), Inc. | Methods of and systems for monitoring the acoustic transmission conditions in underwater areas using unmanned, mobile underwater vehicles |
GB2477148B (en) * | 2010-01-25 | 2014-06-18 | Sonardyne Internat Ltd | Data collection system, marine seismic survey system and method of estimating a corrected sound speed |
-
2019
- 2019-07-15 CN CN201910635423.3A patent/CN110261824B/zh active Active
Patent Citations (28)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
SU1123929A1 (ru) * | 1983-04-21 | 1984-11-15 | Предприятие П/Я А-7499 | Способ разметки теоретических линий набора и контурных линий секций корпуса судна |
US6138495A (en) * | 1997-12-31 | 2000-10-31 | Ultraguide Ltd. | Calibration method and apparatus for calibrating position sensors on scanning transducers |
CN1818710A (zh) * | 2006-03-15 | 2006-08-16 | 哈尔滨工程大学 | 8基元超短基线定位***相位测量***及其校准方法 |
CN101078627A (zh) * | 2007-06-28 | 2007-11-28 | 北京航空航天大学 | 一种基于陀螺全站仪-激光标靶的盾构机自动导向***的在线标定方法 |
CN101441267A (zh) * | 2008-12-30 | 2009-05-27 | 哈尔滨工程大学 | 海底应答器绝对位置三测点高精度标校方法 |
CN101782639A (zh) * | 2009-01-16 | 2010-07-21 | 日电(中国)有限公司 | 用于对定位设备进行标定的方法、设备和*** |
CN102495420A (zh) * | 2011-12-13 | 2012-06-13 | 大连海事大学 | 一种水下目标精确定位***及方法 |
KR20120104135A (ko) * | 2012-09-05 | 2012-09-20 | 한국해양연구원 | 수중 위치추적 시스템의 캘리브레이션 방법 |
CN103926563A (zh) * | 2014-04-15 | 2014-07-16 | 哈尔滨工程大学 | 一种超短基线五基元接收基阵及其水声定位方法 |
CN103927442A (zh) * | 2014-04-15 | 2014-07-16 | 哈尔滨工程大学 | 一种基于测角变换的超短基线安装角度误差抗粗差校准方法 |
JP2016113744A (ja) * | 2014-12-10 | 2016-06-23 | 株式会社本間組 | 水中構造物の据付装置と据付方法 |
CN204536546U (zh) * | 2015-03-05 | 2015-08-05 | 天津水运工程勘察设计院 | 一种水下管道膨胀弯法兰的测量装置 |
CN205246863U (zh) * | 2015-11-30 | 2016-05-18 | 江苏中海达海洋信息技术有限公司 | 基于iTrack-UB系列超短基线水声定位***的声头装置 |
CN105301556A (zh) * | 2015-11-30 | 2016-02-03 | 江苏中海达海洋信息技术有限公司 | 超短基线安装误差校准装置及其方法 |
CN105388457A (zh) * | 2015-12-03 | 2016-03-09 | 山东科技大学 | 一种基于等效声速梯度的长基线水声定位方法 |
CN107957579A (zh) * | 2016-10-14 | 2018-04-24 | 苏州触达信息技术有限公司 | 一种被测物体的状态参数确定方法和*** |
CN106546956A (zh) * | 2016-10-25 | 2017-03-29 | 中国海洋石油总公司 | 一种超短基线接收基阵基元位置的精确标定方法 |
CN106546954A (zh) * | 2016-11-09 | 2017-03-29 | 哈尔滨工程大学 | 一种深海超短基线定位精度检验方法 |
CN106767676A (zh) * | 2016-11-23 | 2017-05-31 | 中国地质大学(武汉) | 一种空间垂向分布点位置测量方法及*** |
CN107132520A (zh) * | 2017-05-03 | 2017-09-05 | 江苏中海达海洋信息技术有限公司 | 一种基于水声超短基线定位***的声线修正方法及*** |
CN107928705A (zh) * | 2017-12-14 | 2018-04-20 | 暨南大学 | 一种基于电磁定位技术的超声探头标定方法与标定装置 |
CN108413983A (zh) * | 2017-12-21 | 2018-08-17 | 中国船舶重工集团公司第七0七研究所 | 一种sins/usbl一体化定位***安装误差标定的机械方法 |
CN108594238A (zh) * | 2018-03-21 | 2018-09-28 | 哈尔滨工程大学 | 基于瞬态信号的水声换能器电声性能校准装置及校准方法 |
CN109031256A (zh) * | 2018-07-03 | 2018-12-18 | 交通运输部天津水运工程科学研究所 | 多波束测深仪测深与扫宽性能校准方法 |
CN109737956A (zh) * | 2018-12-17 | 2019-05-10 | 东南大学 | 一种基于双应答器的sins/usbl相位差紧组合导航定位方法 |
CN109490927A (zh) * | 2018-12-26 | 2019-03-19 | 天津水运工程勘察设计院 | 一种水下整平架定位***及其定位方法 |
CN109490835A (zh) * | 2018-12-26 | 2019-03-19 | 江苏中海达海洋信息技术有限公司 | 一种超短基线水声定位******误差的水池校准方法 |
CN210572711U (zh) * | 2019-07-15 | 2020-05-19 | 天津水运工程勘察设计院 | 一种基于多信标的超短基线标定*** |
Non-Patent Citations (11)
Title |
---|
Study on Installation Error Analysis and Calibration of Acoustic Transceiver Array Based on SINS/USBL Integrated System;T. Jinwu, X. Xiaosu, Z. Tao, Z. Liang and L. Yao;《IEEE Access》;第6卷;66923-66939 * |
X. Zheng, X. Kong, W. Zhang and R. Yang.Design of the Active Sonar Responder.《2018 2nd IEEE Advanced Information Management,Communicates,Electronic and Automation Control Conference》.2018,1623-1627. * |
基于消声水池的多波束探测不确定度检测方法;刘智敏, 杨安秀, 陈景涛, 孙月文;《武汉大学学报(信息科学版)》;20170601;第43卷(第06期);908-914 * |
特殊环境下的高精度超声定位误差研究;诸国磊;王英民;王奇;;西北工业大学学报;20180615(03);496-501 * |
船舶动力定位设备安装误差的校正测量;孟俊瑜, 王聪;《船舶工程》;第36卷(第S1期);126-130+151 * |
超短基线声学定位***安装误差精确校准;郑翠娥, 孙大军, 张殿伦等;《哈尔滨工程大学学报》(第08期);894-898 * |
超短基线声学定位***的校准技术研究;唐秋华, 吴永亭, 丁继胜等;《声学技术》(第04期);281-287 * |
超短基线定位误差综合分析及实验;田春和;;《水道港口》;第36卷(第06期);605-608 * |
超短基线阵基元位置精确校准试验研究;马根卯, 董铭锋, 钟琴琴;《声学与电子工程》(第02期);20-24 * |
长基线定位***高精度阵型标定方法;韩云峰, 郑翠娥, 孙大军;《声学学报》;第41卷(第04期);456-464 * |
高精度超短基线GAPS在水下定位中的应用;韩德忠;隋海琛;赵阳;张兆富;;港工技术(第S1期) * |
Also Published As
Publication number | Publication date |
---|---|
CN110261824A (zh) | 2019-09-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN100535683C (zh) | 用于超短基线声学定位***的校准方法 | |
CN108413887B (zh) | 光纤光栅辅助分布式pos的机翼形变测量方法、装置和平台 | |
CN104344836B (zh) | 一种基于姿态观测的冗余惯导***光纤陀螺***级标定方法 | |
CN103927442B (zh) | 一种基于测角变换的超短基线安装角度误差抗粗差校准方法 | |
CN108413983B (zh) | 一种sins/usbl一体化定位***安装误差标定的机械方法 | |
CN111380518B (zh) | 一种引入径向速度的sins/usbl紧组合导航定位方法 | |
CN109708629B (zh) | 一种用于差异定位性能条件的飞行器集群协同导航方法 | |
CN107894241A (zh) | 一种基于椭球拟合的无人机磁传感器校准方法、无人机 | |
CN110275139B (zh) | 一种基于旋转式基元复用的超短基线定位***及方法 | |
CN111537002B (zh) | 一种激光捷联惯组安装误差的标定方法和定向方法 | |
CN112833917B (zh) | 基于磁航向角和最小二乘法的三轴磁传感器标定方法 | |
CN107976169B (zh) | 一种基于恒星观测的船载惯导姿态角时序检测方法 | |
CN103983276A (zh) | 一种基于导航基准系的三框架四轴惯性平台误差标定方法 | |
CN111561948A (zh) | 四轴冗余捷联惯导的***级标定方法 | |
CN109708663B (zh) | 基于空天飞机sins辅助的星敏感器在线标定方法 | |
CN103925904B (zh) | 一种基于对称测线的超短基线安装角度偏差无偏估计方法 | |
CN105547289A (zh) | 一种水下航行器组合导航***及导航信息融合方法 | |
CN102305624A (zh) | 一种罗盘校准方法 | |
CN103913179B (zh) | 舰载单轴旋转调制捷联惯导姿态角修正方法 | |
CN110261824B (zh) | 一种基于多信标的超短基线标定***及标定方法 | |
CN110082033B (zh) | 一种运动状态下的水上载体重心测量装置和方法 | |
CN210572711U (zh) | 一种基于多信标的超短基线标定*** | |
CN112643712B (zh) | 一种大型机械臂基座零位测量标定方法 | |
CN109931956B (zh) | 捷联式三分量磁测***中三轴磁力仪与惯导安装误差校正方法 | |
CN113819882B (zh) | 一种跨海高程点间重力位差计算方法 |
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 |