CN113686319A - 分布式测量系统基站姿态补偿装置及方法 - Google Patents
分布式测量系统基站姿态补偿装置及方法 Download PDFInfo
- Publication number
- CN113686319A CN113686319A CN202110979188.9A CN202110979188A CN113686319A CN 113686319 A CN113686319 A CN 113686319A CN 202110979188 A CN202110979188 A CN 202110979188A CN 113686319 A CN113686319 A CN 113686319A
- Authority
- CN
- China
- Prior art keywords
- base station
- coordinate system
- attitude
- mirror
- mirror surface
- 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
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C15/00—Surveying instruments or accessories not provided for in groups G01C1/00 - G01C13/00
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/15—Correlation function computation including computation of convolution operations
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/16—Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Data Mining & Analysis (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Theoretical Computer Science (AREA)
- Computational Mathematics (AREA)
- Software Systems (AREA)
- Algebra (AREA)
- Databases & Information Systems (AREA)
- General Engineering & Computer Science (AREA)
- Computing Systems (AREA)
- Radar, Positioning & Navigation (AREA)
- Operations Research (AREA)
- Remote Sensing (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
本发明公开一种分布式测量系统基站姿态补偿装置,包括多个基站和光电自准直仪;所述基站包括嵌在所述基站内部的倾角传感器,以及设置在所述基站侧壁上的反射镜;所述反射镜镜面与倾角传感器坐标系YOZ平面近似重合,镜面法向量与倾角传感器坐标系X轴正方向近似同向;所述光电自准直仪的光源出射轴线与所述基站的反射镜中心的垂线处于平行状态。还公开了一种姿态补偿方法。本发明利用光电自准直仪与双轴倾角传感器实现组合测量,为位姿参数的补偿提供高精度的角度信息,解决了基站姿态变化后须重复性大范围重新定向的问题,能有效补偿发生变化的系统外部参数,增强了系统的鲁棒性,实现了测量基站的姿态更新。
Description
技术领域
本发明涉及大尺度空间三维坐标测量方法,具体涉及一种分布式测量系统基站姿态补偿装置及方法。
背景技术
分布式测量系统具有多目标、多任务并行测量,测量空间可任意扩展等特点,近年来在工业测量领域得到广泛的应用。分布式测量系统以基于角度交会测量原理为主,例如多站视觉定位系统、经纬仪交汇测量系统、室内空间测量定位系统等。其中,室内空间测量定位系统是一种基于光电扫描角度交会的坐标测量系统,通过多个旋转激光发射装置(基站)组成测量网络,对接收器位置进行自动三维坐标测量,具有亚毫米级的测量精度,其以iGPS(indoor Global Positioning System)和wMPS(workshop Measurement PositioningSystem)为典型代表。
系统中各个测量基站间相对位姿关系(位姿关系参数:3个位置参数和3个角度参数)的精确确定是实现分布式网络高精度测量的首要问题,为保证测量的精确,原则上须保证系统的定向参数在测量过程中严格不变。而在船舶、飞机等大型装备制造过程中,由于现场测量环境复杂,基站在长期运行过程中会不可避免地受外界振动等因素干扰,其位姿发生微小变化所引起的测量误差将会累积放大,影响最终测量结果,此时往往需要对系统进行重新标定。常规标定方法需要在有限的测量空间内构建足够的靶标几何约束数量,构建过程易受标定条件及环境制约,尤其不利于系统在复杂遮挡环境下的使用。为了减少定向过程测量空间端所需的约束条件,可以通过融合其它测量系统提供的几何约束,尤其是位姿关系的角度参数,以减少分布式测量单元相对位姿关系的自由度,达到有效提升测量系统的定向效率和环境适应能力的目的。
因此,研究分布式测量系统中基站的姿态补偿方法是提高系统测量精度和满足复杂工业现场适应性的有效手段。专利CN207882432U公开了一种基于倾角传感的新型基站装置,通过刚性连接将倾角传感器安装在基站内部并实时捕捉倾角传感器的位姿信息。专利CN107144273A公开了一种基于倾角传感的室内测量定位系统基站姿态自动补偿方法,通过倾角传感器的输出,结合姿态补偿算法,实时更新基站姿态。但是,这些方法中利用的双轴倾角传感器能够实现2自由度的高精度角度测量,而基站姿态关系包括3个姿态角度参数,仅使用倾角传感器无法完全满足3个姿态角参数的补偿更新需求。
为此,需要一种针对分布式测量系统的基站姿态关系补偿需求,能够实现3个姿态角度参数补偿的装置及方法。
发明内容
本发明的目的在于提供一种基于光电自准直与倾角传感组合测量的分布式测量系统基站姿态补偿装置及方法,引入光电自准直仪作为额外的角度测量装置,通过建立双轴倾角传感器与光电自准直仪组合测量,解决了仅使用倾角传感器无法完全满足姿态更新要求的问题,将位姿补偿问题分解为测量单元姿态的更新和系统位置参数的解算,实现对基站姿态变化的实时补偿,对测量系统长期稳定的测量提供保证,可满足复杂工业现场的测量要求。
本发明的目的是通过以下技术方案实现的:
分布式测量系统基站姿态补偿装置,包括多个基站和光电自准直仪;
其中,所述基站包括嵌在所述基站内部的倾角传感器,以及设置在所述基站侧壁上的反射镜;所述基站放置在精密摆动平台上;
所述反射镜镜面与倾角传感器坐标系YOZ平面近似重合,镜面法向量与倾角传感器坐标系X轴正方向近似同向,光电自准直仪坐标系不随倾角传感器及镜面坐标系姿态的变化而变化;
所述光电自准直仪的光源出射轴线与所述基站的反射镜中心的垂线处于平行状态。
进一步的,所述补偿装置还包括基准尺,用于根据基准尺两端点间的基准长度提供基准长度约束。
进一步的,所述装置设置一个所述光电自准直仪和多个基站,选定其中一个基站为主基站,所述光电自准直仪的光源出射轴线与所述主基站的反射镜中心的垂线处于平行状态。
进一步的,所述装置设置多个基站,每个所述基站配备一个对应的所述光电自准直仪,所述光电自准直仪的光源出射轴线与其对应的所述基站的反射镜中心的垂线处于平行状态。
利用所述分布式测量系统基站姿态补偿装置的姿态补偿方法,包括以下步骤:
步骤一:将多个基站设置在精密摆动平台上,所述基站内嵌有倾角传感器且侧壁上具有反射镜,选定一个基站作为主基站,其余基站为从基站,调整所述光电自准直仪的光源出射轴线,使其与所述主基站的反射镜中心的垂线处于平行状态下;
建立主基站的倾角传感器坐标系,由于镜面与倾角传感器坐标系平面近似重合,镜面法向量与倾角传感器坐标系X轴正方向近似同向,以此为基本关系建立主基站的镜面坐标系;其中倾角传感器和基站固连,因此主基站内倾角传感坐标系与基站坐标系、镜面坐标系的相对位姿关系不变;光电自准直仪坐标系不随倾角传感器及镜面坐标系姿态的变化而变化;
步骤二:利用激光跟踪仪标定空间中的随机控制点的坐标,随机控制点构成世界坐标系,通过后向交会算法获得主基站与世界坐标系之间的姿态关系,利用所述精密摆动平台多次调整主基站姿态,标定倾角传感坐标系与镜面坐标系之间的旋转矩阵,获得新的主基站坐标系及其倾角传感器的姿态变化;其中所述姿态关系为世界坐标系到主基站坐标系的旋转矩阵和平移矩阵;
步骤三:利用步骤二获得的新的主基站坐标系及其倾角传感器的姿态变化,在新的主基站坐标系下表达其余基站的坐标系,获得主基站与从基站的姿态变化;通过倾角传感器姿态变化过程的输出值与镜面姿态变化过程中所述光电自准直仪的输出值,建立倾角传感器与光电自准直仪组合测量约束方程与目标函数;将姿态变化后的主基站坐标系到从基站坐标系的平移矩阵作为初值进行非线性优化,从而得到位姿变化后的位置参数,实现实时更新基站姿态。
进一步的,所述步骤三在“将姿态变化后的主基站坐标系到从基站坐标系的平移矩阵作为初值进行非线性优化”后还包括:进一步利用基准尺的基准长度为约束建立目标函数,非线性优化所述目标函数从而得到位姿变化后的位置参数,实现实时更新基站姿态。
进一步的,步骤二具体包括如下步骤:
步骤2-1:由空间中的随机控制点构成世界坐标系O-XWYWZW,基站坐标系为O-XTYTZT,利用激光跟踪仪标定随机控制点的坐标,通过后向交会算法获得主基站与世界坐标系之间的姿态关系为:
其中,RWT与TWT分别是世界坐标系到单基站坐标系的旋转矩阵和平移矩阵;
步骤2-2:通过精密摆动平台对基站姿态进行多次精密调整,并保证每次姿态变化时反射镜面处于准直状态,即令光电自准直仪的输出值为[0,0],每次调整都通过步骤2-1后向交会算法获得基站与世界坐标系的姿态关系,推导不同姿态基站坐标系的姿态关系为:
其中i,j表示基站不同姿态,RTij、TTij表示基站坐标系从姿态i到姿态j的旋转矩阵和平移矩阵;
步骤2-3:不考虑平移时,不同姿态之间,基站只有绕镜面法向量(设为单位向量nT=[nTxnTynTz]T)的旋转,使用罗德里格斯旋转矩阵求解镜面法向量初值;对罗德里格斯公式逆变换,从旋转矩阵获得旋转向量,表达式如下:
其中R代表旋转矩阵;RT代表旋转矩阵的转置,n是旋转向量;
将基站任意两个姿态之间的旋转矩阵RTij代入表达式获得镜面法向量在基站坐标系下的初值。
步骤2-4:镜面法向量具有如下约束关系:
根据镜面法向量的约束关系建立非线性目标函数,采用L-M算法进行非线性优化,获得镜面法向量在基站坐标系下的表示。非线性目标函数如下,式中M为罚因子,h为约束关系。
步骤2-5:已知基站坐标系与倾角传感器之间的姿态关系RIT,镜面法向量在倾角传感器坐标系下的表示为:
步骤2-6:设倾角传感器坐标系的基为{iI,jI,kI},其在自身坐标系下的表示为:
iI=[1 0 0]T
jI=[0 1 0]T
kI=[0 0 1]T (8)
镜面坐标系的基为{iM,jM,kM},令镜面法向量为镜面坐标系Z轴,镜面坐标系Y轴与倾角传感器坐标系Z轴垂直,镜面坐标系X轴通过右手定则获得,如图1所示,则镜面坐标系的基在倾角传感器坐标系下表示为:
kM=nI
jM=kM×[0 0 1]T
iM=jM×kM (9)
步骤2-7:根据方向余弦矩阵,倾角传感器坐标系到镜面坐标系的旋转矩阵即表示为:
进一步的,所述步骤三具体包括如下步骤:
步骤3-1:根据上述步骤获得的倾角传感器坐标系O-XIYIZI、镜面坐标系O-XMYMZM、光电自准直坐标系O-XAYAZA,设镜面坐标系O-XMYMZM与姿态变化前参与自准直仪测量的镜面坐标系O-XM1YM1ZM1不重合,假定两坐标系关系为:
其中Rz为两坐标系的旋转矩阵,δ为绕Z轴的旋转角;结合上式与步骤2-7,倾角传感器坐标系到镜面坐标系O-XM1YM1ZM1的旋转矩阵表达式为:
R′IM=RZ(δ)RIM (12)
步骤3-2:根据倾角传感器在姿态变化过程中的输出值,获得欧拉旋转角αI1、βI1、αI2、βI2,倾角传感器的姿态变化可表示为:
RI=RY(βI2)RX(αI2)RZ(θI)RX(-αI1)RY(-βI1) (13)
步骤3-3:根据镜面姿态变化过程中自准直仪的输出值,获得欧拉旋转角αM1、βM1、αM1、βM1,建立约束方程:
F=RIR′IM-R′IMRM1
=RY(βI2)RX(αI2)RZ(θI)RX(-αI1)RY(-βI1)RZ(δ)RIM-RZ(δ)RIMRZ(θM)RY(βM2)RX(αM2)RX(-αM1)RY(-βM1)
=[fij]=[0] (14)
步骤3-4:根据约束方程得到目标函数,并使用L-M算法进行非线性优化:
进一步的,光电自准直仪的测角精度为0.4″,所述倾角传感器为双轴倾角传感器。
与现有技术相比,本发明的技术方案所带来的有益效果是:
本发明研究了分布式测量系统的基站姿态参数补偿问题,引入光电自准直仪和双轴倾角传感器为测量基站提供外部角度约束,对倾角传感器与自准直镜面法向量进行标定,利用光电自准直仪与双轴倾角传感器实现组合测量,为位姿参数的补偿提供高精度的角度信息,结合已有的定向先验信息进一步减少了待标定的定向参数个数,实现了有效重定向。此方法解决了基站姿态变化后须重复性大范围重新定向的问题,能有效补偿发生变化的系统外部参数,包括更新测量基站坐标系之间的旋转矩阵和解算测量基站坐标系之间的位置参数,增强了系统的鲁棒性,实现了测量基站的姿态更新。
附图说明
图1是本发明所述的分布式测量系统基站姿态补偿装置中基站与光电自准直仪的结构示意图;
图2是实施例1所述的分布式测量系统基站姿态补偿装置结构示意图;
图3是实施例2所述的姿态补偿方法的工作原理图。
其中,
101:反射镜 102:倾角传感器 103:基站
1002:高精度可调节基座 1003:线结构激光器
1004:匀速旋转平台 104:光电自准直仪 202:随机控制点
203:精密摆动平台 301:主基站 302:从基站
303:基准尺
具体实施方式
为使本发明实施例的目的、技术方案、有益效果及显著进步更加清楚,下面,将以室内空间测量定位系统(wMPS)基站的姿态变化补偿为例,结合本发明实施例中所提供的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所有描述的这些实施例仅是本发明的部分实施例,而不是全部的实施例;基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
实施例1
如图1-2所示,分布式测量系统基站姿态补偿装置,包括1个基站103,和光电自准直仪104。其中,如图1所示,所述基站103包括由下至上依次固装有高精度可调节基座1002和激光发射装置;所述高精度可调节基座2的中心具有一竖直向上的螺纹柱用于与所述激光发射装置配合连接;所述激光发射装置包括匀速旋转平台1004,所述匀速旋转平台1004的侧壁上周向的安装有两个线结构激光器1003,所述线结构激光器1003能够随所述匀速旋转平台1004一同旋转;还包括嵌在所述基站内部的倾角传感器102,以及设置在所述基站侧壁上的反射镜101;所述基站103放置在精密摆动平台203上(如图2所示)。所述光电自准直仪104的光源出射轴线与所述基站103的反射镜101中心的垂线处于平行状态。
根据实际使用情况,所述装置可以设置多个基站103,每个所述基站配备一个对应的所述光电自准直仪104,所述光电自准直仪的光源出射轴线与其对应的所述基站的反射镜中心的垂线处于平行状态。
所述反射镜101的镜面与倾角传感器坐标系YOZ平面近似重合,镜面法向量与倾角传感器坐标系X轴正方向近似同向,光电自准直仪坐标系不随倾角传感器及镜面坐标系姿态的变化而变化。
如图2所示,利用所述分布式测量系统基站姿态补偿装置的姿态补偿方法,包括以下步骤:
步骤一:将1个基站设置在精密摆动平台203上,所述基站内嵌有倾角传感器102且侧壁上具有反射镜101,选定距离所述光电自准直仪最近的一个基站作为主基站301,调整所述光电自准直仪104的光源出射轴线,使其与所述主基站301的反射镜中心的垂线处于平行状态下;
建立主基站301的倾角传感器坐标系YOZ,由于镜面与倾角传感器坐标系平面近似重合,镜面法向量与倾角传感器坐标系X轴正方向近似同向,以此为基本关系建立主基站的镜面坐标系;其中倾角传感器和基站固连,因此主基站内倾角传感坐标系与基站坐标系、镜面坐标系的相对位姿关系不变;光电自准直仪坐标系不随倾角传感器及镜面坐标系姿态的变化而变化;当主基站301移动时,倾角传感器和反射镜面也会随之移动,但光电自准直仪是始终不动的。本实施例中光电自准直仪104选择德国TRIOPTICS生产的TriAngle-TA500-57,焦距500mm,测角精度达0.4″。
步骤二具体包括如下步骤:
步骤2-1:利用激光跟踪仪201标定空间中的随机控制点202的坐标,随机控制点构成世界坐标系O-XWYWZW,主基站坐标系为O-XTYTZT,利用激光跟踪仪201标定随机控制点的坐标,通过后向交会算法获得主基站301与世界坐标系之间的姿态关系为:
其中,RWT与TWT分别是世界坐标系到单基站坐标系的旋转矩阵和平移矩阵;
步骤2-2:通过精密摆动平台203对主基站301姿态进行3次精密调整,图2示出基站的三个姿态,从左到右用弯曲箭头表示顺序,保证每次姿态变化时位于主基站301上的反射镜面处于准直状态,即令光电自准直仪104的输出值为[0,0],每次调整都通过步骤2-1后向交会算法获得主基站与世界坐标系的姿态关系,推导不同姿态主基站坐标系的姿态关系为:
其中i,j表示主基站不同姿态,RTij、TTij表示主基站坐标系从姿态i到姿态j的旋转矩阵和平移矩阵;
步骤2-3:不考虑平移时,不同姿态之间,主基站301只有绕镜面法向量(设为单位向量nT=[nTxnTynTz]T)的旋转,使用罗德里格斯旋转矩阵求解镜面法向量初值;对罗德里格斯公式逆变换,可以从旋转矩阵获得旋转向量,表达式如下:
其中R代表旋转矩阵;RT代表旋转矩阵的转置,n是旋转向量;
将主基站任意两个姿态之间的旋转矩阵RTij代入表达式获得镜面法向量在基站坐标系下的初值。
步骤2-4:镜面法向量具有如下约束关系:
根据镜面法向量的约束关系建立非线性目标函数,采用L-M算法进行非线性优化,获得镜面法向量在基站坐标系下的表示;非线性目标函数如下:
其中M为罚因子,h为约束关系。;
步骤2-5:已知主基站坐标系与倾角传感器之间的姿态关系RIT,镜面法向量在倾角传感器坐标系下的表示为:
其中RIT代表基站坐标系与倾角传感器之间的姿态关系,nT代表镜面法向量在主基站坐标系下的表示,nI代表镜面法向量在倾角传感器坐标系下的表示;
步骤2-6:设倾角传感器坐标系的基为{iI,jI,kI},其在自身坐标系下的表示为:
iI=[1 0 0]T
jI=[0 1 0]T
kI=[0 0 1]T(8)
镜面坐标系的基为{iM,jM,kM},令镜面法向量为镜面坐标系Z轴,镜面坐标系Y轴与倾角传感器坐标系Z轴垂直,镜面坐标系X轴通过右手定则获得,如图1所示,则镜面坐标系的基在倾角传感器坐标系下表示为:
kM=nI
jM=kM×[0 0 1]T
iM=jM×kM (9)
步骤2-7:根据方向余弦矩阵,倾角传感器坐标系到镜面坐标系的旋转矩阵即表示为:
步骤三具体包括如下步骤:
步骤3-1:根据上述步骤获得的倾角传感器坐标系O-XIYIZI、镜面坐标系O-XMYMZM、光电自准直坐标系O-XAYAZA,设镜面坐标系O-XMYMZM与姿态变化前参与自准直仪测量的镜面坐标系O-XM1YM1ZM1不重合,假定两坐标系关系为:
其中Rz为两坐标系的旋转矩阵,δ为绕Z轴的旋转角;结合上式与步骤2-7,倾角传感器坐标系到镜面坐标系O-XM1YM1ZM1的旋转矩阵表达式为:
R′IM=RZ(δ)RIM (12)
步骤3-2:根据倾角传感器在姿态变化过程中的输出值,获得欧拉旋转角αI1、βI1、αI2、βI2,倾角传感器的姿态变化可表示为:
RI=RY(βI2)RX(αI2)RZ(θI)RX(-αI1)RY(-βI1) (13)
步骤3-3:根据镜面姿态变化过程中自准直仪104的输出值,获得欧拉旋转角αM1、βM1、αM2、βM2,建立约束方程:
F=RIR′IM-R′IMRM1
=RY(βI2)RX(αI2)RZ(θI)RX(-αI1)RY(-βI1)RZ(δ)RIM-RZ(δ)RIMRZ(θM)RY(βM2)RX(αM2)RX(-αM1)RY(-βM1)
=[fij]=[0] (14)
步骤3-4:根据约束方程得到目标函数,并使用L-M算法进行非线性优化:
其中θI为倾角传感器绕Z轴的旋转角度,θM为镜面处于准直状态时绕Z轴的旋转角度,由于倾角传感器与光电自准直仪的测量范围较小,因此将θI、δ、θM的初值设置为0。根据式(13)以及优化后的θI即可得到倾角传感器坐标系的姿态变化矩阵RI,由于基站与倾角传感器刚性连接,即可通过倾角传感器的姿态变化得到基站的姿态变化。
实施例2
实施例2的结构与实施例1近似,在此不再赘述,以下只描述其区别特征。如图3所示,以分布式测量系统的代表室内空间测量定位系统(wMPS)为例,双站系统是wMPS中的基本系统,假定在测量过程中系统内的每一个基站的位姿都会发生变化。系统内设置两个基站,基站编号设为1和2,以基站1为主基站301,基站2为从基站302,其坐标系为世界坐标系。
所述实施例2的分布式测量系统基站姿态补偿装置还包括基准尺303,用于根据基准尺两端点间的基准长度提供基准长度约束。
利用所述分布式测量系统基站姿态补偿装置的姿态补偿方法,包括以下步骤:
步骤一:将2个基站设置在精密摆动平台203上,所述基站301,302内嵌有倾角传感器102且侧壁上具有反射镜101,选定一个基站作为主基站301,调整所述光电自准直仪104的光源出射轴线,使其与所述主基站301的反射镜中心的垂线处于平行状态下;
建立主基站301的倾角传感器坐标系YOZ,由于镜面与倾角传感器坐标系平面近似重合,镜面法向量与倾角传感器坐标系X轴正方向近似同向,以此为基本关系建立主基站的镜面坐标系;其中倾角传感器和基站固连,因此主基站内倾角传感坐标系与基站坐标系、镜面坐标系的相对位姿关系不变;光电自准直仪坐标系不随倾角传感器及镜面坐标系姿态的变化而变化;本实施例中光电自准直仪104选择德国TRIOPTICS生产的TriAngle-TA500-57,焦距500mm,测角精度达0.4″。
步骤二:
利用激光跟踪仪201标定空间中的随机控制点202的坐标,随机控制点构成世界坐标系O-XWYWZW,主基站坐标系为O-XTYTZT,利用激光跟踪仪标定随机控制点的坐标,通过后向交会算法获得单基站与世界坐标系之间的姿态关系为:
RWT1=I,TWT1=0
RWT2=RT12,TWT2=TT12
(17)
其中,以基站301作为主基站,其坐标系作为世界坐标系,则RWT1是世界坐标系到主基站301的旋转矩阵,为单位阵,RWT2是世界坐标系到从基站302坐标系的旋转矩阵,TWT1是世界坐标系到主基站301的平移矩阵,为零向量,TWT2是世界坐标系到从基站302坐标系的平移矩阵;
RT12是主基站301坐标系到从基站302坐标系的旋转矩阵;
TT12是主基站301坐标系到从基站302坐标系的平移矩阵;
步骤三:
由于基站与倾角传感器刚性连接,基站与倾角传感器之间的姿态关系始终保持不变,则单基站的姿态变化Rd满足如下方程:
其中RIT为倾角传感器坐标系到基站坐标系的旋转矩阵,RI为倾角传感器坐标系的姿态变化矩阵,参见式(13),RX、RY、RZ分别为RI三个轴的分量,α和β为倾角传感器输出值(下标1代表变化前,下标2代表变化后);
双站系统中基站301和基站302的姿态变化Rd1和Rd2满足:
其中RT12和R′T12为姿态变化前和变化后基站301到基站302的旋转矩阵,此时的RWT2即为双站系统中新的姿态参数。
根据基站301坐标系的姿态变化Rd1可以得到点O2在新的基站1坐标系下的坐标为
进而可得位姿变化后的基站301到基站302的平移矩阵
T′12可作为初值进行非线性优化。
利用基准尺303的基准长度为系统提供额外约束,根据基准尺两端点以及基站交会条件,可以得到如下约束:
其中l=1,2为基准尺两端点序号,RWT2可根据位姿变化前的参数与上式补偿得到。
根据基准尺的基准长度约束r(C),可以建立目标函数为:
综上所述,本发明公开了分布式测量系统基站姿态补偿装置及方法,解决了仅使用倾角传感器无法完全满足姿态更新要求的问题,实现对基站姿态变化的自动补偿,增强测量系统的稳定性,大大提高了分布式测量系统的在复杂工业现场的适用性。
其中,本发明技术方案中涉及的倾角传感器测量模型可参考文献:“张维胜.倾角传感器原理和发展[J].传感器世界,2002,{4}(08):18-21.”;
光电自准直仪测量模型可参考文献:“欧同庚,陈志高,杨博雄,付辉清.CCD光电自准直仪工作原理及误差源分析[J].大地测量与地球动力学,2007,{4}(S1):98-100.”;
基站测量模型可参考文献:“杨凌辉.基于光电扫描的大尺度空间坐标测量定位技术研究[D].天津大学,2010”;
空间后向交会测量方法可参考文献:“刘哲旭.面向大型复杂现场的测量定位方法研究[D].天津大学,2014”。
以上实施例仅用以说明本发明的技术方案,而非是对其的限制,尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解,其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换,而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围,本领域技术人员根据本说明书内容所做出的非本质改进和调整或者替换,均属本发明所要求保护的范围。
Claims (9)
1.分布式测量系统基站姿态补偿装置,其特征在于,包括多个基站(103)和光电自准直仪(104);
其中,所述基站包括嵌在所述基站内部的倾角传感器(102),以及设置在所述基站侧壁上的反射镜(101);所述基站放置在精密摆动平台(203)上;
所述反射镜镜面与倾角传感器坐标系YOZ平面近似重合,镜面法向量与倾角传感器坐标系X轴正方向近似同向,光电自准直仪坐标系不随倾角传感器及镜面坐标系姿态的变化而变化;
所述光电自准直仪的光源出射轴线与所述基站的反射镜中心的垂线处于平行状态。
2.根据权利要求1所述的分布式测量系统基站姿态补偿装置,其特征在于,所述补偿装置还包括基准尺(303),用于根据基准尺两端点间的基准长度提供基准长度约束。
3.根据权利要求1所述的分布式测量系统基站姿态补偿装置,其特征在于,所述装置设置一个所述光电自准直仪(104)和多个基站(103),选定其中一个基站为主基站,所述光电自准直仪的光源出射轴线与所述主基站的反射镜中心的垂线处于平行状态。
4.根据权利要求1所述的分布式测量系统基站姿态补偿装置,其特征在于,所述装置设置多个基站(103),每个所述基站配备一个对应的所述光电自准直仪(104),所述光电自准直仪的光源出射轴线与其对应的所述基站的反射镜中心的垂线处于平行状态。
5.利用权利要求1所述分布式测量系统基站姿态补偿装置的姿态补偿方法,包括以下步骤:
步骤一:将多个基站(103)设置在精密摆动平台(203)上,所述基站内嵌有倾角传感器(102)且侧壁上具有反射镜(101),选定一个基站作为主基站(301),其余基站为从基站,调整所述光电自准直仪(104)的光源出射轴线,使其与所述主基站(301)的反射镜中心的垂线处于平行状态下;
建立主基站(301)的倾角传感器坐标系,由于镜面与倾角传感器坐标系平面近似重合,镜面法向量与倾角传感器坐标系X轴正方向近似同向,以此为基本关系建立主基站的镜面坐标系;其中倾角传感器和基站固连,因此主基站内倾角传感坐标系与基站坐标系、镜面坐标系的相对位姿关系不变;光电自准直仪坐标系不随倾角传感器及镜面坐标系姿态的变化而变化;
步骤二:利用激光跟踪仪(201)标定空间中的随机控制点(202)的坐标,所述随机控制点(202)构成世界坐标系,通过后向交会算法获得主基站(301)与世界坐标系之间的姿态关系,利用所述精密摆动平台(203)多次调整主基站(301)姿态,标定倾角传感坐标系与镜面坐标系之间的旋转矩阵,获得新的主基站坐标系及其倾角传感器的姿态变化;其中所述姿态关系为世界坐标系到主基站坐标系的旋转矩阵和平移矩阵;
步骤三:利用步骤二获得的新的主基站坐标系及其倾角传感器的姿态变化,在新的主基站坐标系下表达其余基站的坐标系,获得主基站与从基站的姿态变化;通过倾角传感器姿态变化过程的输出值与镜面姿态变化过程中所述光电自准直仪的输出值,建立倾角传感器与光电自准直仪组合测量约束方程与目标函数;将姿态变化后的主基站坐标系到从基站坐标系的平移矩阵作为初值进行非线性优化,从而得到位姿变化后的位置参数,实现实时更新基站姿态。
6.利用权利要求5所述的姿态补偿方法,其特征在于所述步骤三在“将姿态变化后的主基站坐标系到从基站坐标系的平移矩阵作为初值进行非线性优化”后还包括:进一步利用基准尺的基准长度为约束建立目标函数,非线性优化所述目标函数从而得到位姿变化后的位置参数,实现实时更新基站姿态。
7.利用权利要求5所述的姿态补偿方法,其特征在于步骤二具体包括如下步骤:
步骤2-1:由空间中的随机控制点构成世界坐标系O-XWYWZW,基站坐标系为O-XTYTZT,利用激光跟踪仪标定随机控制点的坐标,通过后向交会算法获得主基站与世界坐标系之间的姿态关系为:
其中,RWT与TWT分别是世界坐标系到单基站坐标系的旋转矩阵和平移矩阵;
步骤2-2:通过精密摆动平台对基站姿态进行多次精密调整,并保证每次姿态变化时反射镜面处于准直状态,即令光电自准直仪的输出值为[0,0],每次调整都通过步骤2-1后向交会算法获得基站与世界坐标系的姿态关系,推导不同姿态基站坐标系的姿态关系为:
其中i,j表示基站不同姿态,RTij、TTij表示基站坐标系从姿态i到姿态j的旋转矩阵和平移矩阵;
步骤2-3:不考虑平移时,不同姿态之间,基站只有绕镜面法向量的旋转,使用罗德里格斯旋转矩阵求解镜面法向量初值;对罗德里格斯公式逆变换,从旋转矩阵获得旋转向量,表达式如下:
其中R代表旋转矩阵;RT代表旋转矩阵的转置,n是旋转向量,镜面法向量设为单位向量nT=[nTxnTynTz]T;
将基站任意两个姿态之间的旋转矩阵RTij代入表达式获得镜面法向量在基站坐标系下的初值;
步骤2-4:镜面法向量具有如下约束关系:
根据镜面法向量的约束关系建立非线性目标函数,采用L-M算法进行非线性优化,获得镜面法向量在基站坐标系下的表示;非线性目标函数如下,式中M为罚因子,h为约束关系;
步骤2-5:已知基站坐标系与倾角传感器之间的姿态关系RIT,镜面法向量在倾角传感器坐标系下的表示为:
步骤2-6:设倾角传感器坐标系的基为{iI,jI,kI},其在自身坐标系下的表示为:
iI=[1 0 0]T
jI=[0 1 0]T
kI=[0 0 1]T (8)
镜面坐标系的基为{iM,jM,kM},令镜面法向量为镜面坐标系Z轴,镜面坐标系Y轴与倾角传感器坐标系Z轴垂直,镜面坐标系X轴通过右手定则获得,如图1所示,则镜面坐标系的基在倾角传感器坐标系下表示为:
kM=nI
jM=kM×[0 0 1]T
iM=jM×kM (9)
步骤2-7:根据方向余弦矩阵,倾角传感器坐标系到镜面坐标系的旋转矩阵即表示为:
8.利用权利要求5所述的姿态补偿方法,其特征在于,所述步骤三具体包括如下步骤:
步骤3-1:根据上述步骤获得的倾角传感器坐标系O-XIYIZI、镜面坐标系O-XMYMZM、光电自准直坐标系O-XAYAZA,设镜面坐标系O-XMYMZM与姿态变化前参与自准直仪测量的镜面坐标系O-XM1YM1ZM1不重合,假定两坐标系关系为:
其中Rz为两坐标系的旋转矩阵,δ为绕Z轴的旋转角;结合上式与步骤2-7,倾角传感器坐标系到镜面坐标系O-XM1YM1ZM1的旋转矩阵表达式为:
R′IM=RZ(δ)RIM (12)
步骤3-2:根据倾角传感器在姿态变化过程中的输出值,获得欧拉旋转角αI1、βI1、αI2、βI2,倾角传感器的姿态变化可表示为:
RI=RY(βI2)RX(αI2)RZ(θI)RX(-αI1)RY(-βI1) (13)
步骤3-3:根据镜面姿态变化过程中自准直仪的输出值,获得欧拉旋转角αM1、βM1、αM1、βM1,建立约束方程:
F=RIR′IM-R′IMRM1
=RY(βI2)RX(αI2)RZ(θI)RX(-αI1)RY(-βI1)RZ(δ)RIM-RZ(δ)RIMRZ(θM)RY(βM2)RX(αM2)RX(-αM1)RY(-βM1)
=[fij]=[0] (14)
步骤3-4:根据约束方程得到目标函数,并使用L-M算法进行非线性优化:
9.根据权利要求1所述的分布式测量系统基站姿态补偿装置,其特征在于,所述光电自准直仪的测角精度为0.4″,所述倾角传感器为双轴倾角传感器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110979188.9A CN113686319B (zh) | 2021-08-25 | 2021-08-25 | 分布式测量系统基站姿态补偿装置及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110979188.9A CN113686319B (zh) | 2021-08-25 | 2021-08-25 | 分布式测量系统基站姿态补偿装置及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113686319A true CN113686319A (zh) | 2021-11-23 |
CN113686319B CN113686319B (zh) | 2022-05-27 |
Family
ID=78582147
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110979188.9A Active CN113686319B (zh) | 2021-08-25 | 2021-08-25 | 分布式测量系统基站姿态补偿装置及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113686319B (zh) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102374847A (zh) * | 2011-09-14 | 2012-03-14 | 天津大学 | 工作空间六自由度位姿动态测量设备及方法 |
CN102435177A (zh) * | 2011-09-14 | 2012-05-02 | 天津大学 | 室内测量定位系统单发射站位姿参数在线修正方法 |
CN107144273A (zh) * | 2017-06-06 | 2017-09-08 | 天津大学 | 基于倾角传感的室内测量定位系统基站姿态自动补偿方法 |
CN109238247A (zh) * | 2018-07-15 | 2019-01-18 | 天津大学 | 一种面向大空间复杂现场的六自由度测量方法 |
CN109489642A (zh) * | 2018-11-09 | 2019-03-19 | 北京航天计量测试技术研究所 | 一种空间任意姿态下两立方镜相对姿态的动态测量方法 |
-
2021
- 2021-08-25 CN CN202110979188.9A patent/CN113686319B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102374847A (zh) * | 2011-09-14 | 2012-03-14 | 天津大学 | 工作空间六自由度位姿动态测量设备及方法 |
CN102435177A (zh) * | 2011-09-14 | 2012-05-02 | 天津大学 | 室内测量定位系统单发射站位姿参数在线修正方法 |
CN107144273A (zh) * | 2017-06-06 | 2017-09-08 | 天津大学 | 基于倾角传感的室内测量定位系统基站姿态自动补偿方法 |
CN109238247A (zh) * | 2018-07-15 | 2019-01-18 | 天津大学 | 一种面向大空间复杂现场的六自由度测量方法 |
CN109489642A (zh) * | 2018-11-09 | 2019-03-19 | 北京航天计量测试技术研究所 | 一种空间任意姿态下两立方镜相对姿态的动态测量方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113686319B (zh) | 2022-05-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11035660B2 (en) | Inertial dimensional metrology | |
US11441899B2 (en) | Real time position and orientation tracker | |
CN108198219B (zh) | 用于摄影测量的相机标定参数的误差补偿方法 | |
CN109238247B (zh) | 一种面向大空间复杂现场的六自由度测量方法 | |
CN101539397B (zh) | 物体三维姿态的精密光学测量方法 | |
CN111486864B (zh) | 基于立体正八边结构的多源传感器联合标定方法 | |
CN107817003B (zh) | 一种分布式大尺寸空间定位系统的外参数标定方法 | |
CN113295049B (zh) | 一种运载火箭瞄准方法及装置 | |
CN108489468B (zh) | 三线阵影像外方位元素平滑方程自适应光束法平差方法 | |
CN110631567A (zh) | 一种差分天空偏振罗盘大气折射误差的反演及修正方法 | |
CN107727118B (zh) | 大型飞行器中的gnc分系统设备姿态测量系统标定方法 | |
CN108594255B (zh) | 一种激光测距辅助光学影像联合平差方法及系统 | |
CN111044077B (zh) | 星敏感器测量坐标系与星敏感器立方镜坐标系间的标定方法 | |
Guo et al. | Application of a self-compensation mechanism to a rotary-laser scanning measurement system | |
CN115235414A (zh) | 一种大口径望远镜指向变化检测与修正方法 | |
CN114608806A (zh) | 一种基于双目相机的激光振镜扫描系统的标定方法 | |
CN108645392B (zh) | 一种相机安装姿态校准方法及装置 | |
CN113686319B (zh) | 分布式测量系统基站姿态补偿装置及方法 | |
CN113607188A (zh) | 基于经纬仪叉丝成像的多视场星敏感器的标定系统及方法 | |
CN109489642B (zh) | 一种空间任意姿态下两立方镜相对姿态的动态测量方法 | |
CN113177987B (zh) | 一种视觉跟踪测量系统外场全局标定方法及系统 | |
CN111561867A (zh) | 一种飞机表面形貌数字化测量方法 | |
CN114353802A (zh) | 一种基于激光跟踪的机器人三维空间定位方法 | |
JP2021089246A (ja) | アライメント測定システム、情報処理装置、アライメント測定方法及びプログラム | |
CN117190919B (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 |