CN108020243A - 一种基于载体滚转的棱镜安装参数标定方法 - Google Patents
一种基于载体滚转的棱镜安装参数标定方法 Download PDFInfo
- Publication number
- CN108020243A CN108020243A CN201711276584.5A CN201711276584A CN108020243A CN 108020243 A CN108020243 A CN 108020243A CN 201711276584 A CN201711276584 A CN 201711276584A CN 108020243 A CN108020243 A CN 108020243A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- mtd
- mtr
- coordinate system
- 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.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C1/00—Measuring angles
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Manufacturing & Machinery (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
- Length Measuring Devices By Optical Means (AREA)
- Investigating And Analyzing Materials By Characteristic Methods (AREA)
Abstract
提供一种不依赖于载体外部物理基准平面的棱镜标定方法。通过载体携带标定仪进行滚转,即可获得标定仪、载体、棱镜之间的相对关系,完成棱镜与其载体安装偏差的标。不需要载体有固定用的物理基准面,和载体外部形状、体积、重量无关。标定结果为棱镜参考载体的测量坐标系的角度,减少了载体基准面向测量坐标系的传递过程,使得标定更直接、便捷。
Description
技术领域
本发明属于参数标定领域,具体涉及一种基于载体滚转的棱镜安装参数标定方法。
背景技术
标定棱镜和载体的安装参数的基本原理也是利用棱镜的光路传播特性:棱镜棱脊所表述的左指向矢量相对于水平面的倾角β、投影于水平面的方位γ,光电自准直瞄准棱镜时的光轴仰角θ、方位α,有固定关系式sin(α-γ-π/2)=tan(β)tan(θ)。
现有公开的标定方法是基于上述原理的直接测量法,使用花岗岩平板为参考水平基准,两台自准直仪构成测量单元,被测载体的安装座与自准直仪之间固定连接。在载体安装座上放置装有已知棱镜偏差角的标准体,对测量单元的零位进行修正,之后再将载体安装至安装座,因为标准体与被测载体的外部基准面一致,被测载体上的棱镜与标准体上棱镜的差值会通过自准直仪示值显示,结合标准体上棱镜相对与基准面的已知安装偏差,即可得到被测棱镜的安装参数。
但在被测棱镜安装于不规则形状的载体时,通过现有标定方法无法在不改变外部结构形式的条件下完成标定。同理,当棱镜的载体很规则,但已安装至不可拆卸的大型装置上时,也同样不能使用花岗岩平板形式的标定仪进行标定。
发明内容
本发明的目的在于:提供一种不依赖于载体外部物理基准平面的棱镜标定方法。通过载体携带标定仪进行滚转,即可获得标定仪、载体、棱镜之间的相对关系,完成棱镜与其载体安装偏差的标
本发明的技术方案如下:一种基于载体滚转的棱镜安装参数标定方法,包括以下步骤:
S1:双路自准直仪与三轴倾角测量仪构成标定仪,O-XMYMZM为载体坐标系,为棱镜棱脊矢量,为棱镜棱脊在载体坐标系O-XMYMZM的XMOYM平面上的投影,αE为与XM轴的夹角,βE为与轴的夹角,αE与βE为待标定量;
S2:三轴倾角测量仪坐标系O-XCYCZC,而双路自准直仪中与O-XCYCZC重合的坐标系为O-XHYHZH,O-XHYHZH对棱镜自准直读数为AH,而与YC有夹角的坐标系为O-XVYVZV,且O-XVYVZV坐标系XH轴与O-XCYCZC坐标系XC轴重合,YV与YC夹角为20°,O-XVYVZV对棱镜自准直读数为AV,载体坐标系O-XMYMZM与三轴倾角测量仪坐标系O-XCYCZC各坐标轴相对于水平面的倾角使用E表示;
S3:将标定仪固定,YH光轴对棱镜准直时的倾角为θ1=0°,YV轴对棱镜准直时的倾角为θ2=-20°,双路自准直仪中两个坐标系的读数差dA有:
dA=AH-AV (1)
根据直角棱镜的光学准直特性有:
dA=arcsin(tanβH·tanθ1)-arcsin(tanβH·tanθ2) (2)
由式(1)、(2)可得:
βH=arctan(sindA/tan20°) (3)
棱镜棱脊在O-XCYCZC坐标系中的表达式为
VLC=[-cosβHcosAH cosβHsinAH sinβH] (4)
S4:记录载体坐标系O-XMYMZM的倾角EXM1、EYM,三轴倾角测量仪三轴倾角测量坐标系O-XCYCZC的倾角EXC1、EYC,并假设载体坐标系O-XMYMZM的YM轴方位为零;
载体坐标系O-XMYMZM倾角EXM1、EYM转换为相应的欧拉角ρM1、γM1,用于表达载体坐标系O-XMYMZM的地理姿态
同理可得三轴倾角测量仪坐标系O-XCYCZC地理倾斜姿态
式中ψYC为三轴倾角测量仪坐标系O-XCYCZC的YC方位;
S5:通过载体绕XM轴滚转的方式,使得载体坐标系O-XMYMZM的ZM轴水平,记录载体坐标系O-XMYMZM的倾斜角EXM2、EZM,三轴倾角测量坐标系O-XCYCZC的倾斜角EXC2、EZC,并假设载体坐标系O-XMYMZM的ZM轴方位为零;
载体坐标系O-XMYMZM倾角EXM2、EZM转换为相应的欧拉角ρM2、γM2,用于表达载体坐标系O-XMYMZM的地理倾斜姿态其中:
同理可得三轴倾角测量仪坐标系O-XCYCZC地理倾斜姿态
式中ψZC为三轴倾角测量仪坐标系O-XCYCZC的ZC方位;
S6:由于载体坐标系O-XMYMZM与三轴倾角测量仪坐标系O-XCYCZC为固定关系,在滚转前后两者的相对关系不变;
定义满足则:
将上述公式(6)(7)(9)(10)代入后可以解出ψYC、ψZC,并得到
S7:由式(4)所得棱镜棱脊相对于三轴倾角测量仪坐标系O-XCYCZC的表达式VLC、载体坐标系O-XMYMZM与三轴倾角测量仪坐标系O-XCYCZC的转换关系可以得到棱镜棱脊在O-XMYMZM坐标系的表达式VLM;
对VLM按照定义进行分解可得αE、βE
式中VLM(i)(i=1,2,3)分别表示矢量VLM的第i个分量。
所述S2中,EZM表示ZM轴的倾角。
所述S3中,将标定仪固定到载体外部,且双路自准直仪能够观测到棱镜。
本发明技术效果:通过载体滚转法实现棱镜安装参数的标定方法,要求载体可滚转,不需要载体有固定用的物理基准面,和载体外部形状、体积、重量无关。标定结果为棱镜参考载体的测量坐标系的角度,减少了载体基准面向测量坐标系的传递过程,使得标定更直接、便捷。
附图说明
图1为本发明所述基于载体滚转的棱镜安装参数标定方法标定测量关系示意图
图2为本发明所述基于载体滚转的棱镜安装参数标定方法棱镜安装参数示意图
图3为本发明所述基于载体滚转的棱镜安装参数标定方法标定仪各坐标系定义指向示意图
具体实施方式
一种基于载体滚转的棱镜安装参数标定方法,包括以下步骤:
S1:双路自准直仪与三轴倾角测量仪构成标定仪,O-XMYMZM为载体坐标系,为棱镜棱脊矢量,为棱镜棱脊在载体坐标系O-XMYMZM的XMOYM平面上的投影,αE为与XM轴的夹角,βE为与轴的夹角,αE与βE为待标定量。
S2:三轴倾角测量仪坐标系O-XCYCZC,而双路自准直仪中与O-XCYCZC重合的坐标系为O-XHYHZH,O-XHYHZH对棱镜自准直读数为AH,而与YC有夹角的坐标系为O-XVYVZV,且O-XVYVZV坐标系XH轴与O-XCYCZC坐标系XC轴重合,YV与YC夹角为20°,O-XVYVZV对棱镜自准直读数为AV,载体坐标系O-XMYMZM与三轴倾角测量仪坐标系O-XCYCZC各坐标轴相对于水平面的倾角使用E表示,(如EZM表示ZM轴的倾角)。
S3:将标定仪固定到载体外部,且双路自准直仪能够观测到棱镜,YH光轴对棱镜准直时的倾角为θ1=0°,YV轴对棱镜准直时的倾角为θ2=-20°,双路自准直仪中两个坐标系的读数差dA有:
dA=AH-AV (14)
根据直角棱镜的光学准直特性有:
dA=arcsin(tanβH·tanθ1)-arcsin(tanβH·tanθ2) (15)
由式(1)、(2)可得:
βH=arctan(sindA/tan20°) (16)
棱镜棱脊在O-XCYCZC坐标系中的表达式为
VLC=[-cosβHcosAH cosβHsinAH sinβH] (17)
S4:记录载体坐标系O-XMYMZM的倾角EXM1、EYM,三轴倾角测量仪三轴倾角测量坐标系O-XCYCZC的倾角EXC1、EYC,并假设载体坐标系O-XMYMZM的YM轴方位为零;
载体坐标系O-XMYMZM倾角EXM1、EYM转换为相应的欧拉角ρM1、γM1,用于表达载体坐标系O-XMYMZM的地理姿态
同理可得三轴倾角测量仪坐标系O-XCYCZC地理倾斜姿态
式中ψYC为三轴倾角测量仪坐标系O-XCYCZC的YC方位;
S5:通过载体绕XM轴滚转的方式,使得载体坐标系O-XMYMZM的ZM轴水平,记录载体坐标系O-XMYMZM的倾斜角EXM2、EZM,三轴倾角测量坐标系O-XCYCZC的倾斜角EXC2、EZC。并假设载体坐标系O-XMYMZM的ZM轴方位为零。
载体坐标系O-XMYMZM倾角EXM2、EZM转换为相应的欧拉角ρM2、γM2,用于表达载体坐标系O-XMYMZM的地理倾斜姿态其中
同理可得三轴倾角测量仪坐标系O-XCYCZC地理倾斜姿态
式中ψZC为三轴倾角测量仪坐标系O-XCYCZC的ZC方位。
S6:由于载体坐标系O-XMYMZM与三轴倾角测量仪坐标系O-XCYCZC为固定关系,在滚转前后两者的相对关系不变。
定义满足则:
将上述公式(6)(7)(9)(10)代入后可以解出ψYC、ψZC,并得到
S7:由式(4)所得棱镜棱脊相对于三轴倾角测量仪坐标系O-XCYCZC的表达式VLC、载体坐标系O-XMYMZM与三轴倾角测量仪坐标系O-XCYCZC的转换关系可以得到棱镜棱脊在O-XMYMZM坐标系的表达式VLM;
对VLM按照定义进行分解可得αE、βE
式中VLM(i)(i=1,2,3)分别表示矢量VLM的第i个分量。
Claims (3)
1.一种基于载体滚转的棱镜安装参数标定方法,其特征在于:包括以下步骤:
S1:双路自准直仪与三轴倾角测量仪构成标定仪,O-XMYMZM为载体坐标系,为棱镜棱脊矢量,为棱镜棱脊在载体坐标系O-XMYMZM的XMOYM平面上的投影,αE为与XM轴的夹角,βE为与轴的夹角,αE与βE为待标定量;
S2:三轴倾角测量仪坐标系O-XCYCZC,而双路自准直仪中与O-XCYCZC重合的坐标系为O-XHYHZH,O-XHYHZH对棱镜自准直读数为AH,而与YC有夹角的坐标系为O-XVYVZV,且O-XVYVZV坐标系XH轴与O-XCYCZC坐标系XC轴重合,YV与YC夹角为20°,O-XVYVZV对棱镜自准直读数为AV,载体坐标系O-XMYMZM与三轴倾角测量仪坐标系O-XCYCZC各坐标轴相对于水平面的倾角使用E表示;
S3:将标定仪固定,YH光轴对棱镜准直时的倾角为θ1=0°,YV轴对棱镜准直时的倾角为θ2=-20°,双路自准直仪中两个坐标系的读数差dA有:
dA=AH-AV (1)
根据直角棱镜的光学准直特性有:
dA=arcsin(tanβH·tanθ1)-arcsin(tanβH·tanθ2) (2)
由式(1)、(2)可得:
βH=arctan(sindA/tan20°) (3)
棱镜棱脊在O-XCYCZC坐标系中的表达式为
VLC=[-cosβHcosAH cosβHsinAH sinβH] (4)
S4:记录载体坐标系O-XMYMZM的倾角EXM1、EYM,三轴倾角测量仪三轴倾角测量坐标系O-XCYCZC的倾角EXC1、EYC,并假设载体坐标系O-XMYMZM的YM轴方位为零;
载体坐标系O-XMYMZM倾角EXM1、EYM转换为相应的欧拉角ρM1、γM1,用于表达载体坐标系O-XMYMZM的地理姿态
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&rho;</mi>
<mrow>
<mi>M</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>EY</mi>
<mi>M</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&gamma;</mi>
<mrow>
<mi>M</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>=</mo>
<mi>arcsin</mi>
<mfrac>
<mrow>
<msub>
<mi>sinEX</mi>
<mrow>
<mi>M</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
<mrow>
<msub>
<mi>cosEY</mi>
<mi>M</mi>
</msub>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>5</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msubsup>
<mi>R</mi>
<mi>H</mi>
<mi>M</mi>
</msubsup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>cos&gamma;</mi>
<mrow>
<mi>M</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>sin&gamma;</mi>
<mrow>
<mi>M</mi>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>cos&rho;</mi>
<mrow>
<mi>M</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>sin&gamma;</mi>
<mrow>
<mi>M</mi>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>cos&rho;</mi>
<mrow>
<mi>M</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<msub>
<mi>cos&rho;</mi>
<mrow>
<mi>M</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>sin&rho;</mi>
<mrow>
<mi>M</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>sin&gamma;</mi>
<mrow>
<mi>M</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>cos&gamma;</mi>
<mrow>
<mi>M</mi>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>sin&rho;</mi>
<mrow>
<mi>M</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>cos&gamma;</mi>
<mrow>
<mi>M</mi>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>cos&rho;</mi>
<mrow>
<mi>M</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
同理可得三轴倾角测量仪坐标系O-XCYCZC地理倾斜姿态
<mrow>
<msubsup>
<mi>R</mi>
<mi>H</mi>
<mi>C</mi>
</msubsup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>cos&gamma;</mi>
<mrow>
<mi>C</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>sin&gamma;</mi>
<mrow>
<mi>C</mi>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>cos&rho;</mi>
<mrow>
<mi>C</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>sin&gamma;</mi>
<mrow>
<mi>C</mi>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>cos&rho;</mi>
<mrow>
<mi>C</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<msub>
<mi>cos&rho;</mi>
<mrow>
<mi>C</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>sin&rho;</mi>
<mrow>
<mi>C</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>sin&gamma;</mi>
<mrow>
<mi>C</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>cos&gamma;</mi>
<mrow>
<mi>C</mi>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>sin&rho;</mi>
<mrow>
<mi>C</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>cos&gamma;</mi>
<mrow>
<mi>C</mi>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>cos&rho;</mi>
<mrow>
<mi>C</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>&CenterDot;</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>cos&psi;</mi>
<mrow>
<mi>Y</mi>
<mi>C</mi>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>sin&psi;</mi>
<mrow>
<mi>Y</mi>
<mi>C</mi>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>sin&psi;</mi>
<mrow>
<mi>Y</mi>
<mi>C</mi>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>cos&psi;</mi>
<mrow>
<mi>Y</mi>
<mi>C</mi>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
式中ψYC为三轴倾角测量仪坐标系O-XCYCZC的YC方位;
S5:通过载体绕XM轴滚转的方式,使得载体坐标系O-XMYMZM的ZM轴水平,记录载体坐标系O-XMYMZM的倾斜角EXM2、EZM,三轴倾角测量坐标系O-XCYCZC的倾斜角EXC2、EZC,并假设载体坐标系O-XMYMZM的ZM轴方位为零;
载体坐标系O-XMYMZM倾角EXM2、EZM转换为相应的欧拉角ρM2、γM2,用于表达载体坐标系O-XMYMZM的地理倾斜姿态其中:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&rho;</mi>
<mrow>
<mi>M</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>EZ</mi>
<mi>M</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&gamma;</mi>
<mrow>
<mi>M</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>=</mo>
<mi>a</mi>
<mi>r</mi>
<mi>c</mi>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mfrac>
<mrow>
<msub>
<mi>sinEX</mi>
<mrow>
<mi>M</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
<mrow>
<msub>
<mi>cosEZ</mi>
<mi>M</mi>
</msub>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>8</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msubsup>
<mi>R</mi>
<mi>V</mi>
<mi>M</mi>
</msubsup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>cos&gamma;</mi>
<mrow>
<mi>M</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>sin&gamma;</mi>
<mrow>
<mi>M</mi>
<mn>2</mn>
</mrow>
</msub>
<msub>
<mi>cos&rho;</mi>
<mrow>
<mi>M</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>sin&gamma;</mi>
<mrow>
<mi>M</mi>
<mn>2</mn>
</mrow>
</msub>
<msub>
<mi>sin&rho;</mi>
<mrow>
<mi>M</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>sin&gamma;</mi>
<mrow>
<mi>M</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>cos&gamma;</mi>
<mrow>
<mi>M</mi>
<mn>2</mn>
</mrow>
</msub>
<msub>
<mi>cos&rho;</mi>
<mrow>
<mi>M</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>cos&gamma;</mi>
<mrow>
<mi>M</mi>
<mn>2</mn>
</mrow>
</msub>
<msub>
<mi>sin&rho;</mi>
<mrow>
<mi>M</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<msub>
<mi>sin&rho;</mi>
<mrow>
<mi>M</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>cos&rho;</mi>
<mrow>
<mi>M</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>9</mn>
<mo>)</mo>
</mrow>
</mrow>
同理可得三轴倾角测量仪坐标系O-XCYCZC地理倾斜姿态
<mrow>
<msubsup>
<mi>R</mi>
<mi>V</mi>
<mi>C</mi>
</msubsup>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>cos&gamma;</mi>
<mrow>
<mi>C</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>sin&gamma;</mi>
<mrow>
<mi>C</mi>
<mn>2</mn>
</mrow>
</msub>
<msub>
<mi>cos&rho;</mi>
<mrow>
<mi>C</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>sin&gamma;</mi>
<mrow>
<mi>C</mi>
<mn>2</mn>
</mrow>
</msub>
<msub>
<mi>sin&rho;</mi>
<mrow>
<mi>C</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>sin&gamma;</mi>
<mrow>
<mi>C</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>cos&gamma;</mi>
<mrow>
<mi>C</mi>
<mn>2</mn>
</mrow>
</msub>
<msub>
<mi>cos&rho;</mi>
<mrow>
<mi>C</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>cos&gamma;</mi>
<mrow>
<mi>C</mi>
<mn>2</mn>
</mrow>
</msub>
<msub>
<mi>sin&rho;</mi>
<mrow>
<mi>C</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<msub>
<mi>sin&rho;</mi>
<mrow>
<mi>C</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>cos&rho;</mi>
<mrow>
<mi>C</mi>
<mn>2</mn>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>&CenterDot;</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>cos&psi;</mi>
<mrow>
<mi>Z</mi>
<mi>C</mi>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>sin&psi;</mi>
<mrow>
<mi>Z</mi>
<mi>C</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>sin&psi;</mi>
<mrow>
<mi>Z</mi>
<mi>C</mi>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<msub>
<mi>cos&psi;</mi>
<mrow>
<mi>Z</mi>
<mi>C</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>10</mn>
<mo>)</mo>
</mrow>
</mrow>
式中ψZC为三轴倾角测量仪坐标系O-XCYCZC的ZC方位;
S6:由于载体坐标系O-XMYMZM与三轴倾角测量仪坐标系O-XCYCZC为固定关系,在滚转前后两者的相对关系不变;
定义满足则:
<mrow>
<msubsup>
<mi>R</mi>
<mi>M</mi>
<mi>C</mi>
</msubsup>
<mo>=</mo>
<msubsup>
<mi>R</mi>
<mi>H</mi>
<mi>C</mi>
</msubsup>
<mo>&CenterDot;</mo>
<msubsup>
<mi>R</mi>
<mi>H</mi>
<msup>
<mi>M</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
</msubsup>
<mo>=</mo>
<msubsup>
<mi>R</mi>
<mi>V</mi>
<mi>C</mi>
</msubsup>
<mo>&CenterDot;</mo>
<msubsup>
<mi>R</mi>
<mi>V</mi>
<msup>
<mi>M</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
</msubsup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>11</mn>
<mo>)</mo>
</mrow>
</mrow>
将上述公式(6)(7)(9)(10)代入后可以解出ψYC、ψZC,并得到
S7:由式(4)所得棱镜棱脊相对于三轴倾角测量仪坐标系O-XCYCZC的表达式VLC、载体坐标系O-XMYMZM与三轴倾角测量仪坐标系O-XCYCZC的转换关系可以得到棱镜棱脊在O-XMYMZM坐标系的表达式VLM;
<mrow>
<msub>
<mi>VL</mi>
<mi>M</mi>
</msub>
<mo>=</mo>
<msub>
<mi>VL</mi>
<mi>C</mi>
</msub>
<mo>&CenterDot;</mo>
<msubsup>
<mi>R</mi>
<mi>M</mi>
<mi>C</mi>
</msubsup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>12</mn>
<mo>)</mo>
</mrow>
</mrow>
对VLM按照定义进行分解可得αE、βE
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&alpha;</mi>
<mi>E</mi>
</msub>
<mo>=</mo>
<mi>a</mi>
<mi>r</mi>
<mi>c</mi>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>VL</mi>
<mi>M</mi>
</msub>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
<mo>/</mo>
<msub>
<mi>VL</mi>
<mi>M</mi>
</msub>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&beta;</mi>
<mi>E</mi>
</msub>
<mo>=</mo>
<mi>a</mi>
<mi>r</mi>
<mi>c</mi>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>VL</mi>
<mi>M</mi>
</msub>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>13</mn>
<mo>)</mo>
</mrow>
</mrow>
式中VLM(i)(i=1,2,3)分别表示矢量VLM的第i个分量。
2.根据权利要求1所述的一种基于载体滚转的棱镜安装参数标定方法,其特征在于:所述S2中,EZM表示ZM轴的倾角。
3.根据权利要求1所述的一种基于载体滚转的棱镜安装参数标定方法,其特征在于:所述S3中,将标定仪固定到载体外部,且双路自准直仪能够观测到棱镜。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711276584.5A CN108020243B (zh) | 2017-12-06 | 2017-12-06 | 一种基于载体滚转的棱镜安装参数标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711276584.5A CN108020243B (zh) | 2017-12-06 | 2017-12-06 | 一种基于载体滚转的棱镜安装参数标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108020243A true CN108020243A (zh) | 2018-05-11 |
CN108020243B CN108020243B (zh) | 2021-02-09 |
Family
ID=62078600
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711276584.5A Active CN108020243B (zh) | 2017-12-06 | 2017-12-06 | 一种基于载体滚转的棱镜安装参数标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108020243B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109443387A (zh) * | 2018-11-21 | 2019-03-08 | 北京航天时代激光导航技术有限责任公司 | 一种激光惯组棱镜侧反光面安装误差测试方法及*** |
CN109470200A (zh) * | 2018-11-12 | 2019-03-15 | 哈尔滨工业大学 | 一种三轴气浮台大角度姿态角测量装置及方法 |
CN112697170A (zh) * | 2020-12-11 | 2021-04-23 | 西安电子工程研究所 | 标定载体上两个以上倾角传感器的方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105627982A (zh) * | 2014-11-05 | 2016-06-01 | 北京航天计量测试技术研究所 | 一种远程运载器倾斜瞄准方法 |
US20160252909A1 (en) * | 2003-03-20 | 2016-09-01 | Agjunction Llc | Gnss and optical guidance and machine control |
CN106767930A (zh) * | 2017-01-22 | 2017-05-31 | 湖北航天技术研究院总体设计所 | 一种捷联惯导与对准棱镜安装偏角测量方法 |
CN106855419A (zh) * | 2016-12-30 | 2017-06-16 | 西安航天精密机电研究所 | 基于加速度计坐标系直角棱镜的标定测试方法 |
-
2017
- 2017-12-06 CN CN201711276584.5A patent/CN108020243B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20160252909A1 (en) * | 2003-03-20 | 2016-09-01 | Agjunction Llc | Gnss and optical guidance and machine control |
CN105627982A (zh) * | 2014-11-05 | 2016-06-01 | 北京航天计量测试技术研究所 | 一种远程运载器倾斜瞄准方法 |
CN106855419A (zh) * | 2016-12-30 | 2017-06-16 | 西安航天精密机电研究所 | 基于加速度计坐标系直角棱镜的标定测试方法 |
CN106767930A (zh) * | 2017-01-22 | 2017-05-31 | 湖北航天技术研究院总体设计所 | 一种捷联惯导与对准棱镜安装偏角测量方法 |
Non-Patent Citations (2)
Title |
---|
ZHU MENG ET AL.: "Double-slit based carrier frequency speckle interferometric system with large viewing field", 《OPTICS AND PRECISION ENGINEERING》 * |
杨新刚等: "一种周向精度检测***的误差分析及修正算法", 《机械科学与技术》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109470200A (zh) * | 2018-11-12 | 2019-03-15 | 哈尔滨工业大学 | 一种三轴气浮台大角度姿态角测量装置及方法 |
CN109470200B (zh) * | 2018-11-12 | 2021-03-23 | 哈尔滨工业大学 | 一种三轴气浮台大角度姿态角测量装置及方法 |
CN109443387A (zh) * | 2018-11-21 | 2019-03-08 | 北京航天时代激光导航技术有限责任公司 | 一种激光惯组棱镜侧反光面安装误差测试方法及*** |
CN109443387B (zh) * | 2018-11-21 | 2021-02-09 | 北京航天时代激光导航技术有限责任公司 | 一种激光惯组棱镜侧反光面安装误差测试方法及*** |
CN112697170A (zh) * | 2020-12-11 | 2021-04-23 | 西安电子工程研究所 | 标定载体上两个以上倾角传感器的方法 |
CN112697170B (zh) * | 2020-12-11 | 2023-08-29 | 西安电子工程研究所 | 标定载体上两个以上倾角传感器的方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108020243B (zh) | 2021-02-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108020243A (zh) | 一种基于载体滚转的棱镜安装参数标定方法 | |
CN105910624A (zh) | 一种惯组光学瞄准棱镜安装误差的标定方法 | |
Vaníček et al. | Transformation of coordinates between two horizontal geodetic datums | |
CN107782293B (zh) | 基于六自由度激光跟踪靶的航天器设备位姿信息测量方法 | |
CN104034354B (zh) | 一种imu定位定向***装调工艺 | |
CN101975872B (zh) | 石英挠性加速度计组件零位偏置的标定方法 | |
CN103363949A (zh) | 一种卫星天线混合测量分析的方法 | |
CN102538825B (zh) | 一种星敏感器探头组合体光轴指向标定方法 | |
CN103389114B (zh) | 基于g敏感性的三轴MEMS陀螺非正交误差标定方法 | |
CN103822629A (zh) | 基于多方向偏振光导航传感器的定位***及其定位方法 | |
CN101832772A (zh) | 月球车避障***激光点阵器标定方法 | |
CN107543494A (zh) | 立体标定装置及使用其测量坐标系转换的方法 | |
CN105823420B (zh) | 一种角锥组合件回光能量中心坐标精密导出方法 | |
CN103558619A (zh) | 获取航拍像片的外方位元素的方法 | |
CN102012236A (zh) | 一种月球车双目视觉避障***标定方法 | |
CN108507592A (zh) | 一种双轴旋转惯性导航***转轴非正交角标定方法 | |
CN106154232A (zh) | 一种连续波三坐标雷达测角姿态补偿方法 | |
CN106855419A (zh) | 基于加速度计坐标系直角棱镜的标定测试方法 | |
CN105424013B (zh) | 一种地面坐标的测量方法 | |
CN105388494A (zh) | 一种应用于rtk接收机的激光测距定位方法 | |
CN103900566A (zh) | 一种消除地球自转角速度对旋转调制型捷联惯导***精度影响的方法 | |
CN110887472A (zh) | 一种偏振-地磁信息深度融合全自主姿态解算方法 | |
CN106595638A (zh) | 基于光电跟踪技术的三轴气浮台姿态测量装置及测量方法 | |
CN103884356B (zh) | 一种标定捷联惯性组合陀螺仪组合的方法 | |
CN105911576A (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 |