CN104517291A - 基于目标同轴圆特征的位姿测量方法 - Google Patents
基于目标同轴圆特征的位姿测量方法 Download PDFInfo
- Publication number
- CN104517291A CN104517291A CN201410786893.7A CN201410786893A CN104517291A CN 104517291 A CN104517291 A CN 104517291A CN 201410786893 A CN201410786893 A CN 201410786893A CN 104517291 A CN104517291 A CN 104517291A
- Authority
- CN
- China
- Prior art keywords
- projection
- target
- plane
- equation
- line
- 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
- G01C11/00—Photogrammetry or videogrammetry, e.g. stereogrammetry; Photographic surveying
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C11/00—Photogrammetry or videogrammetry, e.g. stereogrammetry; Photographic surveying
- G01C11/04—Interpretation of pictures
Landscapes
- Engineering & Computer Science (AREA)
- Multimedia (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Image Analysis (AREA)
Abstract
基于目标同轴圆特征的位姿测量方法,属于计算机视觉测量技术领域。其特征是:目标具有同轴的圆形特征,结合曲线提取和椭圆拟合技术得到图片中两个同轴圆投影方程,利用圆形特征的投影几何中绝对二次曲线、消失线、圆环点等概念的联系,获得目标平面的圆环点投影坐标以及消失线方程,利用极线-极点定理,通过平面的消失线方程获得两个同轴圆的圆心投影坐标,最后以同轴圆的实际距离为先验条件并结合圆环点投影以及圆心投影坐标,求解出目标的姿态和位置信息。本发明的效果和益处是,利用单幅具有同轴圆特征的目标图片完成目标位姿的测量,操作简单并适用于实时测量。同时,不需要人工干预,实现较高精度的测量。
Description
技术领域
本发明属于计算机视觉测量技术领域,是一种适用于具有同轴圆特征的目标空间姿态和位置的测量方法。
背景技术
视觉测量是一门以图像处理为基础,综合运用电子学、光电探测、图像处理和计算机视觉等技术实现对目标的尺寸或位姿进行非接触测量的新兴测量技术。在视觉测量技术中,采用相机采集测量目标的图像,通过图像处理系统对采集的图像进行分析处理,并利用目标的已知特征或先验条件来完成对目标的几何尺寸或者目标的位置、姿态等信息的测量。
根据采用的摄像机数量将视觉测量系统分为单目、双目和多目视觉测量系统。其中,单目视觉测量具有结构简单、标定步骤少、成本低等优点,同时还避免了双目或多目视觉测量中的视场小和匹配难等问题,所以近年来这方面的研究比较活跃。单个摄像机无法直接测出目标的深度信息,因此单目视觉测量需要预先获取目标的部分特征信息。传统单目视觉测量方法多数需要人工添加特定的测量模板,利用模板上的几何特征或先验条件建立单幅或多幅图像中相同特征的对应关系,求解目标的位姿信息。传统方法主要集中在平面目标的位姿测量,在实际目标中很难找到需要的几何特征,而且多数测量方法需要目标不同视角的图片来完成测量。同时,传统的单一平面的几何特征能够提供的目标位姿信息较少,因此利用目标的三维几何特征或利用多帧图像叠加处理已经成为趋势。最后,目标的圆形特征相对于其他特征具有更多的投影几何性质,能够提供目标更多的位姿信息,因此被广泛应用。
发明内容
本发明提供了一种基于同轴圆形特征的目标位姿测量方法,解决了传统的单目视觉测量方法需要人工设计模板辅助测量以及模板上特征多为单一平面的几何特征的不足。
本发明的技术方案是:
对于存在同轴圆特征的较大口径物体,例如,圆柱体、舱体、隧道等,在其轴向方位拍摄一幅图像来实现对该目标的位姿测量。位姿参数包括θx,θy,tx,ty,tz。本发明以两个同轴圆的实际距离作为先验条件,并预先对相机进行标定。本发明结合多种圆形特征的投影几何概念,例如无穷远量、消失线、绝对二次曲线、圆环点等,实现最终的求解过程。
本发明的技术方案分为如下五个步骤。步骤(1)介绍本发明的投影几何模型。步骤(2)介绍无穷远量以及消失点、线的概念。步骤(3)介绍极线-极点定理以及如何利用消失线求解圆心投影坐标。步骤(4)介绍绝对二次曲线、圆环点的概念以及如何利用圆环点求解目标平面的消失线方程。步骤(5)介绍如何利用已知的同轴圆距离并结合同轴圆的圆心投影和圆环点投影坐标,求解目标的姿态和位置信息。
(1)本发明的投影几何模型
本发明的目标是一个空间圆柱体,其投影几何模型如图1所示。
图1中,Ow-Xw-Yw-Zw表示世界坐标系,用于描述现实世界中点的位置,且本发明假设目标平面为Zw=0平面,Oc-Xc-Yc-Zc表示摄像机坐标系,用于描述相机所在的方位,R,t表示两个坐标系之间的投影变换关系,R为3*3的旋转矩阵,t为3*1的位移向量。
在投影几何中,两个同轴圆在图像平面的投影为两个椭圆,且两个椭圆的位置关系与R,t有关。三维场景中一点M在世界坐标系下的齐次坐标为M=[xw,yw,zw,1]T,其投影在图像平面下的齐次坐标为m=[u v 1]T。在针孔模型下,空间点M与图像平面上对应点m的投影关系描述为:
sm=K[R,t]M (1)
其中,s为非零尺度因子,R,t是3*4的相机外参数矩阵。其中,R是一个3×3的旋转矩阵,由3个Euler角来描述,t为3*1的位移向量,K为相机内参数矩阵,表示为:
其中,f为摄像机的焦距;dx,dy分别表示图像水平、垂直方向相邻像素之间的距离,即像元尺寸。本发明采用相机的像素是正方形,因此有:dx=dy,f/dx=f/dy。记:f/dx=f/dy=fd,(u0,v0)表示主点。
本发明通过单幅目标图像完成目标的位姿测量,在图像中,利用曲线提取与椭圆拟合相结合的技术获得两个同轴圆的投影方程。假设两个空间同轴圆分别为Q1,Q2,两个投影椭圆分别为E1,E2。空间圆投影表示为椭圆的二次曲线方程:
au2+buv+cv2+du+ev+g=0 (2)
将其整理成矩阵形式如下:
mTEm=0 (3)
其中,E为椭圆方程(2)的3*3矩阵表示形式,其方程如下:
m为空间圆上点的投影,且m=[u v 1]T。通过公式(2)(3)得到两个椭圆的二次曲线方程及其矩阵表示形式E1,E2。然后,利用圆形的投影几何性质求解目标的位姿信息。然而,圆心投影是求解目标位姿信息的关键,步骤(2)首先给出圆心投影的求解方法以及相应的投影几何概念。
(2)投影几何中无穷远量及消失点、线的概念
求解目标位姿信息的关键步骤在于两个同轴圆的圆心投影的求解过程,在求解圆心投影的过程中应用投影几何中无穷远量以及消失点、线等概念。上述概念的定义及其数学表示形式如下。
无穷远量分成无穷远平面、直线、点。无穷远平面是投影几何为齐次坐标表示的完备性而定义的。在三维投影几何中,三维点的齐次坐标为4*1向量。如图1所示模型,在世界坐标系下一个点M的坐标的表示形式为:
M=[xw,yw,zw,t]T (4)
特别地,当t=0时,M=[xw,yw,zw,0]T,其中xw,yw,zw不全为0,称该点为无穷远点,所有无穷远点构成的集合为:
π∞={P=[xw,yw,zw,0]|Txw≠0∪yw≠0∪zw≠0} (5)
该集合构成无穷远平面。无穷远平面上任意一点坐标对应空间一条直线的方向。
无穷远点定义为空间中任意两条平行直线在无穷远平面的交点,用于描述平行直线的方向。无穷远直线定义为空间中任意两个平行平面在无穷远平面上的交线,用于描述该平行平面的方向。
综上,在无穷远量概念的基础上引出消失点、线的概念。消失点定义为一个无穷远点在图像平面上的投影,其投影几何关系如图2所示。图2描述两个平行直线交点在图像平面上的投影,该投影为该平行直线的消失点。消失线定义为一个无穷远直线在图像平面上的投影,其投影几何关系如图3所示。图3描述两个平行平面交线在图像平面上的投影,该交线的投影为该平行平面的消失线。每个平面都唯一确定一条消失线,且对于平行平面而言共享同一条消失线。
消失线是求解圆心投影的关键,为通过消失线求得两个同轴圆的圆心投影坐标,步骤(3)给出极线-极点定理并证明消失线与圆心投影满足极线-极点关系。
(3)极线-极点定理及如何利用消失线求解圆心投影
在投影几何中,极线-极点定理描述相同平面中的点与线在某种映射关系下的一一对应关系。这种映射关系的数学表达形式为平面二次曲线的3*3矩阵,
假设,m=[xw,yw,1]T为目标平面(zw=0)中任意一点,
(xw-x0)2+(yw-y0)2=r2为目标平面上任意一个圆方程,并整理成3*3矩阵方程形式Q,
l=[A B D]T描述目标平面中一条直线Axw+Byw+D=0,当点m与直线l满足如下公式:
sl=Qm (6)
称点m与直线l在Q的约束下满足极线-极点关系,直线l称作点m的极线,点m称作直线l的极点。公式(6)中Q为目标平面特定圆方程的3*3矩阵表示形式,s为非零尺度因子。特别地,当点m为该圆圆心时,通过公式(6)求得的直线l为该目标平面的无穷远直线。证明如下,设目标平面无穷远直线方程为Axw=Byw+D*0=0,且表示为l∞=[A B D]T。因为,无穷远直线上点坐标xw或yw无穷大,所以为满足该直线方程,A=0,B=0,且D归一化为1,则l∞=[0 0 1]T。相反地,m0=[x0 y0 1]T为圆Q的圆心坐标,利用公式(6)解得l=[0 0 1]T=l∞,证毕。
极线-极点定理满足投影不变性,在图像平面中,一个圆的圆心投影与目标平面的消失线,在圆的投影方程约束下满足极线-极点关系。在已知目标平面的消失线方程lv以及两个同轴圆的投影E1,E2时,通过公式(6)求得两个同轴圆的圆心投影坐lv标,这里分别假设为mc1,mc2。步骤(4)详解目标平面消失线的求解过程并介绍相关的投影几何概念。
(4)绝对二次曲线、圆环点的概念及消失线的求解
绝对二次曲线具有投影不变性,定义在无穷远平面上,且其在图像平面的投影方程与相机和目标之间的位姿信息无关,其空间模型如图4所示。
图4中,Π∞表示无穷远平面,Ω表示绝对二次曲线,ω表示绝对二次曲线在图像平面上的投影(IAC)。
绝对二次曲线的数学表达式为无穷远平面上满足如下公式的点集:
在本发明的模型中,假设同轴圆目标的前端所在平面为zw=0平面,其中M=[xw yw zw 0]T,令并将公式(7)整理成矩阵形式:
其中,Ω是绝对二次曲线方程的3*3矩阵表示形式。
设绝对二次曲线Ω在图像平面的投影为ω,由公式(2)得到ω满足方程mTωm=0,其中m=[u v 1]T为ω上的点坐标T。对针孔成像模型作如下变形:
其中,r1,r2,r3为旋转矩阵R的三个列向量。令公式(9)中的KR=H,并结合公式(8)与公式(9)得到如下推导:
mTH-TH-1m=mTK-Tm=mTωm=0 (10)
根据公式(10)推导出ω=K-TK-1,且ω只与相机的内参数有关。相机内参数作为一个已知量,通过预先标定相机获得。
绝对二次曲线及其投影的概念与圆环点的概念紧密联系。在投影几何中,圆环点定义为目标平面的无穷远直线l∞与绝对二次曲线Ω的交点,一般为复数表示形式,且已证明目标平面上任意圆与绝对二次曲线相交于两个共轭圆环点。圆环点的几何模型如图5所示。
图5中,Πw表示目标平面,Π∞表示无穷远平面,Ω表示绝对二次曲线,Q表示目标平面上任意圆,l∞表示目标平面的无穷远直线,I,J表示目标平面的圆环点,彼此共轭。
已知目标平面为zw=0平面,且步骤(3)中已经证明目标平面的无穷远
直线方程l∞=[0 0 1]T,联立Ω与l∞的方程得到圆环点I,J的表达式如下:
I=[1 i 0]T,[1-i 0]T (11)
根据圆环点的投影不变性,设其在图像平面上的投影分别为Im,Jm,且lv为目标平面的消失线方程。因为圆环点投影经过目标平面的消失线,即Im,Jm在lv上,所以通过Im,Jm获得lv的方程。
已证,在投影几何中,目标平面上任意圆Q与绝对二次曲线Ω相交于圆环点I,J。根据该性质的投影不变性,在图像平面中,利用绝对二次曲线投影ω的方程与两个同轴圆的投影方程E1,E2联立,求得公共解Im,Jm,且两者互相共轭。通过Im,Jm获得消失线lv的方程,并利用消失线lv与两个同轴圆圆心投影
mc1,mc2之间的极线-极点关系求解mc1,mc2:
其中,s1,s2为非零尺度因子。综上,利用绝对二次曲线及圆环点的性质求解出目标平面的消失线方程lv,从而利用lv和极线-极点定理获得两个同轴圆圆心投影坐标mc1,mc2。步骤(5)以两个同轴圆的实际距离为先验条件,利用两个同轴圆圆心的投影mc1,mc2和圆环点投影Im,Jm解出目标的位姿信息。
(5)目标的位姿信息的求解过程
利用上述四个步骤分别获得两个同轴圆的投影坐标mc1,mc2及目标平面的圆环点投影坐标Im,Jm。根据2针孔模型,圆环点的投影公式如下:
λIm=PI=K[r1 r2 r3 t][1 i 0 0]T=K[r1 r2 r3][1 i 0]T=KRI (14)
其中,λ为非零尺度因子,r1,r2,r3为3*3的旋转矩阵R的三个列向量。根据公式(14)推导如下:
r1=s1K-1Re{Im} (15)
r2=s2K-1Im{Im} (16)
其中,s1,s2为非零尺度因子,且R矩阵为单位正交阵,则通过公式(15)(16)得到r3的表达式如下:
r3=λ[K-1Re{Im}]×[K-1Im{Im}] (17)
r3表示旋转矩阵R的第三列,λ为非零尺度因子,通过|r3|=1获得λ,从而解得r3。根据投影几何中Euler角的定义,r3的表达式如下:
r3=|-sinθy,sinθxcosθy,cosθxcosθy]T (18)
其中,θx和θy分别表示为图1中世界坐标系Xw和Yw轴相对于摄像机坐标系Xc和Yc轴的夹角。通过公式(17)(18)解得θx,θy,且本发明采用同轴圆模型,目标的轴向与Zw轴重合,所以目标沿Zw轴具有旋转不变性。因此,本发明假定θz=0符合实际要求。
在解出θx,θy后,根据两个同轴圆的圆心投影mc1,mc2的成像模型推导如下:
s1mc1=[r1,r2,r3,t]Mc1=K[r1,r2,r3,t][0,0,0,1]T=Kt=K[tx,ty,tz]T (19)
其中,s1,s2为非零尺度因子,d为目标上两个同轴圆的实际距离,
Mc1=[0,0,0,1]T,Mc2=[0,0,d,1]T,r31,r32,r33为r3的三个分量。通过公式(19)(20)解出目标的位置信息t=[tx,ty,tz]T。
综上,结合多种同轴圆的投影几何性质,实现了包括θx,θy,tx,ty,tz的五个自由度的目标位姿测量。
本发明的效果和益处是,不需要人工设计测量模板,不局限于目标的尺寸,且结合曲线提取和椭圆拟合技术提高了椭圆拟合精度。同时,本发明测量步骤简单,利用单幅目标图像即可获取目标的位姿信息,适用于实时测量的场景。
附图说明
图1是本发明的空间模型图。1摄像机坐标系,2世界坐标系。图中Oc-Xc-Yc-Zc表示摄像机坐标系。Ow-Xw-Yw-Zw表示世界坐标系。
图2是消失点的投影关系图。3摄像机光心,4图像平面。图中l1,l2表示空间中两个平行直线。lm1,lm2表示l1,l2在图像平面的投影。v表示消失点。
图3是消失线的投影关系图。5摄像机光心,6图像平面。图中P1,P2表示空间中两个平行平面。Vc1,Vc2表示该平行平面的两个消失点。lv表示目标平面的消失线。
图4是绝对二次曲线及其投影的空间模型图。7摄像机光心,8图像平面,9无穷远平面。图中Π∞为无穷远平面,Ω表示绝对二次曲线,ω表示绝对二次曲线在图像平面上的投影。Oc表示摄像机坐标系原点。
图5是圆环点、绝对二次曲线以及目标平面圆的几何关系模型图。10目标平面,11无穷远平面,12目标平面任意圆,13目标平面的无穷远直线,14绝对二次曲线。图中Πw表示目标平面,Π∞表示无穷远平面,Ω表示绝对二次曲线,Q表示目标平面上任意圆。l∞表示目标平面的无穷远直线,I,J表示目标平面的圆环点。
图6是实施例的模型示意图。15摄像机坐标系,16图像平面,17同轴圆目标前端平面。图中两个圆形表示同轴圆目标。d为同轴圆目标的实际距离。
Oc-Xc-Yc-Zc表示摄像机坐标系。Mc1,Mc2表示两个同轴圆的圆心空间位置。O表示图像的主点位置。R,T描述目标与相机坐标系之间的位姿信息。
具体实施方式
以下结合技术方案和附图详细叙述本发明的具体实施方式。
S1.利用相机标定技术,获得相机的3*3内参数矩阵K,利用绝对二次曲线的投影ω=K-TK-1,求得ω的3*3矩阵表示形式及其二次曲线方程。
S2.获取单幅同轴圆目标的图片,结合曲线提取和椭圆拟合技术,获得两个同轴圆投影的3*3矩阵方程E1,E2及其二次曲线方程。
S3.分别联立ω的二次曲线方程与两个投影椭圆E1,E2的二次曲线方程,对两个联立方程的一对近似解取均值,得到两个共轭圆环点的投影坐标Im,Jm
S4.利用目标平面的圆环点投影Im,Jm经过目标平面的消失线lv的性质,获得目标平面的消失线方程lv。
S5.利用两个目标平面的同轴圆圆心投影mc1,mc2与目标平面消失线lv方程分别在投影椭圆E1,E2的约束下满足极线-极点关系,即 求得两个圆心投影mc1,mc2。
S6.利用已知的圆心投影mc1,mc2以及两个圆环点投影Im,Jm,解出目标的角度信息θx,θy和位置信息tx,ty,tz。
实施例:
实验使用Basler pilot的高速面阵摄像机采集图像,相机型号为piA1600-35gc,CCD点阵数目为1606×1206,像元尺寸为7.4×7.4μm2,与PC接口为千兆网口。
实验采用相机镜头的标准焦距是25mm,因此fd=25/0.0074=3378.38。实验使用Bevel Box测角仪来测量角度并作为参照标准,其分辨率为0.1°。实验以圆柱型桶为目标,桶顶部中空,底部密封,半径为285mm,高度为870mm。桶前端到相机的距离在3.0m到3.5m之间。
对相机采用张正友棋盘格标定法进行标定,标定后相机的焦距f=25.311mm,主点为(752.45521,559.10071)(像素),并对图片进行径向畸变校正。
在测量前,将桶平放并固定在实验台上,将相机固定在云台上,该云台有四个方向的自由度,包括水平位移x,垂直位移y,沿水平轴旋转θx,沿垂直轴旋转θy。在实验过程中,首先测试本发明角度的测量精度,具体方法为,使桶前端沿着水平轴向上旋转,共旋转5次,间隔为1°,每次旋转后用测角仪记录桶底部平面的水平轴倾角,即桶平面相对于相机CCD平面的俯仰角G(θx),然后将本发明的计算结果θx与测角仪的测量结果进行比较,测量结果如表1所示。
表1 角度测量结果
G(θx)/度 | -0.7 | 0.3 | 1.3 | 2.3 | 3.3 |
θx/度 | -0.9011 | 0.1045 | 0.9736 | 2.4692 | 3.0157 |
然后测量位移的精度,首先使用本发明测量目标角度方法将桶两端平面与相机CCD平面的垂直轴倾角θy调至0,然后使云台沿着水平轴平移8次,间隔为10mm,最后将本发明提出算法的计算结果tx与云台平移的真实结果G(tx)进行比较。测量结果如表2所示。
表2 位移测量结果
G(tx)/mm | 0 | 10 | 20 | 30 | 40 | 50 | 60 | 70 | 80 |
tx/mm | 0 | 10.20 | 19.77 | 30.01 | 40.15 | 50.20 | 59.83 | 69.71 | 79.79 |
表1,表2的实验结果显示,本发明的角度测量误差在0.3°以内,位移的测量误差在0.3mm以内。
Claims (1)
1.基于目标同轴圆特征的位姿测量方法,其特征在于,步骤如下:
S1.通过相机标定技术,获得相机的3*3内参数矩阵K,其中,
S2.选择一幅同轴圆目标的图片,利用曲线提取技术获得两个同轴圆投影的边缘点,并利用椭圆拟合技术获得两个同轴圆投影的二次曲线方程及其3*3的矩阵方程E1,E2;
S3.根据圆形特征的投影几何性质中,目标平面中任意圆Q与绝对二次曲线Ω相交于目标平面的两个共轭圆环点I,J及其投影不变特性,在图像平面中,绝对二次曲线投影ω与两个投影椭圆E1,E2相交于圆环点I,J的投影Im,Jm,联立ω的二次曲线方程与两个投影椭圆E1,E2的二次曲线方程,求得两个共轭圆环点投影的3*1齐次坐标Im,Jm;
S4.在投影几何概念中,目标平面∏w与无穷远平面∏∞相交于目标平面的无穷远直线l∞,且平行平面拥有相同的无穷远直线;假设m∞=[x∞ y∞ 1]T为目标平面无穷远直线l∞上任意点,且无穷远直线方程为Ax∞+By∞+D*0=0,因为x∞或y∞无穷大,则A=0,B=0才能满足该直线方程且将D归一化为1,则l∞=[0 0 1]T;利用投影几何性质中,目标平面的无穷远直线l∞经过目标平面的两个共轭圆环点I,J且该性质投影不变,在图像平面中,无穷远直线l∞投影成为目标平面的消失线lv,且目标平面的圆环点投影Im,Jm经过两个同轴圆目标平面的消失线lv,通过Im,Jm求得消失线方程lv;
S5.利用投影几何中的极线-极点定理,并根据两个同轴圆目标的圆心Mc1,Mc2与目标平面的无穷远直线l∞在两个同轴圆方程Q1,Q2的约束下,满足极线-极点定理且该性质投影不变,以两个投影椭圆E1,E2的3*3矩阵形式作为映射矩阵,通过目标平面的消失线方程lv,利用如下公式,
求得两个同轴圆圆心投影坐标mc1,mc2,s1,s2为非零尺度因子;
S6.联立目标平面的无穷远直线方程l∞与绝对二次曲线Ω的方程,求得目标平面的圆环点坐标为I=[1 i 0]T,J=[1 -i 0]T,并利用两个共轭圆环点的投影坐标Im,Jm,根据针孔成像模型得到如下公式,
λIm=PI=K[r1 r2 r3 t][1 i 0 0]T=K[r1 r2 r3][1 i 0]T=KRI
λ为非零尺度因子,I为目标平面的圆环点坐标,Im为I的投影坐标,P=[R t]为3*4投影矩阵,K为相机3*3内参数矩阵,R=[r1,r2,r3]为3*3旋转矩阵,r1,r2,r3为R中三个列向量,利用上述公式推导如下,
r1=s1K-1Re{Im}
r2=s2K-1Im{Im}
其中,s1,s2为非零尺度因子;利用R矩阵为单位正交阵,得到
r3=λ[K-1Re(Im)]×[K-1Im(Im)]
其中,λ为非零尺度因子,利用|r3|=1求解λ,求解r3;根据Euler角公式,
r3=[-sinθy,sinθxcosθy,cosθxcosθy]T
其中,θx,θy表示世界坐标系X,Y轴与摄像机坐标系X,Y轴间的夹角,利用r3求解出目标的角度信息θx,θy;本发明是同轴圆模型,其轴向与世界坐标系Z轴重合,目标沿世界坐标系Z轴具有旋转不变性,所以设定θz=0;已求解的圆心投影mc1,mc2的针孔成像公式如下,
s1mc1=K[r1,r2,r2,t]Mc1=K[r1,r2,r3,t][0,0,0,1]T=Kt=K[tx,ty,tz]T
s2mc2=K[r1,r2,r3,t]Mc2=K[r1,r2,r3,t][0,0,d,1]T
=K[tx+r31d,ty+r32d,tz+r33d]
其中,s1,s2为非零尺度因子,K为相机内参数矩阵,r1,r2,r3为旋转矩阵R中三个列向量,t=[tx,ty,tz]T,d为已知的同轴圆目标的距离,r31,r32,r33为r3的三个分量,利用上述公式获得目标的位置信息tx,ty,tz;综上,利用一幅具有同轴圆特征的目标图像,完成5个自由度θx,θy,tx,ty,tz的目标的位姿测量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410786893.7A CN104517291B (zh) | 2014-12-15 | 2014-12-15 | 基于目标同轴圆特征的位姿测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410786893.7A CN104517291B (zh) | 2014-12-15 | 2014-12-15 | 基于目标同轴圆特征的位姿测量方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104517291A true CN104517291A (zh) | 2015-04-15 |
CN104517291B CN104517291B (zh) | 2017-08-01 |
Family
ID=52792537
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410786893.7A Active CN104517291B (zh) | 2014-12-15 | 2014-12-15 | 基于目标同轴圆特征的位姿测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104517291B (zh) |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107218930A (zh) * | 2017-05-05 | 2017-09-29 | 山东大学 | 基于单目手眼系统的空间圆六维位置‑姿态主动式测量方法 |
CN108447092A (zh) * | 2018-02-06 | 2018-08-24 | 中国科学院自动化研究所 | 视觉定位标识物的方法及装置 |
CN108537849A (zh) * | 2018-04-20 | 2018-09-14 | 东北大学 | 基于同心圆环的三维直角靶标的线阵相机的标定方法 |
CN109102567A (zh) * | 2018-10-11 | 2018-12-28 | 北京理工大学 | 一种基于重建误差最小化的位姿参数高精度求解方法 |
CN109405835A (zh) * | 2017-08-31 | 2019-03-01 | 北京航空航天大学 | 基于非合作目标直线与圆单目图像的相对位姿测量方法 |
CN109754430A (zh) * | 2018-12-20 | 2019-05-14 | 西北工业大学 | 基于自配极三角形的相机参数标定方法 |
CN109949367A (zh) * | 2019-03-11 | 2019-06-28 | 中山大学 | 一种基于圆形投影的可见光成像定位方法 |
CN110415292A (zh) * | 2019-09-02 | 2019-11-05 | 安徽建筑大学 | 一种圆环标识的运动姿态视觉测量方法及其应用 |
CN111104890A (zh) * | 2019-12-13 | 2020-05-05 | 上海宇航系统工程研究所 | 一种空间飞行器广义模型的识别和重构方法及装置 |
CN112381884A (zh) * | 2020-11-12 | 2021-02-19 | 北京航空航天大学 | 基于rgbd相机的空间圆目标位姿测量方法 |
CN113012226A (zh) * | 2021-03-22 | 2021-06-22 | 浙江商汤科技开发有限公司 | 相机位姿的估计方法、装置、电子设备及计算机存储介质 |
CN113790719A (zh) * | 2021-08-13 | 2021-12-14 | 北京自动化控制设备研究所 | 一种基于线特征的无人机惯性/视觉着陆导航方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2012150150A1 (de) * | 2011-05-05 | 2012-11-08 | Siemens Aktiengesellschaft | Verfahren zur rechnergestützten lageschätzung eines objekts |
CN103512559A (zh) * | 2013-10-08 | 2014-01-15 | 北京理工大学 | 一种弹丸单目视频位姿测量方法及靶标图案 |
CN103759669A (zh) * | 2014-01-03 | 2014-04-30 | 河南科技大学 | 一种大型零件的单目视觉测量方法 |
-
2014
- 2014-12-15 CN CN201410786893.7A patent/CN104517291B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2012150150A1 (de) * | 2011-05-05 | 2012-11-08 | Siemens Aktiengesellschaft | Verfahren zur rechnergestützten lageschätzung eines objekts |
CN103512559A (zh) * | 2013-10-08 | 2014-01-15 | 北京理工大学 | 一种弹丸单目视频位姿测量方法及靶标图案 |
CN103759669A (zh) * | 2014-01-03 | 2014-04-30 | 河南科技大学 | 一种大型零件的单目视觉测量方法 |
Non-Patent Citations (1)
Title |
---|
罗磊 等: "基于虚拟连杆机构的类圆柱体目标位姿获取", 《兵工学报》 * |
Cited By (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107218930A (zh) * | 2017-05-05 | 2017-09-29 | 山东大学 | 基于单目手眼系统的空间圆六维位置‑姿态主动式测量方法 |
CN109405835A (zh) * | 2017-08-31 | 2019-03-01 | 北京航空航天大学 | 基于非合作目标直线与圆单目图像的相对位姿测量方法 |
CN109405835B (zh) * | 2017-08-31 | 2020-11-13 | 北京航空航天大学 | 基于非合作目标直线与圆单目图像的相对位姿测量方法 |
CN108447092A (zh) * | 2018-02-06 | 2018-08-24 | 中国科学院自动化研究所 | 视觉定位标识物的方法及装置 |
CN108537849A (zh) * | 2018-04-20 | 2018-09-14 | 东北大学 | 基于同心圆环的三维直角靶标的线阵相机的标定方法 |
CN109102567A (zh) * | 2018-10-11 | 2018-12-28 | 北京理工大学 | 一种基于重建误差最小化的位姿参数高精度求解方法 |
CN109102567B (zh) * | 2018-10-11 | 2023-02-24 | 北京理工大学 | 一种基于重建误差最小化的位姿参数高精度求解方法 |
CN109754430A (zh) * | 2018-12-20 | 2019-05-14 | 西北工业大学 | 基于自配极三角形的相机参数标定方法 |
CN109949367B (zh) * | 2019-03-11 | 2023-01-20 | 中山大学 | 一种基于圆形投影的可见光成像定位方法 |
CN109949367A (zh) * | 2019-03-11 | 2019-06-28 | 中山大学 | 一种基于圆形投影的可见光成像定位方法 |
CN110415292A (zh) * | 2019-09-02 | 2019-11-05 | 安徽建筑大学 | 一种圆环标识的运动姿态视觉测量方法及其应用 |
CN111104890A (zh) * | 2019-12-13 | 2020-05-05 | 上海宇航系统工程研究所 | 一种空间飞行器广义模型的识别和重构方法及装置 |
CN111104890B (zh) * | 2019-12-13 | 2023-09-29 | 上海宇航系统工程研究所 | 一种空间飞行器广义模型的识别和重构方法及装置 |
CN112381884B (zh) * | 2020-11-12 | 2022-04-19 | 北京航空航天大学 | 基于rgbd相机的空间圆目标位姿测量方法 |
CN112381884A (zh) * | 2020-11-12 | 2021-02-19 | 北京航空航天大学 | 基于rgbd相机的空间圆目标位姿测量方法 |
CN113012226A (zh) * | 2021-03-22 | 2021-06-22 | 浙江商汤科技开发有限公司 | 相机位姿的估计方法、装置、电子设备及计算机存储介质 |
CN113790719A (zh) * | 2021-08-13 | 2021-12-14 | 北京自动化控制设备研究所 | 一种基于线特征的无人机惯性/视觉着陆导航方法 |
CN113790719B (zh) * | 2021-08-13 | 2023-09-12 | 北京自动化控制设备研究所 | 一种基于线特征的无人机惯性/视觉着陆导航方法 |
Also Published As
Publication number | Publication date |
---|---|
CN104517291B (zh) | 2017-08-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104517291A (zh) | 基于目标同轴圆特征的位姿测量方法 | |
Hu et al. | Extrinsic calibration of 2-D laser rangefinder and camera from single shot based on minimal solution | |
CN107146254A (zh) | 多相机系统的相机外参数标定方法 | |
CN109242915A (zh) | 基于多面立体靶标的多相机系统标定方法 | |
CN105043250B (zh) | 一种基于至少两个公共标记点的双视角数据对齐方法 | |
CN103258329B (zh) | 一种基于圆球一维特性的摄像机标定方法 | |
CN101621711B (zh) | 采用两个相同圆进行摄像机标定的方法 | |
CN101581569A (zh) | 双目视觉传感系统结构参数的标定方法 | |
CN103106661B (zh) | 空间二条相交直线线性求解抛物折反射摄像机内参数 | |
CN109272555B (zh) | 一种rgb-d相机的外部参数获得及标定方法 | |
CN103983186A (zh) | 双目视觉系统校正方法及校正设备 | |
CN108180888A (zh) | 一种基于可转动摄像头的距离检测方法 | |
CN108036791A (zh) | 一种部件间高精度自动对接的位姿检测方法 | |
CN107560554A (zh) | 一种基于旋转透镜的三维信息视觉测量方法 | |
CN103106662A (zh) | 空间一条直线线性求解抛物折反射摄像机内参数 | |
Liu et al. | A high-accuracy pose measurement system for robotic automated assembly in large-scale space | |
CN108921904B (zh) | 利用单个球及渐近线的性质标定针孔摄像机的方法 | |
CN105187812B (zh) | 一种双目视觉立体匹配方法 | |
CN102620745A (zh) | 一种机载imu视准轴误差检校方法 | |
CN107958468B (zh) | 利用空间位置不同的三个球标定中心折反射摄像机的方法 | |
Zhang et al. | A survey of catadioptric omnidirectional camera calibration | |
CN110766752A (zh) | 一种带反光标志点的虚拟现实交互眼镜及空间定位方法 | |
CN110428472B (zh) | 工业相机标定方法 | |
CN103077518B (zh) | 基于圆环点的相机自标定方法及装置 | |
CN103810697A (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 |