CN105652305A - 一种动态环境下轨道检测平台的三维定位定姿方法及*** - Google Patents

一种动态环境下轨道检测平台的三维定位定姿方法及*** Download PDF

Info

Publication number
CN105652305A
CN105652305A CN201610010650.3A CN201610010650A CN105652305A CN 105652305 A CN105652305 A CN 105652305A CN 201610010650 A CN201610010650 A CN 201610010650A CN 105652305 A CN105652305 A CN 105652305A
Authority
CN
China
Prior art keywords
attitude
solid camera
ins
binocular solid
camera
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
Application number
CN201610010650.3A
Other languages
English (en)
Other versions
CN105652305B (zh
Inventor
李清泉
陈智鹏
毛庆洲
刘勇
熊智敏
张亮
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shenzhen University
Original Assignee
Shenzhen University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Shenzhen University filed Critical Shenzhen University
Priority to CN201610010650.3A priority Critical patent/CN105652305B/zh
Publication of CN105652305A publication Critical patent/CN105652305A/zh
Application granted granted Critical
Publication of CN105652305B publication Critical patent/CN105652305B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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
    • G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
    • 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/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Navigation (AREA)

Abstract

本发明提供了一种动态环境下轨道检测平台的三维定位定姿方法及***，方法包括：对双目立体相机的左右相机的相对空间位置姿态进行标定；对双目立体相机与激光惯导之间的相对位置姿态参数进行标定；根据双目立体相机对CPIII控制点进行拍照获取多张控制点图片，并根据立体后交得到双目立体相机的位置和姿态；将双目立体相机的位置和姿态作为带权观测值输入INS/OD导航***进行滤波、平滑及内插处理，得到轨道检测平台的位置和姿态。本发明通过视觉方法将轨道线路高精度控制网数据与惯导/里程计数据与融合，采用联合解算方法，实现动态轨道检测平台的连续且高精度的定位定姿，可广泛用于高铁、地铁的轨道检测、移动道路测量等应用。

Description

一种动态环境下轨道检测平台的三维定位定姿方法及***
技术领域
本发明涉及测绘技术领域，尤其涉及一种动态环境下轨道检测平台的三维定位定姿方法及***。
背景技术
目前，随着经济的飞速发展和城市化进程的加快，城市轨道交通也进入大发展时期。当前城市轨道交通发展迅速，通车里程长，列车运行速度快、密度高，对于列车运行的安全性要求越来越高，提高城市轨道交通检测的快速性、准确性、高效性具有重要意义。轨道和隧道是影响列车运行安全的两个重要因素，因此利用轨道检测装备对铁路和隧道的状态、病害进行精确、快速地测量和检测是确保列车运行安全的必要途径。
城市轨道交通隧道环境下轨检***的高精度动态三维定位定姿方法，是实现城市轨道快速、连续、可靠检测的关键技术。城市轨道交通隧道环境下轨检***在轨道移动平台上集成激光惯导（INS）、里程计（OD）、激光扫描仪、线结构光激光扫描仪、CCD相机等多传感器，实现城市轨道交通基础设施全断面信息的快速获取。基于此信息对城市轨道状态的实时自动化分析，为城市轨道交通安全运营提供及时可靠的轨道状态信息与技术保障。
目前轨道检测设备主要围绕着两个典型的研发方向，一个是以高精度轨检小车为代表，一个是以综合轨检车为代表。轨检小车利用全站仪（测量机器人）对铁路沿线的控制点进行观测建立空间基准，然后对轨道的几何状态进行检测。动态轨检平台的三维空间基准是整个轨道检测***的基础，其测量精度直接决定了轨道结构检测***的精度与可靠性。但是城市地铁隧道环境对GNSS（全球卫星导航***）信号形成了遮挡，GNSS/INS的组合定位定姿方法会受到很大的影响，不能满足检测***的精度和效率要求。
因此，现有技术还有待发展。
发明内容
鉴于上述现有技术的不足之处，本发明的目的在于提供一种动态环境下轨道检测平台的三维定位定姿方法及***，旨在解决现有技术中城市地铁隧道环境对GNSS信号形成的遮挡，使得GNSS/INS的组合定位定姿方法受到很大的影响，不能满足检测***的精度和效率要求的问题。
为了达到上述目的，本发明采取了以下技术方案：
一种动态环境下轨道检测平台的三维定位定姿方法，其中，所述方法包括以下步骤：
A、对双目立体相机的左右相机的相对空间位置姿态进行标定；
B、对双目立体相机与激光惯导之间的相对位置姿态参数进行标定；
C、根据双目立体相机对CPIII控制点进行拍照获取多张控制点图片，并根据立体后交得到双目立体相机的位置和姿态；
D、将双目立体相机的位置和姿态作为带权观测值输入INS/OD导航***，并进行滤波、平滑及内插处理，得到轨道检测平台的位置和姿态；其中，所述INS/OD导航***为惯导/里程计导航***。
所述动态环境下轨道检测平台的三维定位定姿方法，其中，所述步骤A具体包括：
A1、双目立体相机对已建立的三维相机标定场进行拍照，获取多对观测位置各不相同的立体像对；
A2、获取每一立体像对的像点坐标，根据立体像对的像点坐标及与像点坐标相对应控制点的三维坐标进行标定，并根据光束法平差算法获取双目立体相机中每一相机内参数、畸变系数及左右相机的相对位置姿态参数。
所述动态环境下轨道检测平台的三维定位定姿方法，其中，所述步骤B中通过同一时刻双目立体相机的位置和姿态与GNSS/INS导航***得到的位置和姿态进行比对，标定双目立体相机坐标系到惯导载体坐标系转换关系；其中GNSS/INS导航***为全球卫星导航***/惯导组合导航***。
所述动态环境下轨道检测平台的三维定位定姿方法，其中，所述步骤C具体包括：
C1、通过双目立体相机获取轨道上预先设置的多个控制点的CPIII坐标；
C2、获取每一控制点上标靶的像点坐标；
C3、将标靶的像点坐标与对应的控制点的CPIII坐标进行立体后交，得到双目立体相机的位置和姿态，及与双目立体相机的位置和姿态相对应的精度。
所述动态环境下轨道检测平台的三维定位定姿方法，其中，所述步骤D具体包括：
D1、通过卡尔曼松组合滤波，将双目立体相机的位置和姿态作为带权观测值输入INS/OD导航***，得到INS/OD导航***的位置和姿态；
D2、对INS/OD导航***的位置和姿态进行反向平滑处理及内插，得到轨道检测平台的位置和姿态。
一种动态环境下轨道检测平台的三维定位定姿***，其中，包括：
相机标定模块，用于对双目立体相机的左右相机的相对空间位置姿态进行标定；
视准角标定模块，用于对双目立体相机与激光惯导之间的相对位置姿态参数进行标定；
双目视觉定位定姿模块，用于根据双目立体相机对CPIII控制点进行拍照获取多张控制点图片，并根据立体后交得到双目立体相机的位置和姿态；
双目视觉辅助INS/OD定位定姿模块，用于将双目立体相机的位置和姿态作为带权观测值输入INS/OD导航***，并进行滤波、平滑及内插处理，得到轨道检测平台的位置和姿态；其中，所述INS/OD导航***为惯导/里程计导航***。
所述动态环境下轨道检测平台的三维定位定姿***，其中，所述相机标定模块具体包括：
立体像对获取单元，用于双目立体相机对已建立的三维相机标定场进行拍照，获取多对观测位置各不相同的立体像对；
双目立体相机标定单元，用于获取每一立体像对的像点坐标，根据立体像对的像点坐标及与像点坐标相对应控制点的三维坐标进行标定，并根据光束法平差算法获取双目立体相机中每一相机内参数、畸变系数及左右相机的相对位置姿态参数。
所述动态环境下轨道检测平台的三维定位定姿***，其中，所述视准角标定模块中通过同一时刻双目立体相机的位置和姿态与GNSS/INS导航***得到的位置和姿态进行比对，标定双目立体相机坐标系到惯导载体坐标系转换关系；其中GNSS/INS导航***为全球卫星导航***/惯导组合导航***。
所述动态环境下轨道检测平台的三维定位定姿***，其中，所述双目视觉定位定姿模块具体包括：
控制点获取单元，用于通过双目立体相机获取轨道上预先设置的多个控制点的CPIII坐标；
像点坐标获取单元，用于获取每一控制点上标靶的像点坐标；
定位定姿单元，用于将标靶的像点坐标与对应的控制点的CPIII坐标进行立体后交，得到双目立体相机的位置和姿态，及与双目立体相机的位置和姿态相对应的精度。
所述动态环境下轨道检测平台的三维定位定姿***，其中，所述双目视觉辅助INS/OD定位定姿模块具体包括：
滤波单元，用于通过卡尔曼松组合滤波，将双目立体相机的位置和姿态作为带权观测值输入INS/OD导航***，得到INS/OD导航***的位置和姿态；
平滑单元，用于对INS/OD导航***的位置和姿态进行反向平滑处理及内插，得到轨道检测平台的位置和姿态。
本发明所述的动态环境下轨道检测平台的三维定位定姿方法及***，方法包括：对双目立体相机的左右相机的相对空间位置姿态进行标定；对双目立体相机与激光惯导之间的相对位置姿态参数进行标定；根据双目立体相机对CPIII控制点进行拍照获取多张控制点图片，并根据立体后交得到双目立体相机的位置和姿态；将双目立体相机的位置和姿态作为带权观测值输入INS/OD导航***，并进行滤波、平滑及内插处理，得到轨道检测平台的位置和姿态。本发明通过视觉的方法将轨道线路高精度控制网数据与惯导/里程计（INS/OD）数据与融合，采用联合解算方法，实现动态轨道检测平台的连续的、高精度的定位定姿。可广泛用于高铁、地铁的轨道检测、移动道路测量等应用。
附图说明
图1为本发明所述动态环境下轨道检测平台的三维定位定姿方法较佳实施例的流程图。
图2为本发明所述动态环境下轨道检测平台的三维定位定姿***较佳实施例的结构框图。
具体实施方式
本发明提供一种动态环境下轨道检测平台的三维定位定姿方法及***。为使本发明的目的、技术方案及效果更加清楚、明确，以下参照附图并举实施例对本发明进一步详细说明。应当理解，此处所描述的具体实施例仅用以解释本发明，并不用于限定本发明。
请参考图1，其为本发明所述动态环境下轨道检测平台的三维定位定姿方法较佳实施例的流程图。如图1所示，所述动态环境下轨道检测平台的三维定位定姿方法包括如下步骤：
步骤S100、对双目立体相机的左右相机的相对空间位置姿态进行标定；
步骤S200、对双目立体相机与激光惯导之间的相对位置姿态参数进行标定；
步骤S300、根据双目立体相机对CPIII控制点进行拍照获取多张控制点图片，并根据立体后交得到双目立体相机的位置和姿态；
步骤S400、将双目立体相机的位置和姿态作为带权观测值输入INS/OD导航***，并进行滤波、平滑及内插处理，得到轨道检测平台的位置和姿态；其中，所述INS/OD导航***为惯导/里程计导航***。
本发明的实施例中，包括硬件标定和定位定姿数据处理两部分。其中步骤S100和步骤S200中进行硬件标定，步骤S300和步骤S400中进行定位定姿数据处理。硬件标定指轨道检测平台上激光惯导、里程计和双目立体相机实现时间同步后，对双目立体相机中两个相机相对空间位置、立体相机和激光惯导之间的相对关系（杆臂值和安置角）进行标定。通过硬件标定，实现双目立体相机与激光惯导的空间同步。
轨道检测平台在采集数据时，在轨道沿线每隔一定距离布设CPIII控制点的标志，利用双目立体相机进行观测，并自动提取立体像对中CPIII控制点的像点坐标，利用像点坐标反算双目立体相机的位置和姿态。利用双目立体相机得到的位置、姿态辅助INS/OD进行高精度定位定姿，最后通过内插得到轨道检测平台任意时刻的位置姿态。
所述动态环境下轨道检测平台的三维定位定姿方法，其中，所述步骤S100具体包括：
步骤S101、双目立体相机对已建立的三维相机标定场进行拍照，获取多对观测位置各不相同的立体像对；
步骤S102、获取每一立体像对的像点坐标，根据立体像对的像点坐标及与像点坐标相对应控制点的三维坐标进行标定，并根据光束法平差算法获取双目立体相机中每一相机内参数、畸变系数及左右相机的相对位置姿态参数。
所述动态环境下轨道检测平台的三维定位定姿方法，其中，所述步骤S200中通过同一时刻双目立体相机的位置和姿态与GNSS/INS导航***得到的位置和姿态进行比对，标定双目立体相机坐标系到惯导载体坐标系转换关系；其中GNSS/INS导航***为全球卫星导航***/惯导组合导航***。
所述动态环境下轨道检测平台的三维定位定姿方法，其中，所述步骤S300具体包括：
步骤S301、通过双目立体相机获取轨道上预先设置的多个控制点的CPIII坐标；
步骤S302、获取每一控制点上标靶的像点坐标；
步骤S303、将标靶的像点坐标与对应的控制点的CPIII坐标进行立体后交，得到双目立体相机的位置和姿态，及与双目立体相机的位置和姿态相对应的精度。
在步骤S301中，利用双目立体相机将控制点的CPIII坐标传递到轨道检测平台上，是为了在保证可靠性的情况下，尽量减少控制点的数量，最少要求2个控制点。但是当控制点数目足够多时，即大于3个时，也可以利用单目相机将控制点传递到检测平台上，但是可靠性和精度不如双目立体相机。
所述动态环境下轨道检测平台的三维定位定姿方法，其中，所述步骤S400具体包括：
步骤S401、通过卡尔曼松组合滤波，将双目立体相机的位置和姿态作为带权观测值输入INS/OD导航***，得到INS/OD导航***的位置和姿态；
步骤S402、对INS/OD导航***的位置和姿态进行反向平滑处理及内插，得到轨道检测平台的位置和姿态。
在步骤S401中，通过闭环反馈，不断修正到INS/OD导航***的误差。且在步骤S402中，利用RTS反向平滑算法（即RauchTung-Striebel反向平滑算法）对INS/OD导航***的位置和姿态的滤波结果进行平滑处理，得到最优导航结果。
本发明中通过双目立体相机对铁路隧道沿线布置的已知的CPIII控制点进行摄影的方式，经过摄影测量后方交汇计算，得到轨道检测平台的绝对三维位置和姿态。
再对获得的轨道检测平台的绝对三维位置和姿态作为带权观测值与检测平台搭载的INS/OD（惯性测量单元/里程计）***进行组合导航，纠正INS/OD累积误差，实现轨道检测平台的高精度定位定姿。
可见，传统的轨道检测小车通过全站仪和CPIII控制点进行定位定姿，具有高精度、操作简易、携带方便等特点，被广大高速铁路工程施工、设计监理单位使用，但轨检小车作业效率低，一个天窗时间只能检测不到5km，无法满足城市轨道长线路、快速检测的需求。本发明通过移动检测平台搭载INS、CCD相机、激光惯导、线结构光扫描仪与车轮编码器等多传感器，实现高动态、高精度测量，提高检测的效率。
而且综合检测车一般利用INS与GNSS组成的POS***进行导航，但是在城市轨道交通的隧道环境下，无法接收到GNSS信号，单独依靠INS进行定姿定位的误差会随着时间的推移而快速积累直至发散。本发明通过双目立体相机对铁路沿线CPIII控制点进行拍照，反推检测平台的绝对位置和姿态，取代传统GNSS/INS组合导航***的GNSS定位，实现隧道环境下的轨道平台的高精度定位定姿。
基于上述方法实施例，本发明还提供了一种动态环境下轨道检测平台的三维定位定姿***。如图2所示，本发明所述动态环境下轨道检测平台的三维定位定姿***，包括：
相机标定模块100，用于对双目立体相机的左右相机的相对空间位置姿态进行标定；
视准角标定模块200，用于对双目立体相机与激光惯导之间的相对位置姿态参数进行标定；
双目视觉定位定姿模块300，用于根据双目立体相机对CPIII控制点进行拍照获取多张控制点图片，并根据立体后交得到双目立体相机的位置和姿态；
双目视觉辅助INS/OD定位定姿模块400，用于将双目立体相机的位置和姿态作为带权观测值输入INS/OD导航***，并进行滤波、平滑及内插处理，得到轨道检测平台的位置和姿态；其中，所述INS/OD导航***为惯导/里程计导航***。
进一步的，在所述动态环境下轨道检测平台的三维定位定姿***中，所述相机标定模块具体包括：
立体像对获取单元，用于双目立体相机对已建立的三维相机标定场进行拍照，获取多对观测位置各不相同的立体像对；
双目立体相机标定单元，用于获取每一立体像对的像点坐标，根据立体像对的像点坐标及与像点坐标相对应控制点的三维坐标进行标定，并根据光束法平差算法获取双目立体相机中每一相机内参数、畸变系数及左右相机的相对位置姿态参数。
进一步的，在所述动态环境下轨道检测平台的三维定位定姿***中，所述视准角标定模块中通过同一时刻双目立体相机的位置和姿态与GNSS/INS导航***得到的位置和姿态进行比对，标定双目立体相机坐标系到惯导载体坐标系转换关系；其中GNSS/INS导航***为全球卫星导航***/惯导组合导航***。
进一步的，在所述动态环境下轨道检测平台的三维定位定姿***中，所述双目视觉定位定姿模块具体包括：
控制点获取单元，用于通过双目立体相机获取轨道上预先设置的多个控制点的CPIII坐标；
像点坐标获取单元，用于获取每一控制点上标靶的像点坐标；
定位定姿单元，用于将标靶的像点坐标与对应的控制点的CPIII坐标进行立体后交，得到双目立体相机的位置和姿态，及与双目立体相机的位置和姿态相对应的精度。
进一步的，在所述动态环境下轨道检测平台的三维定位定姿***中，所述双目视觉辅助INS/OD定位定姿模块具体包括：
滤波单元，用于通过卡尔曼松组合滤波，将双目立体相机的位置和姿态作为带权观测值输入INS/OD导航***，得到INS/OD导航***的位置和姿态；
平滑单元，用于对INS/OD导航***的位置和姿态进行反向平滑处理及内插，得到轨道检测平台的位置和姿态。
综上所述，本发明所述的动态环境下轨道检测平台的三维定位定姿方法及***，方法包括：对双目立体相机的左右相机的相对空间位置姿态进行标定；对双目立体相机与激光惯导之间的相对位置姿态参数进行标定；根据双目立体相机对CPIII控制点进行拍照获取多张控制点图片，并根据立体后交得到双目立体相机的位置和姿态；将双目立体相机的位置和姿态作为带权观测值输入INS/OD导航***，并进行滤波、平滑及内插处理，得到轨道检测平台的位置和姿态。本发明通过视觉的方法将轨道线路高精度控制网数据与激光惯导/里程计数据与融合，采用联合解算方法，实现动态轨道检测平台的连续的、高精度的定位定姿，可广泛用于高铁、地铁的轨道检测、移动道路测量等应用。
可以理解的是，对本领域普通技术人员来说，可以根据本发明的技术方案及本发明构思加以等同替换或改变，而所有这些改变或替换都应属于本发明所附的权利要求的保护范围。

Claims (10)

1.一种动态环境下轨道检测平台的三维定位定姿方法，其特征在于，所述方法包括以下步骤：
A、对双目立体相机的左右相机的相对空间位置姿态进行标定；
B、对双目立体相机与激光惯导之间的相对位置姿态参数进行标定；
C、根据双目立体相机对CPIII控制点进行拍照获取多张控制点图片，并根据立体后交得到双目立体相机的位置和姿态；
D、将双目立体相机的位置和姿态作为带权观测值输入INS/OD导航***，并进行滤波、平滑及内插处理，得到轨道检测平台的位置和姿态；其中，所述INS/OD导航***为惯导/里程计导航***。
2.根据权利要求1所述动态环境下轨道检测平台的三维定位定姿方法，其特征在于，所述步骤A具体包括：
A1、双目立体相机对已建立的三维相机标定场进行拍照，获取多对观测位置各不相同的立体像对；
A2、获取每一立体像对的像点坐标，根据立体像对的像点坐标及与像点坐标相对应控制点的三维坐标进行标定，并根据光束法平差算法获取双目立体相机中每一相机内参数、畸变系数及左右相机的相对位置姿态参数。
3.根据权利要求1所述动态环境下轨道检测平台的三维定位定姿方法，其特征在于，所述步骤B中通过同一时刻双目立体相机的位置和姿态与GNSS/INS导航***得到的位置和姿态进行比对，标定双目立体相机坐标系到惯导载体坐标系转换关系；其中GNSS/INS导航***为全球卫星导航***/惯导组合导航***。
4.根据权利要求1所述动态环境下轨道检测平台的三维定位定姿方法，其特征在于，所述步骤C具体包括：
C1、通过双目立体相机获取轨道上预先设置的多个控制点的CPIII坐标；
C2、获取每一控制点上标靶的像点坐标；
C3、将标靶的像点坐标与对应的控制点的CPIII坐标进行立体后交，得到双目立体相机的位置和姿态，及与双目立体相机的位置和姿态相对应的精度。
5.根据权利要求1所述动态环境下轨道检测平台的三维定位定姿方法，其特征在于，所述步骤D具体包括：
D1、通过卡尔曼松组合滤波，将双目立体相机的位置和姿态作为带权观测值输入INS/OD导航***，得到INS/OD导航***的位置和姿态；
D2、对INS/OD导航***的位置和姿态进行反向平滑处理及内插，得到轨道检测平台的位置和姿态。
6.一种动态环境下轨道检测平台的三维定位定姿***，其特征在于，包括：
相机标定模块，用于对双目立体相机的左右相机的相对空间位置姿态进行标定；
视准角标定模块，用于对双目立体相机与惯导之间的相对位置姿态参数进行标定；
双目视觉定位定姿模块，用于根据双目立体相机对CPIII控制点进行拍照获取多张控制点图片，并根据立体后交得到双目立体相机的位置和姿态；
双目视觉辅助INS/OD定位定姿模块，用于将双目立体相机的位置和姿态作为带权观测值输入INS/OD导航***进行滤波、平滑及内插处理，得到轨道检测平台的位置和姿态；其中，所述INS/OD导航***为惯导/里程计导航***。
7.根据权利要求6所述动态环境下轨道检测平台的三维定位定姿***，其特征在于，所述相机标定模块具体包括：
立体像对获取单元，用于双目立体相机对已建立的三维相机标定场进行拍照，获取多对观测位置各不相同的立体像对；
双目立体相机标定单元，用于获取每一立体像对的像点坐标，根据立体像对的像点坐标及与像点坐标相对应控制点的三维坐标进行标定，并根据光束法平差算法获取双目立体相机中每一相机内参数、畸变系数及左右相机的相对位置姿态参数。
8.根据权利要求6所述动态环境下轨道检测平台的三维定位定姿***，其特征在于，所述视准角标定模块中通过同一时刻双目立体相机的位置和姿态与GNSS/INS导航***得到的位置和姿态进行比对，标定双目立体相机坐标系到惯导载体坐标系转换关系；其中GNSS/INS导航***为全球卫星导航***/惯导组合导航***。
9.根据权利要求6所述动态环境下轨道检测平台的三维定位定姿***，其特征在于，所述双目视觉定位定姿模块具体包括：
控制点获取单元，用于通过双目立体相机获取轨道上预先设置的多个控制点的CPIII坐标；
像点坐标获取单元，用于获取每一控制点上标靶的像点坐标；
定位定姿单元，用于将标靶的像点坐标与对应的控制点的CPIII坐标进行立体后交，得到双目立体相机的位置和姿态，及与双目立体相机的位置和姿态相对应的精度。
10.根据权利要求6所述动态环境下轨道检测平台的三维定位定姿***，其特征在于，所述双目视觉辅助INS/OD定位定姿模块具体包括：
滤波单元，用于通过卡尔曼松组合滤波，将双目立体相机的位置和姿态作为带权观测值输入INS/OD导航***，得到INS/OD导航***的位置和姿态；
平滑单元，用于对INS/OD导航***的位置和姿态进行反向平滑处理及内插，得到轨道检测平台的位置和姿态。
CN201610010650.3A 2016-01-08 2016-01-08 一种动态环境下轨道检测平台的三维定位定姿方法及*** Active CN105652305B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610010650.3A CN105652305B (zh) 2016-01-08 2016-01-08 一种动态环境下轨道检测平台的三维定位定姿方法及***

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610010650.3A CN105652305B (zh) 2016-01-08 2016-01-08 一种动态环境下轨道检测平台的三维定位定姿方法及***

Publications (2)

Publication Number Publication Date
CN105652305A true CN105652305A (zh) 2016-06-08
CN105652305B CN105652305B (zh) 2018-02-06

Family

ID=56490575

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610010650.3A Active CN105652305B (zh) 2016-01-08 2016-01-08 一种动态环境下轨道检测平台的三维定位定姿方法及***

Country Status (1)

Country Link
CN (1) CN105652305B (zh)

Cited By (22)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106524924A (zh) * 2016-11-25 2017-03-22 闫东坤 一种基于光学惯性组合的轨检车位置姿态测量***及方法
CN106952306A (zh) * 2017-02-16 2017-07-14 西安交通大学 一种轨检车定位方法及装置
CN107621266A (zh) * 2017-08-14 2018-01-23 上海宇航***工程研究所 基于特征点跟踪的空间非合作目标相对导航方法
CN107728182A (zh) * 2017-09-18 2018-02-23 北京航空航天大学 基于相机辅助的柔性多基线测量方法和装置
CN107856687A (zh) * 2017-11-13 2018-03-30 中铁三局集团有限公司 一种轨道近景摄影测量装置及方法
CN108022265A (zh) * 2016-11-01 2018-05-11 狒特科技（北京）有限公司 红外相机位姿确定方法、设备及***
CN108663681A (zh) * 2018-05-16 2018-10-16 华南理工大学 基于双目摄像头与二维激光雷达的移动机器人导航方法
CN109581457A (zh) * 2018-10-26 2019-04-05 武汉长天铁路技术有限公司 一种动态环境下轨道检测平台的三维定位定姿方法
CN109631887A (zh) * 2018-12-29 2019-04-16 重庆邮电大学 基于双目、加速度与陀螺仪的惯性导航高精度定位方法
CN109797612A (zh) * 2019-03-12 2019-05-24 北京星网宇达科技股份有限公司 一种检测车的轨迹确定方法、装置、设备和介质
CN110220454A (zh) * 2019-06-03 2019-09-10 西安飞机工业（集团）有限责任公司 一种三坐标定位机构的位姿标定方法
CN110542415A (zh) * 2018-05-28 2019-12-06 北京京东尚科信息技术有限公司 用于导航***的导航方法和装置
CN110820447A (zh) * 2019-11-22 2020-02-21 武汉纵横天地空间信息技术有限公司 一种基于双目视觉的轨道几何状态测量***及其测量方法
CN111024072A (zh) * 2019-12-27 2020-04-17 浙江大学 一种基于深度学习的卫星地图辅助导航定位方法
CN111089564A (zh) * 2019-12-16 2020-05-01 上海航天控制技术研究所 一种动平台动目标双目测距***及方法
CN111398980A (zh) * 2018-12-29 2020-07-10 广东瑞图万方科技股份有限公司 一种机载LiDAR数据处理的方法及装置
CN111811467A (zh) * 2020-09-03 2020-10-23 深圳大学 高速铁路轨面长波不均匀沉降动态检测方法、装置
CN111809466A (zh) * 2020-09-14 2020-10-23 深圳大学 一种高速铁路cpiii控制网复测方法、装置
CN113011315A (zh) * 2021-03-16 2021-06-22 华南理工大学 一种基于超快速结构感知深度网络的地铁轨道识别方法
CN113724337A (zh) * 2021-08-30 2021-11-30 合肥工业大学 一种无需依赖云台角度的相机动态外参标定方法及装置
CN115790430A (zh) * 2022-11-22 2023-03-14 上海勃发空间信息技术有限公司 高速动态条件下三维变形检测方法
CN116088020A (zh) * 2022-12-23 2023-05-09 中国铁路设计集团有限公司 一种基于低成本传感器集成的融合轨道三维重建方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101408410A (zh) * 2008-10-28 2009-04-15 山东科技大学 隧道体元形变移动监测***及隧道体元形变移动监测方法
CN104132943A (zh) * 2013-05-02 2014-11-05 上海工程技术大学 一种车载高速动态轨道表面缺陷视频检测方法及装置
CN104976986A (zh) * 2015-05-04 2015-10-14 上海图甲信息科技有限公司 一种铁轨路基沉降测量方法
CN104973092A (zh) * 2015-05-04 2015-10-14 上海图甲信息科技有限公司 一种基于里程和图像测量的铁轨路基沉降测量方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101408410A (zh) * 2008-10-28 2009-04-15 山东科技大学 隧道体元形变移动监测***及隧道体元形变移动监测方法
CN104132943A (zh) * 2013-05-02 2014-11-05 上海工程技术大学 一种车载高速动态轨道表面缺陷视频检测方法及装置
CN104976986A (zh) * 2015-05-04 2015-10-14 上海图甲信息科技有限公司 一种铁轨路基沉降测量方法
CN104973092A (zh) * 2015-05-04 2015-10-14 上海图甲信息科技有限公司 一种基于里程和图像测量的铁轨路基沉降测量方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
AXEL LILJENCRANTZ ET AL.: "Implementing bridge weigh-in-motion for railway traffic", 《COMPUTERS & STRUCTURES》 *
赵景民: "基于三维精测网的轨道检测技术运用", 《煤炭技术》 *

Cited By (29)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108022265B (zh) * 2016-11-01 2023-06-13 北京墨土科技有限公司 红外相机位姿确定方法、设备及***
CN108022265A (zh) * 2016-11-01 2018-05-11 狒特科技（北京）有限公司 红外相机位姿确定方法、设备及***
CN106524924A (zh) * 2016-11-25 2017-03-22 闫东坤 一种基于光学惯性组合的轨检车位置姿态测量***及方法
CN106952306A (zh) * 2017-02-16 2017-07-14 西安交通大学 一种轨检车定位方法及装置
CN106952306B (zh) * 2017-02-16 2020-03-27 西安交通大学 一种轨检车定位方法及装置
CN107621266B (zh) * 2017-08-14 2020-12-15 上海宇航***工程研究所 基于特征点跟踪的空间非合作目标相对导航方法
CN107621266A (zh) * 2017-08-14 2018-01-23 上海宇航***工程研究所 基于特征点跟踪的空间非合作目标相对导航方法
CN107728182A (zh) * 2017-09-18 2018-02-23 北京航空航天大学 基于相机辅助的柔性多基线测量方法和装置
CN107856687A (zh) * 2017-11-13 2018-03-30 中铁三局集团有限公司 一种轨道近景摄影测量装置及方法
CN108663681B (zh) * 2018-05-16 2021-01-19 华南理工大学 基于双目摄像头与二维激光雷达的移动机器人导航方法
CN108663681A (zh) * 2018-05-16 2018-10-16 华南理工大学 基于双目摄像头与二维激光雷达的移动机器人导航方法
CN110542415A (zh) * 2018-05-28 2019-12-06 北京京东尚科信息技术有限公司 用于导航***的导航方法和装置
CN109581457A (zh) * 2018-10-26 2019-04-05 武汉长天铁路技术有限公司 一种动态环境下轨道检测平台的三维定位定姿方法
CN109631887A (zh) * 2018-12-29 2019-04-16 重庆邮电大学 基于双目、加速度与陀螺仪的惯性导航高精度定位方法
CN111398980A (zh) * 2018-12-29 2020-07-10 广东瑞图万方科技股份有限公司 一种机载LiDAR数据处理的方法及装置
CN109797612A (zh) * 2019-03-12 2019-05-24 北京星网宇达科技股份有限公司 一种检测车的轨迹确定方法、装置、设备和介质
CN110220454A (zh) * 2019-06-03 2019-09-10 西安飞机工业（集团）有限责任公司 一种三坐标定位机构的位姿标定方法
CN110820447A (zh) * 2019-11-22 2020-02-21 武汉纵横天地空间信息技术有限公司 一种基于双目视觉的轨道几何状态测量***及其测量方法
CN111089564A (zh) * 2019-12-16 2020-05-01 上海航天控制技术研究所 一种动平台动目标双目测距***及方法
CN111089564B (zh) * 2019-12-16 2021-12-07 上海航天控制技术研究所 一种动平台动目标双目测距***及方法
CN111024072A (zh) * 2019-12-27 2020-04-17 浙江大学 一种基于深度学习的卫星地图辅助导航定位方法
CN111811467A (zh) * 2020-09-03 2020-10-23 深圳大学 高速铁路轨面长波不均匀沉降动态检测方法、装置
CN111809466A (zh) * 2020-09-14 2020-10-23 深圳大学 一种高速铁路cpiii控制网复测方法、装置
CN113011315A (zh) * 2021-03-16 2021-06-22 华南理工大学 一种基于超快速结构感知深度网络的地铁轨道识别方法
CN113011315B (zh) * 2021-03-16 2022-12-16 华南理工大学 一种基于超快速结构感知深度网络的地铁轨道识别方法
CN113724337A (zh) * 2021-08-30 2021-11-30 合肥工业大学 一种无需依赖云台角度的相机动态外参标定方法及装置
CN113724337B (zh) * 2021-08-30 2024-02-23 合肥工业大学 一种无需依赖云台角度的相机动态外参标定方法及装置
CN115790430A (zh) * 2022-11-22 2023-03-14 上海勃发空间信息技术有限公司 高速动态条件下三维变形检测方法
CN116088020A (zh) * 2022-12-23 2023-05-09 中国铁路设计集团有限公司 一种基于低成本传感器集成的融合轨道三维重建方法

Also Published As

Publication number Publication date
CN105652305B (zh) 2018-02-06

Similar Documents

Publication Publication Date Title
CN105652305A (zh) 一种动态环境下轨道检测平台的三维定位定姿方法及***
CN106092056B (zh) 一种高速铁路桥梁基础沉降变形的车载动态监测方法
WO2022141913A1 (zh) 一种基于车载定位装置的路侧毫米波雷达校准方法
CN103419812B (zh) 一种基于摄像及卫星及惯性测量组合的铁轨路基沉降测量的方法
CN109946730A (zh) 一种车路协同下基于超宽带的车辆高可靠融合定位方法
CN104428686B (zh) 用于获得车辆位置的方法和车辆
CN103162689B (zh) 辅助车载定位***及车辆的辅助定位方法
CN108801142A (zh) 一种特大尺寸工件双移动测量机器人***及方法
CN101334288A (zh) 基于标准线路匹配的公交准确定位方法
CN104973092A (zh) 一种基于里程和图像测量的铁轨路基沉降测量方法
CN104280036A (zh) 一种交通信息的检测与定位方法、装置及电子设备
CN106052705A (zh) 一种车载综合导航方法及装置
US20220282967A1 (en) Method and mobile detection unit for detecting elements of infrastructure of an underground line network
KR20160121452A (ko) 철도 시설물 정보 생성 시스템 및 방법
CN109444916A (zh) 一种无人驾驶可行驶区域确定装置及方法
KR102255978B1 (ko) 3d 센서를 활용한 객체 인식 기반 고해상도 철도 터널 내부 정밀 지도 생성 장치 및 방법
CN115503694B (zh) 基于自主学习的记忆泊车路径生成方法、装置及电子设备
CN106524924A (zh) 一种基于光学惯性组合的轨检车位置姿态测量***及方法
CN114859374A (zh) 基于无人机激光点云和影像融合的新建铁路交叉测量方法
CN116358515A (zh) 一种低速无人驾驶***的建图定位方法与装置
CN111811467B (zh) 高速铁路轨面长波不均匀沉降动态检测方法、装置
KR20160121453A (ko) 철도 시설물 공간 정보 구축 시스템 및 방법
CN206192281U (zh) 一种基于光学惯性组合的轨检车位置姿态测量***
JP2017032356A (ja) ステレオ画像処理装置
CN109581457A (zh) 一种动态环境下轨道检测平台的三维定位定姿方法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant