CN108225286B - 一种移动站车载全站仪位姿估计方法 - Google Patents
一种移动站车载全站仪位姿估计方法 Download PDFInfo
- Publication number
- CN108225286B CN108225286B CN201711481025.8A CN201711481025A CN108225286B CN 108225286 B CN108225286 B CN 108225286B CN 201711481025 A CN201711481025 A CN 201711481025A CN 108225286 B CN108225286 B CN 108225286B
- Authority
- CN
- China
- Prior art keywords
- total station
- coordinate system
- station
- track
- rail
- 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
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
Abstract
一种移动站车载全站仪位姿估计方法,按如下步骤:(1)测量并计算车载全站仪和轨检仪的初始姿态;(2)基于全站仪位姿模型的位姿估计。本发明利用轨检仪在行进过程中,全站仪坐标系与轨检仪坐标系位姿关系始终不变的基本规律,构建全站仪和轨检仪位姿模型,并在此基础上结合行进中轨检仪姿态信息和1个CPIII控制点的测量数据,对移动站车载全站仪的位姿进行估计,从而实现全站仪免置平设站中棱镜点的自动照准和测量。该方法使全站仪在免置平设站过程中能自动、快速、精确地照准目标,适用于高速铁路无砟轨道的快速精调与日常维护,可有效提高车载全站仪轨道精测方法的测量效率和自动化程度。
Description
技术领域
本发明属于铁路轨道测量技术领域。
背景技术
鉴于无砟轨道的高稳定、高平顺与低维护等特点,《高速铁路设计规范》中建议,高铁轨道结构宜采用全线无缝、无砟轨道结构。但同时,无砟轨道作为一种新的轨道结构,具有很强的试验性。通过在京沪、郑徐、沪昆等高速铁路的铺设和使用,我国已在轨道铺设、落成等方面取得了一定的成果,形成了自身的技术体系。然而,对于高铁无砟轨道三维坐标及绝对位置测量和控制方面,现有客运专线轨道测量仪(绝对测量技术)在环境适应性、测量效率、平顺性精度方面都在不足,这不但影响了我国高铁的建设速度、也增大了线路运营养护的成本。
现有的“绝对+相对”轨道精调技术表明,采用少量的轨道测量仪定位数据对轨道检查仪相对测量轨迹进行约束的技术模式是可行的,有利于更好地控制轨道绝对位置和线路平顺性。为进一步贯彻这一技术路线,避免轨道测量仪和轨道检查仪在数据采集中的独立使用造成的设备成本、人力成本和时间成本多重浪费,以两种仪器的测量技术为基础,进行车载全站仪轨道精测方法的研究,从根本上实现,一套设备和一套人马在一次测量内完成全部轨道数据的采集。所谓车载全站仪轨道精测方法,在原有轨道检查仪上安装了具有高精度免置平设站功能的全站仪和测量控制分析软件,在陀螺仪测量轨道相对轨迹同时,以CPIII控制网为基准进行全站仪免置平设站并采集轨道的定位数据。
为保证测量精度,车载全站仪在免置平设站过程中,通常需要测量6-8个CPIII控制点。根据全站仪免置平设站原理,在全站仪自身位置和姿态未知的情况下,需要人工进行至少4个CPIII控制点的照准和测量。当完成4个以上的CPIII控制点的测量以后,才能计算全站仪位置和姿态的初始解(粗解),并以此为基础获得所有CPIII控制点在全站仪坐标系下的坐标和角度,实现程序控制下的后续待测点的自动照准和测量。全站仪安装于轨道检查仪上,其视准轴仅高出轨道面约30公分,不利于CPIII控制点的人工照准,而且,人工照准需要在全站仪前完成,而测量控制需要在电脑软件上进行,每进行一个CPIII控制点的人工照准和测量,需要测量人员往返于电脑和全站仪之间一次。综上所述,车载全站仪每次免置平设站都需要对前4个CPIII控制点进行人工照准和测量,工作繁琐,影响效率。
鉴于此,在轨道检查仪停稳后,即车载全站仪进行免置平设站前,利用轨道已知参数或轨道检查仪相关测量数据,对全站仪的位置和姿态进行估计即是技术可能也是工程需要。完成全站仪位置和姿态的估计后,可计算出所有CPIII控制点在全站仪坐标系下的近似坐标和近似角度,再结合全站仪的自动照准功能,实现全站仪快速精确地照准目标棱镜和精确测量,可极大地提高车载全站仪轨道精测系统的测量效率和自动化程度。
发明内容
本发明的目的是克服现有技术在全站仪位置未知,设站速度慢、自动化程度低的不足,提出一种移动站车载全站仪的位姿估计方法。
本发明是通过以下步骤实现的。
本发明所述的一种移动站车载全站仪位姿估计方法,按如下步骤:
(1)测量并计算车载全站仪和轨检仪的初始姿态。
建立轨检仪独立坐标系,原点建立轨检仪坐标系O'-X'Y'Z',以X'轴正方向为轨道前进方向,Z'轴垂直于轨道所在平面,向上为正方向,Y'轴在轨道所在平面内,与X'轴和Z'轴正交,符合空间直角坐标系左手定则。轨检仪坐标系的正北方向角θ'、俯仰角α'可通过轨道设计线形计算得到,而水平倾斜角β'可通过水平传感器测量得到。根据空间坐标转换关系,可得到轨检仪坐标系O'-X'Y'Z'与大地坐标系O-XYZ的坐标转换关系(如式(1)):
其中,R′为轨检仪姿态矩阵,X、Y、Z为大地坐标系下的坐标,X′、Y′、Z′为轨检仪坐标系下的坐标,Xs、Ys、Zs为全站仪站点在大地坐标系下的坐标。
建立全站仪坐标系与大地坐标系之间的坐标转换关系,(Xs,Ys,Zs)为全站仪站点坐标。
其中,R为全站仪姿态矩阵,X、Y、Z为大地坐标系下的坐标,Xs、Ys、Zs为全站仪站点在大地坐标系下的坐标,x、y、z为全站仪坐标系下的坐标。
(2)基于全站仪位姿模型的位姿估计(全站仪当前的姿态矩阵、全站仪当前站点坐标)。
通过全站仪姿态矩阵R和轨检仪姿态矩阵R′,可求解全站仪坐标系到轨检仪坐标系的坐标旋转矩阵Rs:
Rs=(R')-1R (3)
当轨检仪推至新的轨道位置时,根据里程增量△l,得到全站仪当前点里程l。再由此查询轨道设计线形中坡度表和曲线表,得到当前轨道坡度αi和轨道方向角θi,再结合轨检仪水平传感器测量值得到当前水平角βi,求解当前轨检仪坐标系与大地坐标系的坐标旋转矩阵R'i
测量过程中坐标旋转矩阵Rs保持不变,可得到全站仪当前的姿态矩阵:
Ri=R'iRs (5)
控制全站仪对所跟踪的CPIII控制点进行测量,得到全站仪坐标系下该CPIII控制点的坐标(x,y,z),根据公式(6)便可计算出全站仪当前站点坐标(Xsi,Ysi,Zsi):
完成移动站车载免置平全站仪位置和姿态的估计。
基于已估计出的全站仪位置和姿态信息估计CPIII控制点位置。
CPIII棱镜在大地坐标系下的坐标(X,Y,Z)是已知的,通过公式(7)可求出CPIII控制点在全站仪坐标系下的坐标(x,y,z):
全站仪坐标系下各目标棱镜的坐标(x,y,z)已知后,计算目标棱镜在全站仪坐标系下的其水平角Ah和垂直角Av,实现CPIII目标棱镜位置估计,达到指令控制下全站仪旋转和照准棱镜,达到提高免置平设站效率的目的。
本发明利用轨检仪在行进过程中,全站仪坐标系与轨检仪坐标系位姿关系始终不变的基本规律,构建全站仪和轨检仪位姿模型,并在此基础上结合行进中轨检仪姿态信息和1个CPIII控制点的测量数据,对移动站车载全站仪的位姿进行估计,从而实现全站仪免置平设站中棱镜点的自动照准和测量。该方法使全站仪在免置平设站过程中能自动、快速、精确地照准目标,适用于高速铁路无砟轨道的快速精调与日常维护,可有效提高车载全站仪轨道精测方法的测量效率和自动化程度。
附图说明
附图1为车载全站仪位姿模型示意图。
附图2为车载全站仪位姿估计程序流程图。
具体实施方式
本发明将通过以下实施例作进一步说明。
实施例1。
全站仪坐标系与轨检仪坐标系之间的坐标旋转矩阵求解。
(1)轨道设计线形、CPIII设计坐标等资料的准备和数据导入软件。
(2)新建测量文件,开启相对测量,获取轨检仪相对测量数据后,进行首次全站仪免置平手动设站,通过平差方法求解全站仪站点坐标和姿态。采用公式3,求全站仪坐标系到大地坐标系的坐标旋转矩阵R0。
(3)根据轨检仪水平传感器测量信息和线路设计线形中的方向角和俯仰角数据,采用公式1求解轨检仪坐标系到大地坐标系的坐标旋转矩阵R'0。
(4)通过公式13中的矩阵求逆和矩阵乘法求解全站仪坐标系到轨检仪坐标系的坐标旋转矩阵。姿态和轨道中线坐标计算,求出全站仪坐标系与轨检仪坐标系间的坐标旋转矩阵RS。
Rs=(R'0)-1R0 (8)
其程序流程如附图2中首次全站仪免置平设站和轨道定位测量部分所示。
实施例2。
进行移动站车载全站仪位姿的估计。
(1)推行轨检仪至第1站,通过里程、超高等相对测量数据计算轨检仪坐标系与大地坐标系之间的坐标旋转矩阵R'1。
(2)基于全站仪坐标系与轨检仪坐标系之间的位姿关系始终不变的客观规律,计算全站仪坐标系与大地坐标系之间的坐标旋转矩阵。
(3)通过对第1站第1个CPIII控制点坐标(x11,y11,z11)的测量,计算全站仪第1站的站点坐标。
其程序流程如附图2中第i次全站仪免置平设站和轨道定位测量部分所示。
实施例3。
(1)对CPIII目标棱镜的位置进行估计。
(2)完成车载全站仪站点坐标(Xsi,Ysi,Zsi)和旋转矩阵Ri的估计后,通过公式(7)估计当前站8个CPIII控制点在全站仪坐标系下的水平角和垂直角;
(3)使用全站仪GeoCOM接口调用全站仪机载程序,将其视准轴定位到待测量的CPIII基桩点附近,旋转定位子程序为AUT_MakePositioning(double Hz,double V,AUT_POSMODE POSMode,AUT_ATRMODE ATRMode,BOOLE bDummy),Hz和V即为水平角和垂直角,其余为与旋转定位相关的模式参数。ATRMODE为AUT_TARGET时,当全站仪旋转到目标位置后,将会在照准范围内自动照准棱镜。
Claims (1)
1.一种移动站车载全站仪位姿估计方法,其特征是按如下步骤:
(1)测量并计算车载全站仪和轨检仪的初始姿态
建立轨检仪独立坐标系O'-X'Y'Z',其以全站仪站点(Xs,Ys,Zs)为原点,以X'轴正方向为轨道前进方向,Z'轴垂直于轨道所在平面,向上为正方向,Y'轴在轨道所在平面内,与X'轴和Z'轴正交,符合空间直角坐标系左手定则;轨检仪坐标系的正北方向角θ'、俯仰角α'通过轨道设计线形计算得到,而水平倾斜角β'通过水平传感器测量得到;根据空间坐标转换关系,得到轨检仪坐标系O'-X'Y'Z'与大地坐标系O-XYZ的坐标转换关系:
其中,R′为轨检仪姿态矩阵,X、Y、Z为大地坐标系下的坐标,X′、Y′、Z′为轨检仪坐标系下的坐标,Xs、Ys、Zs为全站仪站点在大地坐标系下的坐标;
建立全站仪坐标系与大地坐标系之间的坐标转换关系:
其中,R为全站仪姿态矩阵,x、y、z为全站仪坐标系下的坐标;
(2)基于全站仪位姿模型的位姿估计
通过全站仪姿态矩阵R和轨检仪姿态矩阵R′,求解全站仪坐标系到轨检仪坐标系的坐标旋转矩阵Rs:
Rs=(R')-1R (3)
当轨检仪推至新的轨道位置时,根据里程增量△l,得到全站仪当前点里程l,再由此查询轨道设计线形中坡度表和曲线表,得到当前轨道坡度αi和轨道方向角θi,再结合轨检仪水平传感器测量值得到当前水平角βi,求解当前轨检仪坐标系与大地坐标系的坐标旋转矩阵R'i:
测量过程中坐标旋转矩阵Rs保持不变,得到全站仪当前的姿态矩阵:
Ri=R'iRs (5)
控制全站仪对所跟踪的CPIII控制点进行测量,得到全站仪坐标系下该CPIII控制点的坐标(x,y,z),根据公式(6)计算出全站仪当前站点坐标(Xsi,Ysi,Zsi):
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711481025.8A CN108225286B (zh) | 2017-12-29 | 2017-12-29 | 一种移动站车载全站仪位姿估计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711481025.8A CN108225286B (zh) | 2017-12-29 | 2017-12-29 | 一种移动站车载全站仪位姿估计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108225286A CN108225286A (zh) | 2018-06-29 |
CN108225286B true CN108225286B (zh) | 2020-09-29 |
Family
ID=62646177
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711481025.8A Active CN108225286B (zh) | 2017-12-29 | 2017-12-29 | 一种移动站车载全站仪位姿估计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108225286B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109959334B (zh) * | 2019-03-01 | 2020-10-27 | 湖南悟空信息科技有限公司 | 一种轨道自动测量车视频坐标的计算方法 |
CN110017823B (zh) * | 2019-04-29 | 2022-02-08 | 江西日月明测控科技股份有限公司 | 基于全站仪免置平设站的轨道定位坐标计算方法及装置 |
CN112729220A (zh) * | 2019-10-14 | 2021-04-30 | 图达通智能科技(苏州)有限公司 | 一种对路测感知系统的实时位姿测量系统、补偿方法 |
CN113048972B (zh) * | 2021-03-12 | 2023-05-23 | 衢州海西电子科技有限公司 | 矿山工程机械姿态位置确定方法及系统 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4426915B2 (ja) * | 2004-07-12 | 2010-03-03 | 大成建設株式会社 | トータルステーションを用いた測定方法 |
CN102865862A (zh) * | 2012-09-24 | 2013-01-09 | 江西日月明铁道设备开发有限公司 | 全站仪免置平自由设站及其工程测量方法 |
-
2017
- 2017-12-29 CN CN201711481025.8A patent/CN108225286B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4426915B2 (ja) * | 2004-07-12 | 2010-03-03 | 大成建設株式会社 | トータルステーションを用いた測定方法 |
CN102865862A (zh) * | 2012-09-24 | 2013-01-09 | 江西日月明铁道设备开发有限公司 | 全站仪免置平自由设站及其工程测量方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108225286A (zh) | 2018-06-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108225286B (zh) | 一种移动站车载全站仪位姿估计方法 | |
CN106092056B (zh) | 一种高速铁路桥梁基础沉降变形的车载动态监测方法 | |
CN101408410B (zh) | 隧道体元形变移动监测系统及隧道体元形变移动监测方法 | |
CN108413946B (zh) | 一种车载全站仪位置参数的测量方法 | |
CN106342197B (zh) | 一种用于对激光设备进行远近距离动态精度指标测试的系统 | |
CN108444432B (zh) | 一种铁路既有线控制网及轨道线形同步测量方法 | |
CN111519482B (zh) | 一种铺轨机的导航控制方法、铺轨机及铺轨机系统 | |
CN207907883U (zh) | 一种高效高精度的飞机水平测量系统 | |
CN110017823B (zh) | 基于全站仪免置平设站的轨道定位坐标计算方法及装置 | |
CN104297771B (zh) | 一种用于gnss精确快速测量高程的设备及方法 | |
CN113212491B (zh) | 一种用于轨道线路平顺性评价的设站测量方法 | |
CN103754235A (zh) | 一种高铁测量用惯性定位定向装置及方法 | |
CN108458698A (zh) | 全站仪不整平测量的未知点三维坐标计算方法 | |
CN106324632A (zh) | 无控制点条件下的植保无人机精确定位方法 | |
CN209479681U (zh) | 实现轨道快速检测的测量小车 | |
CN101487210B (zh) | 底座混凝土钢模放样测量方法 | |
CN109085655A (zh) | 一种水下平台重力测量方案与验证方法 | |
CN108919304A (zh) | 一种基于参考平面的移动测量系统中pos误差补偿方法 | |
CN105648860A (zh) | 城市轨道交通用轨道板的测量调整系统及其测量调整方法 | |
CN108318011B (zh) | 一种通过无人机搭载全站仪监测施工场地周边位移的方法 | |
CN103925904B (zh) | 一种基于对称测线的超短基线安装角度偏差无偏估计方法 | |
CN205280095U (zh) | 采煤机惯性导航定位误差校准装置 | |
CN103276644A (zh) | 基于轨道基桩控制网进行轨道交通接触网、轨测量方法 | |
CN104266664B (zh) | 一种管道中心线测量的螺旋误差补偿方法及测量设备 | |
CN106546229B (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 |