CN112484722A - 结合惯性导航系统的视觉传感器全局定位方法 - Google Patents
结合惯性导航系统的视觉传感器全局定位方法 Download PDFInfo
- Publication number
- CN112484722A CN112484722A CN202011305036.2A CN202011305036A CN112484722A CN 112484722 A CN112484722 A CN 112484722A CN 202011305036 A CN202011305036 A CN 202011305036A CN 112484722 A CN112484722 A CN 112484722A
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- inertial navigation
- global positioning
- global
- measurement position
- 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
- 230000000007 visual effect Effects 0.000 title claims abstract description 80
- 238000000034 method Methods 0.000 title claims abstract description 37
- 238000005259 measurement Methods 0.000 claims abstract description 128
- 238000001514 detection method Methods 0.000 claims description 30
- 238000006243 chemical reaction Methods 0.000 claims description 11
- 230000001133 acceleration Effects 0.000 claims description 5
- 230000009466 transformation Effects 0.000 claims description 4
- 238000005299 abrasion Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000011179 visual inspection Methods 0.000 description 1
- 230000003313 weakening effect Effects 0.000 description 1
Classifications
-
- 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
- G01B11/002—Measuring arrangements characterised by the use of optical techniques for measuring two or more coordinates
-
- 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/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Length Measuring Devices By Optical Means (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
Abstract
本发明公开了一种结合惯性导航系统的视觉传感器全局定位方法,在任一测量位置处,判断:全局定位装置能否进行全局定位;若是,利用全局定位装置获取:视觉传感器坐标系与全局坐标系之间的关系以及惯性导航系统坐标系与全局坐标系之间的关系;若否,利用惯性导航系统实时获取从上一正常测量位置移动到当前测量位置的惯性导航数据,再利用所述惯性导航数据解算视觉传感器坐标系与全局坐标系之间的关系;对每个测量位置处的视觉传感器进行全局定位,完成对待测工件所有测点的三维测量;本方法能够在被遮挡的位置进行全局定位,具有便捷、高效的特点。
Description
技术领域
本发明涉及视觉测量领域,具体涉及一种结合惯性导航系统的视觉传感器全局定位方法。
背景技术
目前视觉测量已经被广泛应用于工业制造领域;对于大型尺寸的工件检测,需要设置多个测量位置,并对每个位置进行全局定位,将各个视觉传感器采集的测点信息汇总到全局坐标系中,实现对大型工件的整体测量,现有的全局定位方法为通过摄影测量系统或激光跟踪仪等全局定位装置,获取视觉传感器上的标志点,对各个视觉传感器进行全局定位;公开文件CN102607457中还公开了一种基于惯性导航技术的大尺寸三维形貌测量装置,其通过激光跟踪仪和惯性导航单元联合求解光刀坐标系到世界坐标系的转换关系,其中激光跟踪仪靶球用于获取平移关系T=(x,y,z)T;惯性导航单元用于获取旋转关系R,二者相互配合,实现转换关系的快速获取;该技术方案存在两个弊端:1)当跟踪仪靶球被遮挡时,激光跟踪仪将无法解算平移关系;2)惯性导航单元容易受到积分误差的影响,在长时间工作后,其得到的惯性导航数据误差较大,造成转换关系计算不准确;实际应用过程中,测量大尺寸待测工件不可避免的存在标志点被遮挡的情形,特别是测量面型复杂的构件时,如汽车车身、高铁舱段、飞机舱段等,视觉传感器需要深入到工件内部进行部分测点的检测,此时会造成部分或全部标志点被遮挡,全局定位装置(激光跟踪仪等)无法对此时的视觉传感器定位;在这种情况下,公开文件CN102607457的技术方案无法实施,而在现有方法中,往往利用机器人的重复定位精度获取视觉传感器的位姿,但由于机器人连杆变形、齿轮磨损等原因,机器人末端的姿态会发生漂移,这需要定期修正机器人重复定位的位置,这给测量系统的维护带来了难度。
发明内容
针对上述问题,本发明提出一种结合惯性导航系统的视觉传感器全局定位方法,本方法能够解决全局定位装置在部分测量位置(标志点被遮挡)无法获得足够数量标志点的问题,在被遮挡的测量位置,仅利用惯性导航系统辅助获得被遮挡测量位置的视觉传感器在全局坐标系中的位置,适用于面型复杂的大型构件测点全局定位,具有便捷、高效的特点。
本发明技术方案如下:
一种结合惯性导航系统的视觉传感器全局定位方法,当大型待测工件落位在检测工位内,视觉传感器依据待测工件上不同测点的位置,移动到不同的测量位置;在测量位置处视觉传感器能够采集到测点的三维信息;
所述视觉传感器的外壳上固定有多个标志点,其通过机械机构连接有惯性导航系统,二者同步移动并保持相对位姿不变;标定两者之间的转换关系RT;
所述检测工位内还设置有全局定位装置,其用于采集多个标志点位置信息并计算视觉传感器坐标系与全局坐标系之间的关系;
在任一测量位置处,判断:全局定位装置是否能够对视觉传感器进行全局定位;
若是,则将当前测量位置记为正常测量位置,并利用全局定位装置获取:视觉传感器坐标系与全局坐标系之间的关系以及惯性导航系统坐标系与全局坐标系之间的关系;
若否,则将当前测量位置记为被遮挡测量位置,并利用惯性导航系统实时获取从上一正常测量位置移动到当前测量位置的惯性导航数据,再利用所述惯性导航数据解算视觉传感器坐标系与全局坐标系之间的关系;
根据以上判断,对每个测量位置处的视觉传感器进行全局定位,再将其采集的待测工件上测点的三维信息转换到全局坐标系中,完成对待测工件所有测点的三维测量。
进一步,视觉传感器和惯性导航系统通过手持方式移动到各个测量位置,或者,检测工位中设置机器人,机器人末端固定视觉传感器和惯性导航系统。
当采用机器人移动视觉传感器时,可以采用以下定位方法:
一种结合惯性导航系统的视觉传感器全局定位方法,检测工位中设置机器人,机器人末端固定视觉传感器和惯性导航系统,二者同步移动并保持相对位姿不变;所述视觉传感器的外壳上固定有多个标志点;
所述检测工位内还设置有全局定位装置,其用于采集多个标志点位置信息并计算视觉传感器坐标系与全局坐标系之间的关系;
大型待测工件落位在检测工位内,根据多个测点所在的不同位置,设有多个测量位置,在每个测量位置处,机器人停止运动、调整位姿,保障视觉传感器能够采集到测点的三维信息;
利用以下方法,为每个测量位置匹配对应的全局定位方式并设置其在机器人移动轨迹中的位置排序:
判断在当前测量位置处,全局定位装置是否能够对视觉传感器进行全局定位;
若是,则将当前测量位置记为正常测量位置,并利用全局定位装置获取:视觉传感器坐标系与全局坐标系之间的关系以及惯性导航系统坐标系与全局坐标系之间的关系;
若否,则将当前测量位置记为被遮挡测量位置,并利用惯性导航系统实时获取从上一正常测量位置移动到当前测量位置的惯性导航数据,再利用所述惯性导航数据解算视觉传感器坐标系与全局坐标系之间的关系;
将各个测量位置的全局定位方式和位置排序存储为示教信息;
实际检测时,机器人依据所述示教信息,带动视觉传感器和惯性导航系统依次运动到各个测量位置处,视觉传感器采集被测物上测点的三维信息,根据相应的全局定位方式,对不同测量位置的视觉传感器进行全局定位,再将采集到被测物上测点的三维信息转换到全局坐标系中,完成对被测物的三维测量。
进一步,所述全局定位装置包括固定在视觉检测工位上方的多个相机,所述多个相机的整体视场能够覆盖整个视觉检测工位;
所述标志点为圆形反光标记点或编码点。
或者,所述全局定位装置为一个或多个激光跟踪仪,将激光跟踪仪坐标系作为全局坐标系;
所述标志点为激光跟踪仪靶球。
进一步,判断:全局定位装置是否能够对视觉传感器进行全局定位的方式为:
全局定位装置是否能够采集到的至少三个不共线的标志点。
进一步,利用全局定位装置获取视觉传感器坐标系与全局坐标系之间的关系,具体方法为:
预先标定视觉传感器外壳上的标志点在传感器坐标系中的位置坐标;
全局定位装置采集多个标志点,计算其在全局坐标系中的坐标,利用刚体变换得到传感器坐标系与全局坐标系之间的旋转平移关系RT'。
进一步,利用所述惯性导航数据解算视觉传感器坐标系与全局坐标系之间的关系,具体方法为:
惯性导航系统通过角速度计和加速度计获得:从上一正常测量位置移动到当前测量位置,角速度和加速度的测量值,生成惯性导航数据;利用惯性导航数据得到惯性导航系统在当前测量位置相对于上一个正常测量位置的旋转平移关系H;
则计算此处视觉传感器坐标系与全局坐标系之间的关系为:RT'×H×RT;
其中,RT'表示在上一正常测量位置处,利用全局定位装置获取的视觉传感器坐标系与全局坐标系之间的旋转平移关系;RT为预先标定的视觉传感器和惯性导航系统之间的转换关系。
为了保证测量精度,视觉传感器的移动轨迹中,首个测量位置为正常测量位置;相邻两个正常测量位置之间设置被遮挡测量位置的个数小于等于3个。
本方法不仅能够解决标志点被遮挡时,全局定位的问题,还考虑到了惯性导航系统在短时间内定位精度高,长时间则会存在积分误差的问题,为了保证系统定位的精度,在设置测量位置排序时,首个测量位置为正常测量位置;相邻两个正常测量位置之间设置被遮挡测量位置的个数小于等于3个;当视觉传感器由被遮挡测量位置转换为正常测量位置后,利用全局定位装置采集标记点信息、更新惯性导航系统与全局坐标系的关系,重新定位惯性导航系统在全局坐标系中的位置,以此作为惯性导航系统新的初始位置,再进行下一次角速度和加速度的测量,即保障惯性导航系统在短时间(短距离)内定位,进而削弱了惯性导航系统的姿态积分误差对定位精度的影响。
具体实施方式
以下结合具体实施方式对本发明的技术方案进行详细描述。
实施例1
一种结合惯性导航系统的视觉传感器全局定位方法,当大型待测工件落位在检测工位内,视觉传感器依据待测工件上不同测点的位置,移动到不同的测量位置;在测量位置处视觉传感器能够采集到测点的三维信息;
其中,视觉传感器和惯性导航系统通过手持方式移动到各个测量位置,或者,检测工位中设置机器人,机器人末端固定视觉传感器和惯性导航系统;
视觉传感器的外壳上固定有多个标志点,其通过机械机构连接有惯性导航系统,二者同步移动并保持相对位姿不变;标定两者之间的转换关系RT;
检测工位内还设置有全局定位装置,其用于采集多个标志点位置信息并计算视觉传感器坐标系与全局坐标系之间的关系;
在任一测量位置处,判断:全局定位装置是否能够对视觉传感器进行全局定位(全局定位装置是否能够采集到的至少三个不共线的标志点);
若是,则将当前测量位置记为正常测量位置,并利用全局定位装置获取:视觉传感器坐标系与全局坐标系之间的关系以及惯性导航系统坐标系与全局坐标系之间的关系;
若否,则将当前测量位置记为被遮挡测量位置,并利用惯性导航系统实时获取从上一正常测量位置移动到当前测量位置的惯性导航数据,再利用惯性导航数据解算视觉传感器坐标系与全局坐标系之间的关系;
根据以上判断,对每个测量位置处的视觉传感器进行全局定位,再将其采集的待测工件上测点的三维信息转换到全局坐标系中,完成对待测工件所有测点的三维测量。
其中,全局定位装置包括固定在视觉检测工位上方的多个相机,多个相机的整体视场能够覆盖整个视觉检测工位;
具体实施时,以任一部相机的坐标系作为全局坐标系,基于摄影测量原理,多个相机分别采集标志点,利用光束平差法解算出多个标记点的位置信息;
标志点为圆形反光标记点或编码点。
或者,全局定位装置为一个或多个激光跟踪仪,将激光跟踪仪坐标系作为全局坐标系;
标志点为激光跟踪仪靶球。
本实施例中,采用固定在视觉检测工位上方的多个相机进行全局定位,判断:全局定位装置是否能够采集到的至少四个不共面的标志点;
具体的,利用全局定位装置获取视觉传感器坐标系与全局坐标系之间的关系,具体方法为:
预先标定视觉传感器外壳上的标志点在传感器坐标系中的位置坐标;
全局定位装置采集至少四个不共面的标志点,计算其在全局坐标系中的坐标,利用刚体变换得到传感器坐标系与全局坐标系之间的旋转平移关系RT'。
利用惯性导航数据解算视觉传感器坐标系与全局坐标系之间的关系,具体方法为:
惯性导航系统通过角速度计和加速度计获得:从上一正常测量位置移动到当前测量位置,角速度和加速度的测量值,生成惯性导航数据;利用惯性导航数据得到惯性导航系统在当前测量位置相对于上一个正常测量位置的旋转平移关系H;
其中ψ、γ、θ通过惯性导航系统三自由度陀螺仪的角速度计积分获得;x、y、z、通过对角速度计和加速度计积分获得;
则计算此处视觉传感器坐标系与全局坐标系之间的关系为:RT'×H×RT;
其中,RT'表示在上一正常测量位置处,利用全局定位装置获取的视觉传感器坐标系与全局坐标系之间的旋转平移关系;RT为预先标定的视觉传感器和惯性导航系统之间的转换关系。
为了保证测量精度,视觉传感器的移动轨迹中,首个测量位置为正常测量位置;相邻两个正常测量位置之间设置被遮挡测量位置的个数小于等于3个。
本实施例中,将被遮挡测量位置穿插在正常测量位置之间,即两个正常测量位置之间设置0个或1个被遮挡测量位置。
实施例2
一种结合惯性导航系统的视觉传感器全局定位方法,检测工位中设置机器人,机器人末端固定视觉传感器和惯性导航系统,二者同步移动并保持相对位姿不变;视觉传感器的外壳上固定有多个标志点;
检测工位内还设置有全局定位装置,其用于采集多个标志点位置信息并计算视觉传感器坐标系与全局坐标系之间的关系;
大型待测工件落位在检测工位内,根据多个测点所在的不同位置,设有多个测量位置,在每个测量位置处,机器人停止运动、调整位姿,保障视觉传感器能够采集到测点的三维信息;
利用以下方法,为每个测量位置匹配对应的全局定位方式并设置其在机器人移动轨迹中的位置排序:
判断在当前测量位置处,全局定位装置是否能够对视觉传感器进行全局定位(全局定位装置是否能够采集到的至少三个不共线的标志点);
若是,则将当前测量位置记为正常测量位置,并利用全局定位装置获取:视觉传感器坐标系与全局坐标系之间的关系以及惯性导航系统坐标系与全局坐标系之间的关系;
若否,则将当前测量位置记为被遮挡测量位置,并利用惯性导航系统实时获取从上一正常测量位置移动到当前测量位置的惯性导航数据,再利用惯性导航数据解算视觉传感器坐标系与全局坐标系之间的关系;
将各个测量位置的全局定位方式和位置排序存储为示教信息;
实际检测时,机器人依据示教信息,带动视觉传感器和惯性导航系统依次运动到各个测量位置处,视觉传感器采集被测物上测点的三维信息,根据相应的全局定位方式,对不同测量位置的视觉传感器进行全局定位,再将采集到被测物上测点的三维信息转换到全局坐标系中,完成对被测物的三维测量。
其中,全局定位装置包括固定在视觉检测工位上方的多个相机,多个相机的整体视场能够覆盖整个视觉检测工位,以任一部相机的坐标系作为全局坐标系,各相机与全局坐标系的转换关系已知。
标志点为圆形反光标记点或编码点。
具体而言,利用全局定位装置获取视觉传感器坐标系与全局坐标系之间的关系,具体方法为:
预先标定视觉传感器外壳上的标志点在传感器坐标系中的位置坐标;
全局定位装置采集至少三个不共线的标志点,计算其在全局坐标系中的坐标,利用刚体变换得到传感器坐标系与全局坐标系之间的旋转平移关系RT'。
此外,利用惯性导航数据解算视觉传感器坐标系与全局坐标系之间的关系,具体方法为:
惯性导航系统通过角速度计和加速度计获得:从上一正常测量位置移动到当前测量位置,角速度和加速度的测量值,生成惯性导航数据;利用惯性导航数据得到惯性导航系统在当前测量位置相对于上一个正常测量位置的旋转平移关系H;
则计算此处视觉传感器坐标系与全局坐标系之间的关系为:RT'×H×RT;
其中,RT'表示在上一正常测量位置处,利用全局定位装置获取的视觉传感器坐标系与全局坐标系之间的旋转平移关系;RT为预先标定的视觉传感器和惯性导航系统之间的转换关系。
为了保证测量精度,视觉传感器的移动轨迹中,首个测量位置为正常测量位置;相邻两个正常测量位置之间设置被遮挡测量位置的个数小于等于3个。
本实施例中,将被遮挡测量位置穿插在正常测量位置之间,即两个正常测量位置之间设置0个或1个被遮挡测量位置。
Claims (9)
1.一种结合惯性导航系统的视觉传感器全局定位方法,其特征在于,当大型待测工件落位在检测工位内,视觉传感器依据待测工件上不同测点的位置,移动到不同的测量位置;在测量位置处视觉传感器能够采集到测点的三维信息;
所述视觉传感器的外壳上固定有多个标志点,其通过机械机构连接有惯性导航系统,二者同步移动并保持相对位姿不变;标定两者之间的转换关系RT;
所述检测工位内还设置有全局定位装置,其用于采集多个标志点位置信息,并计算视觉传感器坐标系与全局坐标系之间的关系;
在任一测量位置处,判断:全局定位装置是否能够对视觉传感器进行全局定位;
若是,则将当前测量位置记为正常测量位置,并利用全局定位装置获取:视觉传感器坐标系与全局坐标系之间的关系以及惯性导航系统坐标系与全局坐标系之间的关系;
若否,则将当前测量位置记为被遮挡测量位置,并利用惯性导航系统实时获取从上一正常测量位置移动到当前测量位置的惯性导航数据,再利用所述惯性导航数据解算视觉传感器坐标系与全局坐标系之间的关系;
根据以上判断,对每个测量位置处的视觉传感器进行全局定位,再将其采集的待测工件上测点的三维信息转换到全局坐标系中,完成对待测工件所有测点的三维测量。
2.如权利要求1所述结合惯性导航系统的视觉传感器全局定位方法,其特征在于:视觉传感器和惯性导航系统通过手持方式移动到各个测量位置,或者,检测工位中设置机器人,机器人末端固定视觉传感器和惯性导航系统。
3.一种结合惯性导航系统的视觉传感器全局定位方法,其特征在于:检测工位中设置机器人,机器人末端固定视觉传感器和惯性导航系统,二者同步移动并保持相对位姿不变;所述视觉传感器的外壳上固定有多个标志点;
所述检测工位内还设置有全局定位装置,其用于采集多个标志点位置信息并计算视觉传感器坐标系与全局坐标系之间的关系;
大型待测工件落位在检测工位内,根据多个测点所在的不同位置,设有多个测量位置,在每个测量位置处,机器人停止运动、调整位姿,保障视觉传感器能够采集到测点的三维信息;
利用以下方法,为每个测量位置匹配对应的全局定位方式并设置其在机器人移动轨迹中的位置排序:
判断在当前测量位置处,全局定位装置是否能够对视觉传感器进行全局定位;
若是,则将当前测量位置记为正常测量位置,并利用全局定位装置获取:视觉传感器坐标系与全局坐标系之间的关系以及惯性导航系统坐标系与全局坐标系之间的关系;
若否,则将当前测量位置记为被遮挡测量位置,并利用惯性导航系统实时获取从上一正常测量位置移动到当前测量位置的惯性导航数据,再利用所述惯性导航数据解算视觉传感器坐标系与全局坐标系之间的关系;
将各个测量位置的全局定位方式和位置排序存储为示教信息;
实际检测时,机器人依据所述示教信息,带动视觉传感器和惯性导航系统依次运动到各个测量位置处,视觉传感器采集被测物上测点的三维信息,根据相应的全局定位方式,对不同测量位置的视觉传感器进行全局定位,再将采集到被测物上测点的三维信息转换到全局坐标系中,完成对被测物的三维测量。
4.如权利要求1~3中任一项所述结合惯性导航系统的视觉传感器全局定位方法,其特征在于:所述全局定位装置包括固定在视觉检测工位上方的多个相机,所述多个相机的整体视场能够覆盖整个视觉检测工位;
所述标志点为圆形反光标记点或编码点。
5.如权利要求1~3中任一项所述结合惯性导航系统的视觉传感器全局定位方法,其特征在于:所述全局定位装置为一个或多个激光跟踪仪,将激光跟踪仪坐标系作为全局坐标系;
所述标志点为激光跟踪仪靶球。
6.如权利要求4或5中任一项所述结合惯性导航系统的视觉传感器全局定位方法,其特征在于:判断:全局定位装置是否能够对视觉传感器进行全局定位的方式为:
全局定位装置是否能够采集到的至少三个不共线的标志点。
7.如权利要求1~3中任一项所述结合惯性导航系统的视觉传感器全局定位方法,其特征在于:利用全局定位装置获取视觉传感器坐标系与全局坐标系之间的关系,具体方法为:
预先标定视觉传感器外壳上的标志点在传感器坐标系中的位置坐标;
全局定位装置采集多个标志点,计算其在全局坐标系中的坐标,利用刚体变换得到传感器坐标系与全局坐标系之间的旋转平移关系RT'。
8.如权利要求1~3中任一项所述结合惯性导航系统的视觉传感器全局定位方法,其特征在于:利用所述惯性导航数据解算视觉传感器坐标系与全局坐标系之间的关系,具体方法为:
惯性导航系统通过角速度计和加速度计获得:从上一正常测量位置移动到当前测量位置,角速度和加速度的测量值,生成惯性导航数据;利用惯性导航数据得到惯性导航系统在当前测量位置相对于上一个正常测量位置的旋转平移关系H;
则计算此处视觉传感器坐标系与全局坐标系之间的关系为:RT'×H×RT;
其中,RT'表示在上一正常测量位置处,利用全局定位装置获取的视觉传感器坐标系与全局坐标系之间的旋转平移关系;RT为预先标定的视觉传感器和惯性导航系统之间的转换关系。
9.如权利要求1~3中任一项所述结合惯性导航系统的视觉传感器全局定位方法,其特征在于:为了保证测量精度,视觉传感器的移动轨迹中,首个测量位置为正常测量位置;相邻两个正常测量位置之间设置被遮挡测量位置的个数小于等于3个。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011305036.2A CN112484722B (zh) | 2020-11-19 | 2020-11-19 | 结合惯性导航系统的视觉传感器全局定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011305036.2A CN112484722B (zh) | 2020-11-19 | 2020-11-19 | 结合惯性导航系统的视觉传感器全局定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112484722A true CN112484722A (zh) | 2021-03-12 |
CN112484722B CN112484722B (zh) | 2023-06-06 |
Family
ID=74932206
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011305036.2A Active CN112484722B (zh) | 2020-11-19 | 2020-11-19 | 结合惯性导航系统的视觉传感器全局定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112484722B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113776523A (zh) * | 2021-08-24 | 2021-12-10 | 武汉第二船舶设计研究所 | 一种机器人低成本导航定位方法、系统及应用 |
CN114372916A (zh) * | 2021-12-31 | 2022-04-19 | 易思维(杭州)科技有限公司 | 一种自动化点云拼接方法 |
US11953609B2 (en) | 2021-09-29 | 2024-04-09 | Beijing Baidu Netcom Science Technology Co., Ltd. | Vehicle positioning method, apparatus and autonomous driving vehicle |
CN114372916B (zh) * | 2021-12-31 | 2024-05-31 | 易思维(杭州)科技股份有限公司 | 一种自动化点云拼接方法 |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102607457A (zh) * | 2012-03-05 | 2012-07-25 | 西安交通大学 | 基于惯性导航技术的大尺寸三维形貌测量装置及方法 |
CN103782132A (zh) * | 2011-09-13 | 2014-05-07 | 赫克斯冈技术中心 | 具有多目标跟踪功能的大地测绘系统和方法 |
CN104406585A (zh) * | 2014-11-19 | 2015-03-11 | 中国计量学院 | 基于惯性检测的激光跟踪仪靶球定位系统 |
CN204329975U (zh) * | 2014-11-19 | 2015-05-13 | 中国计量学院 | 一种基于惯性检测的激光跟踪仪靶球定位装置 |
CN104764452A (zh) * | 2015-04-23 | 2015-07-08 | 北京理工大学 | 一种基于惯性和光学跟踪系统的混合位姿跟踪方法 |
CN105222772A (zh) * | 2015-09-17 | 2016-01-06 | 泉州装备制造研究所 | 一种基于多源信息融合的高精度运动轨迹检测系统 |
CN106595654A (zh) * | 2016-12-13 | 2017-04-26 | 天津大学 | 一种激光跟踪测量系统连续跟踪测量方法及装置 |
CN106646507A (zh) * | 2016-12-13 | 2017-05-10 | 天津大学 | 基于惯性引导的激光跟踪测量设备多目标测量方法与装置 |
CN109945782A (zh) * | 2019-04-02 | 2019-06-28 | 易思维(杭州)科技有限公司 | 超长白车身关键位置检测方法 |
CN110116410A (zh) * | 2019-05-28 | 2019-08-13 | 中国科学院自动化研究所 | 基于视觉伺服的机械臂目标导引系统、方法 |
CN110125944A (zh) * | 2019-05-14 | 2019-08-16 | 中国地质大学(武汉) | 一种机械臂示教系统和方法 |
CN110238831A (zh) * | 2019-07-23 | 2019-09-17 | 青岛理工大学 | 基于rgb-d图像及示教器的机器人示教系统及方法 |
-
2020
- 2020-11-19 CN CN202011305036.2A patent/CN112484722B/zh active Active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103782132A (zh) * | 2011-09-13 | 2014-05-07 | 赫克斯冈技术中心 | 具有多目标跟踪功能的大地测绘系统和方法 |
CN102607457A (zh) * | 2012-03-05 | 2012-07-25 | 西安交通大学 | 基于惯性导航技术的大尺寸三维形貌测量装置及方法 |
CN104406585A (zh) * | 2014-11-19 | 2015-03-11 | 中国计量学院 | 基于惯性检测的激光跟踪仪靶球定位系统 |
CN204329975U (zh) * | 2014-11-19 | 2015-05-13 | 中国计量学院 | 一种基于惯性检测的激光跟踪仪靶球定位装置 |
CN104764452A (zh) * | 2015-04-23 | 2015-07-08 | 北京理工大学 | 一种基于惯性和光学跟踪系统的混合位姿跟踪方法 |
CN105222772A (zh) * | 2015-09-17 | 2016-01-06 | 泉州装备制造研究所 | 一种基于多源信息融合的高精度运动轨迹检测系统 |
CN106595654A (zh) * | 2016-12-13 | 2017-04-26 | 天津大学 | 一种激光跟踪测量系统连续跟踪测量方法及装置 |
CN106646507A (zh) * | 2016-12-13 | 2017-05-10 | 天津大学 | 基于惯性引导的激光跟踪测量设备多目标测量方法与装置 |
CN109945782A (zh) * | 2019-04-02 | 2019-06-28 | 易思维(杭州)科技有限公司 | 超长白车身关键位置检测方法 |
CN110125944A (zh) * | 2019-05-14 | 2019-08-16 | 中国地质大学(武汉) | 一种机械臂示教系统和方法 |
CN110116410A (zh) * | 2019-05-28 | 2019-08-13 | 中国科学院自动化研究所 | 基于视觉伺服的机械臂目标导引系统、方法 |
CN110238831A (zh) * | 2019-07-23 | 2019-09-17 | 青岛理工大学 | 基于rgb-d图像及示教器的机器人示教系统及方法 |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113776523A (zh) * | 2021-08-24 | 2021-12-10 | 武汉第二船舶设计研究所 | 一种机器人低成本导航定位方法、系统及应用 |
CN113776523B (zh) * | 2021-08-24 | 2024-03-19 | 武汉第二船舶设计研究所 | 一种机器人低成本导航定位方法、系统及应用 |
US11953609B2 (en) | 2021-09-29 | 2024-04-09 | Beijing Baidu Netcom Science Technology Co., Ltd. | Vehicle positioning method, apparatus and autonomous driving vehicle |
CN114372916A (zh) * | 2021-12-31 | 2022-04-19 | 易思维(杭州)科技有限公司 | 一种自动化点云拼接方法 |
CN114372916B (zh) * | 2021-12-31 | 2024-05-31 | 易思维(杭州)科技股份有限公司 | 一种自动化点云拼接方法 |
Also Published As
Publication number | Publication date |
---|---|
CN112484722B (zh) | 2023-06-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109029257B (zh) | 基于立体视觉和结构光视觉的大型工件位姿测量系统、方法 | |
AU664393B2 (en) | Method and system for point by point measurement of spatial coordinates | |
US6460004B2 (en) | Method and apparatus for calibrating a non-contact gauging sensor with respect to an external coordinate system | |
CN110837080B (zh) | 激光雷达移动测量系统的快速标定方法 | |
CN111060097B (zh) | 一种提高位置误差估计精度的惯性/天文组合导航方法 | |
US10495456B2 (en) | Method for calibrating a detection device, and detection device | |
EP1091186A2 (en) | Method and apparatus for calibrating a non-contact gauging sensor with respect to an external coordinate system | |
CN112484722B (zh) | 结合惯性导航系统的视觉传感器全局定位方法 | |
CN106226780A (zh) | 基于激光扫描雷达的多旋翼室内定位系统及实现方法 | |
CN111637888B (zh) | 基于惯导和激光雷达单点测距的掘进机定位方法及系统 | |
CN111947644B (zh) | 一种室外移动机器人定位方法、系统及其电子设备 | |
CN109212497A (zh) | 一种空间六自由度车载雷达天线位姿偏差测量及对接方法 | |
CN114459345B (zh) | 基于视觉空间定位的飞机机身位置姿态检测系统及方法 | |
CN106225779A (zh) | 基于三激光标记点图像的掘进机定位系统及定位方法 | |
CN114964227A (zh) | 基于深度相机定位修正的采煤机组合导航定位系统及方法 | |
CN109470274B (zh) | 一种车载光电经纬仪载车平台变形测量系统及方法 | |
CN111486867A (zh) | 一种视觉和惯性混合跟踪组件安装参数的标定装置及方法 | |
CN112985420B (zh) | 小天体附着光学导航特征递推优选方法 | |
CN113781558A (zh) | 一种姿态与位置解耦的机器人视觉寻位方法 | |
CN116753953A (zh) | 一种基于视觉的无人机组合导航方法 | |
CN114199239B (zh) | 结合北斗导航的双视觉辅助惯性差分座舱内头部测姿系统 | |
CN216116064U (zh) | 掘进机的位姿标定系统 | |
CN212300369U (zh) | 高速轨道检测系统 | |
CN114562994A (zh) | 移动机器人处于动态环境中的定位方法 | |
CN113324538A (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 | ||
CP01 | Change in the name or title of a patent holder | ||
CP01 | Change in the name or title of a patent holder |
Address after: Room 495, building 3, 1197 Bin'an Road, Binjiang District, Hangzhou City, Zhejiang Province 310051 Patentee after: Yi Si Si (Hangzhou) Technology Co.,Ltd. Address before: Room 495, building 3, 1197 Bin'an Road, Binjiang District, Hangzhou City, Zhejiang Province 310051 Patentee before: ISVISION (HANGZHOU) TECHNOLOGY Co.,Ltd. |