CN101865656A - 一种使用少数共面点精确定位多摄像头系统位姿的方法 - Google Patents
一种使用少数共面点精确定位多摄像头系统位姿的方法 Download PDFInfo
- Publication number
- CN101865656A CN101865656A CN201010203869A CN201010203869A CN101865656A CN 101865656 A CN101865656 A CN 101865656A CN 201010203869 A CN201010203869 A CN 201010203869A CN 201010203869 A CN201010203869 A CN 201010203869A CN 101865656 A CN101865656 A CN 101865656A
- Authority
- CN
- China
- Prior art keywords
- camera
- matrix
- homography matrix
- point
- homography
- 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
Landscapes
- Studio Devices (AREA)
Abstract
本发明提供一种使用少数共面点精确定位多摄像头系统位姿的方法,它可描述为以下技术方案:多摄像头系统由N个相对位姿关系固定的摄像头组成,N为2或大于2的自然数,其中每一个摄像头具有唯一的编号;在多摄像头系统中定义第j个摄像头的内参矩阵为Kj。特殊的3D点在第j个摄像头上的图像记为mj=[uj vj]T。可以由已知的摄像头间的刚性转换定位每个摄像头的Rj,tj。本发明提出了一种利用单应性的方法提出了一种新的多摄像头定位方法,能够使用3D共面参考点映射图像点精确定位摄像头的位置。相对于原有方法,本发明提出的方法更加精确,更具鲁棒性,可用于对视角有要求、共面点很少的情况。
Description
技术领域
本发明涉及多摄像头系统中定位所有摄像头位姿的方法,尤其是涉及一种利用单应性使用少数共面点的精确定位方法。
背景技术
当前通用的位姿定位理论和方法:
1、高斯牛顿(Gauss-Newton)方法:
Gauss-Newton方法是用来解决最小二乘问题的经典解法。它通过在当前估计值用一节泰勒级数迭代线性化共线性方程来实现。如果初始估计值比较好,那么很快就可以收敛得到精确解。然而当当前解与实际的精确值差距较大,那么这种方法收敛较慢并很有可能不收敛。
2、Levenberg-Marquardt方法:
Levenberg-Marquardt方法则可以被看做是最速下降法和Gauss-Newton方法的叠加。当当前的解和精确解差距较大时候,这个方法比较慢,但是保证收敛,表现为最速下降法;当当前解接近于真实解时候,它表现为Gauss-Newton方法。Levenberg-Marquardt方法已经成为了非线性最小二乘问题的一种标准解法,在计算机视觉和计算机图形学的领域内被广泛使用。
3、正交迭代(Orthogonal Iteration)算法:
正交迭代算法采用迭代求解方法,具有迭代次数少,计算精度高,计算速度快且全局收敛的特点,可用于实时位姿估计。算法达到了与Levenberg-Marquardt方法相当的精度,并提高了计算效率,受初始影响较小,对错误数据的鲁棒性更高。Chien-Ping Lu,Gregory D.Hager,Eric Mjolsness.Fast and Globally Convergent Pose Estimation from Video Images.IEEETransactions on Pattern Analysis and Machine Intelligence,2000,22(6):610~622
大多数存在的方法试图通过最优化或者迭代来直接解出方向和平移。
发明内容
本发明所要解决的技术问题是提供一种使用少数共面点精确定位多摄像头系统位姿的方法,能够对于多摄像系统内的摄像头的定位更加精确,更具鲁棒性。
为此本发明采用以下技术方案:
所述多摄像头系统由N个相对位姿关系固定的摄像头组成,N为2或大于2的自然数,其中每一个摄像头具有唯一的编号;其特征在于包括以下步骤:
1)、在多摄像头系统中的N个摄像头中选择一个摄像头作为参照,该摄像头的编号为i,使用张正友标定方法测量多摄像头系统内其它摄像头相对摄像头i的位姿关系,所述位姿关系包括:
a)、平移向量t=[X,Y,Z],X、Y、Z分别表示X轴,Y轴和Z轴的偏移量,b)、旋转矩阵R,R为3×3矩阵,表示两个摄像头之间的旋转关系;
2)、在参考平面上放置n个标记点,n为2或大于2的自然数,并测量标记点之间的二维坐标值,以垂直参考平面的方向为Z轴,且该参考平面为Z=1建立坐标系,指定其中一个标记点为参考原点,得到标记点的坐标M%=[X,Y,1]T;
3)、用图像分割方法识别出步骤2)中所放置的标记点在每一个摄像头中成像的图像坐标值,并对每一个摄像头建立得到步骤2)中所放置的标记点的坐标值与其在摄像头上的成像点坐标值之间的一一对应关系;
4)、通过标记点坐标M%=[X,Y,1]T和其在摄像头i上的成像点m%=[u,v,1]T,计算摄像头i的单应矩阵H,H为3×3矩阵,sm%=HM%,m%表示点M%在摄像头i上的成像点坐标值,s为一实常数,表示比例因子;通过多个成像点联立方程组解得s和H;
5)、建立摄像头i的单应矩阵与多摄像头系统中其它摄像头的单应矩阵之间的一对一对应关系,它包括:
测量所述被选择的摄像头i的单应矩阵H和其它摄像头相对于摄像头i的平移向量t和旋转矩阵R,
根据所述摄像头i的单应矩阵H和其它摄像头相对于摄像头i的平移向量t和旋转矩阵R,将其它摄像头的单应矩阵表示为与所述被选择的摄像头i的单应矩阵H和t,R相关的等式;
6)、采用非线性优化方法优化摄像头i的单应矩阵H,使得所有摄像头实际获得的成像点坐标值和通过优化后的单应矩阵H’计算出来的像点坐标值的欧氏距离误差最小;
7)、通过优化后的各摄像头的单应矩阵,计算每一个摄像头的位姿参数,所述位姿关系参数包括:旋转矩阵R、平移向量t。
本发明所解决问题的数学化描述为:
在多摄像头系统中定义第j个摄像头的内参矩阵为Kj。特殊的3D点P=[X,Y,Z]T在第j个摄像头上的图像记为mj=[uj vj]T。摄像头的绝对6DOF(自由度,三个旋转自由度和三个平移自由度)记为[Rj tj]3×4,由于多摄像头系统是刚性的所以这些可以预先精确的定标。摄像头i和j之间的转换可以计算如下:
任务是来测量多摄像头系统的绝对位姿,可以描述如下:一组共面不共线的3D参考点坐标,Pi,i=1,…,n,n≥3,在多摄像头系统中的相关图像记为i=1,…,n,n≥3,且j=1,…,k,k≥2,为摄像头数。基于以上的相关点,可以由已知的摄像头间的刚性转换定位每个摄像头的Rj,tj,[Rij tij],i,j=1,…,k。
由于采用本发明的技术方案,与背景技术直接的解出方向和平移不同,本发明提出了一种利用单应性的方法提出了一种新的多摄像头定位方法,能够使用3D共面参考点映射图像点精确定位摄像头的位置。相对于原有方法,本发明提出的方法更加精确,更具鲁棒性,可用于对视角有要求、共面点很少的情况。
附图说明
图1是本发明方法在两个摄像头情况下的示例说明图
图2是本发明方法的步骤流程图
具体实施方式
下面结合图示附图和实例对本发明进一步说明。
本发明公开了一种多摄像头系统中定位所有摄像头位姿的新方法,其中摄像头均刚性放置,只有极少同时共面的点。在本发明中,首先建立了每个摄像头之间欧式几何的相互关系,以此建立多个摄像头的单应矩阵相对其中某一个摄像头C的单应矩阵关系,优化获得摄像头C单应矩阵,再计算其它摄像头的单应矩阵,然后从每一个摄像头对应的单应矩阵中解出对应摄像头的方向旋转矩阵R和平移向量T。
首先介绍下单应矩阵:
参考点的齐次坐标和摄像头j的相关图像点的齐次坐标为有一个射影相关,且这里3D相关点是共面的,所以可以假设Z=0,这样有:
H是一个3×3矩阵,同样定义了一个尺度因子sj。为了计算的方便,这里由H(3,3)=1定义尺度因子。Hj=[h1j h2j h3j],然后从方程(2),可以计算旋转和平移如下:
r1j=λjKj -1h1j
r2j=λjKj -1h2j
(3)
r3j=r1j×r2j
tj=λjKj -1h3j
且λj=1/‖Kj -1h1j‖=1/‖Kj -1h2j‖,这样待测量摄像头6DOF的目标可以转换为测量相关摄像头的单应性。
以两个摄像头为例,示意图如图1所示,多个摄像头的方法以此类推。
在两摄像头系统中定义第i个摄像头的内参矩阵为Kj。特殊的3D点M=[X Y Z]T,第i个点记为Mi,位置如101所示,在第j个摄像头上的图像记为mj=[uj vj]T,如102和103所示,两个摄像头的图像平面104和105分别有自己的坐标系106和107。摄像头的绝对6DOF(自由度,三个旋转自由度和三个平移自由度)记为[Rj tj]3×4,由于多摄像头系统是刚性的所以这些可以预先精确的定标。摄像头i和j之间的转换可以计算如下:
对于测量多摄像头系统的绝对位姿的任务,可以描述如下:一组共面不共线的3D参考点坐标,Mi,i=1,…,n,n≥3,在多摄像头系统中的相关图像记为i=1,…,n,n≥3,且j=1,…,k,k=2,为摄像头数。基于以上的相关点,可以由已知的摄像头间的刚性转换测量计算每个摄像头的Rj,tj,[Rij tij],i,j=1,…,2。
具体流程图如图2所示,这里具体介绍每一步的实现细节:
1.步骤201,使用张正友标定方法标定测量多摄像头系统内摄像头的相对某一选定摄像头之间的相对位姿关系:包括旋转矩阵和平移向量[Rij tij],i,j=1,…,N。
2.步骤202,参考平面上放置若干个标记点,并测量标记点之间的二维坐标值(以其中某一个点为原点),这样得到一组共面不共线的3D参考点坐标Mi=[Xi,Yi,1],i=1,…,n,n≥3。
3.步骤203,使用图像分割方法识别出放置的标记点,并对每一个摄像头的二维图像坐标与平面放置的参考点建立一一对应的关系。
因为x定义为一个尺度因子,上式的解可以通过奇异矩阵分解得到,可以重写(4)式为Ax=0(这里A是一个2n×9的矩阵,n是参考点的数目),通过奇异矩阵分解方法获得A右面奇异向量及最小的奇异值。
5.步骤205,由摄像头之间的刚性关系得出j摄像头的H2矩阵。
H2~H′2=K2[λ2R21K1 -1h11 λ1R21K1 -1h21 λ1R21K1 -1h31+t21]
6.步骤206,最小化所有摄像头关于共面点的图像距离。一共n个参考共面点和k个摄像头,通过最小化下面的函数计算每个摄像头的单应性(Hj,j=1,…,K):
上面最优化方程式基于假设每个摄像头的图像点是被高斯噪声扰动的,这是在很多图像噪声消除工作和视觉实验中十分通常的。由于摄像头之间是刚性的组合,每个摄像头的单应性存在固有的限制关系,这将使得只有少数点就得到多摄像头系统的全局优化。
采用一个已知单应性以及刚性旋转和平移计算摄像头单应性的一种计算方法。假设有两个摄像头i和j,以及刚性的旋转矩阵Rij和平移向量tij。基于方程(1)和(3),在摄像头之间的平移和旋转是:
ti=Rij*tj+tij=λjRijKj -1h3j+tij
Ri=Rij*[λjKj -1h2j λjKj -1h2j λjKj -1h1j×λjKj -1h2j]
这样摄像头i的单应性基于单应性在方程(2)的定义有了下面的关系:
Hi~H′i=Ki[λjRijKj -1h2j λjRijKj -1h2j λjRijKj -1h3j+tij]
在本发明方法中,单应性定义为尺度H(3,3)=1,所以Hi的单应性可以计算如下:
有了单应性Hi,摄像头i的旋转矩阵和平移向量可以由(3)容易的计算出来。
然后最优化函数(5)可以重写为:
其中尺度因子sj可以计算如下:
本实例中使用Levenberg-Marquardt方法来解这个非线性最优化问题,分别得到两摄像头的H矩阵。当解最优化方程(6)时,需要一个初始的猜想Hq。
因为x定义为一个尺度因子,上式的解可以通过奇异矩阵分解得到,可以重写(7)式为Ax=0(这里A是一个2n×9的矩阵,n是参考点的数目),获得A右面奇异向量及最小的奇异值。
在以上方法计算初始猜想单应性之前,应该首先进行数据标准化来获得更加稳定和精确的结果。
此外,如果需要一个更加精确的初始单应性猜想,H的最大可能性估计也可以使用下面方程:
7.步骤207,由H(3,3)=1定义了尺度因子,故:
H1=[h11 h21 h31],然后从方程(2),可以计算摄像头1的旋转和平移如下:
r11=λ1K1 -1h11
r21=λ1K1 -1h21
r31=r11×r21
t1=λ1K1 -1h31
这里λ1=1/‖K1 -1h11‖=1/‖K1 -1h21‖。
由解出摄像头的旋转矩阵和平移向量,以及摄像头之间的刚性关系,可以解出另外一摄像头的旋转矩阵和平移向量:
Claims (2)
1.一种使用少数共面点定位多摄像头系统位姿的方法,所述多摄像头系统由N个相对位姿关系固定的摄像头组成,N为2或大于2的自然数,其中每一个摄像头具有唯一的编号;其特征在于包括以下步骤:
1)、在多摄像头系统中的N个摄像头中选择一个摄像头作为参照,该摄像头的编号为i,使用张正友标定方法测量多摄像头系统内其它摄像头相对摄像头i的位姿关系,所述位姿关系包括:
a)、平移向量t=[X,Y,Z],X、Y、Z分别表示X轴,Y轴和Z轴的偏移量,b)、旋转矩阵R,R为3×3矩阵,表示两个摄像头之间的旋转关系;
2)、在参考平面上放置n个标记点,n为2或大于2的自然数,并测量标记点之间的二维坐标值,以垂直参考平面的方向为Z轴,且该参考平面为Z=1建立坐标系,指定其中一个标记点为参考原点,得到标记点的坐标M%=[X,Y,1]T;
3)、用图像分割方法识别出步骤2)中所放置的标记点在每一个摄像头中成像的图像坐标值,并对每一个摄像头建立得到步骤2)中所放置的标记点的坐标值与其在摄像头上的成像点坐标值之间的一一对应关系;
4)、通过标记点坐标M%=[X,Y,1]T和其在摄像头i上的成像点m%=[u,v,1]T,计算摄像头i的单应矩阵H,H为3×3矩阵,sm%=HM%,m%表示点M%在摄像头i上的成像点坐标值,s为一实常数,表示比例因子;通过多个成像点联立方程组解得s和H;
5)、建立摄像头i的单应矩阵与多摄像头系统中其它摄像头的单应矩阵之间的一对一对应关系,它包括:
测量所述被选择的摄像头i的单应矩阵H和其它摄像头相对于摄像头i的平移向量t和旋转矩阵R,
根据所述摄像头i的单应矩阵H和其它摄像头相对于摄像头i的平移向量t和旋转矩阵R,将其它摄像头的单应矩阵表示为与所述被选择的摄像头i的单应矩阵H和t,R相关的等式;
6)、采用非线性优化方法优化摄像头i的单应矩阵H,使得所有摄像头实际获得的成像点坐标值和通过优化后的单应矩阵H’计算出来的像点坐标值的欧氏距离误差最小;
7)、通过优化后的各摄像头的单应矩阵,计算每一个摄像头的位姿参数,所述位姿关系参数包括:旋转矩阵R、平移向量t。
2.根据权利要求1所述的一种使用少数共面点定位多摄像头系统位姿的方法,其特征在于所述步骤5)建立摄像头i的单应矩阵与多摄像头系统中其它摄像头的单应矩阵之间的一对一对应关系采用以下等式:
ti=Rij*tj+tij=λjRijKj-1h3j+tij
Ri=Rij*[λjKj-1h1j λjKj -1h2j λjKj -1h1j×λjKj -1h2j]
Hi~H′i=Ki[λjRijKj -1h1j λjRijKj -1h2j λjRijKj -1h3j+tij]
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010102038698A CN101865656B (zh) | 2010-06-18 | 2010-06-18 | 一种使用少数共面点精确定位多摄像头系统位姿的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010102038698A CN101865656B (zh) | 2010-06-18 | 2010-06-18 | 一种使用少数共面点精确定位多摄像头系统位姿的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101865656A true CN101865656A (zh) | 2010-10-20 |
CN101865656B CN101865656B (zh) | 2011-12-14 |
Family
ID=42957474
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2010102038698A Active CN101865656B (zh) | 2010-06-18 | 2010-06-18 | 一种使用少数共面点精确定位多摄像头系统位姿的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101865656B (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102128617A (zh) * | 2010-12-08 | 2011-07-20 | 中国科学院自动化研究所 | 基于色标块的视觉实时测量方法 |
CN102523385A (zh) * | 2011-12-30 | 2012-06-27 | 洛阳圣瑞机电技术有限公司 | 双线阵ccd相机共面共线拍摄调整装置 |
CN102682448A (zh) * | 2012-03-14 | 2012-09-19 | 浙江大学 | 一种基于双三视张量的立体视觉快速导航定位方法 |
CN103363902A (zh) * | 2013-07-16 | 2013-10-23 | 清华大学 | 基于红外激光的粉尘环境中运动目标位姿检测装置及方法 |
CN107067436A (zh) * | 2015-11-17 | 2017-08-18 | 株式会社东芝 | 位姿估计装置及真空清洁器系统 |
CN109741403A (zh) * | 2018-12-29 | 2019-05-10 | 重庆邮电大学 | 一种基于全局线性的相机平移标定方法 |
CN111033567A (zh) * | 2017-06-16 | 2020-04-17 | 惠普发展公司,有限责任合伙企业 | 使用四边形对象的梯形校正 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101697233A (zh) * | 2009-10-16 | 2010-04-21 | 长春理工大学 | 一种基于结构光的三维物体表面重建方法 |
-
2010
- 2010-06-18 CN CN2010102038698A patent/CN101865656B/zh active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101697233A (zh) * | 2009-10-16 | 2010-04-21 | 长春理工大学 | 一种基于结构光的三维物体表面重建方法 |
Non-Patent Citations (1)
Title |
---|
《中国优秀硕士学位论文全文数据库》 20061231 姜勇 摄像机标定算法库的设计与实验验证 19-23 1 , 第9期 2 * |
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102128617B (zh) * | 2010-12-08 | 2012-10-03 | 中国科学院自动化研究所 | 基于色标块的视觉实时测量方法 |
CN102128617A (zh) * | 2010-12-08 | 2011-07-20 | 中国科学院自动化研究所 | 基于色标块的视觉实时测量方法 |
CN102523385B (zh) * | 2011-12-30 | 2016-01-20 | 洛阳圣瑞机电技术有限公司 | 双线阵ccd相机共面共线拍摄调整装置 |
CN102523385A (zh) * | 2011-12-30 | 2012-06-27 | 洛阳圣瑞机电技术有限公司 | 双线阵ccd相机共面共线拍摄调整装置 |
CN102682448A (zh) * | 2012-03-14 | 2012-09-19 | 浙江大学 | 一种基于双三视张量的立体视觉快速导航定位方法 |
CN102682448B (zh) * | 2012-03-14 | 2015-03-04 | 浙江大学 | 一种基于双三视张量的立体视觉快速导航定位方法 |
CN103363902A (zh) * | 2013-07-16 | 2013-10-23 | 清华大学 | 基于红外激光的粉尘环境中运动目标位姿检测装置及方法 |
CN103363902B (zh) * | 2013-07-16 | 2016-03-30 | 清华大学 | 基于红外激光的粉尘环境中运动目标位姿检测装置及方法 |
CN107067436A (zh) * | 2015-11-17 | 2017-08-18 | 株式会社东芝 | 位姿估计装置及真空清洁器系统 |
CN107067436B (zh) * | 2015-11-17 | 2021-01-05 | 株式会社东芝 | 位姿估计装置及真空清洁器系统 |
CN111033567A (zh) * | 2017-06-16 | 2020-04-17 | 惠普发展公司,有限责任合伙企业 | 使用四边形对象的梯形校正 |
CN109741403A (zh) * | 2018-12-29 | 2019-05-10 | 重庆邮电大学 | 一种基于全局线性的相机平移标定方法 |
CN109741403B (zh) * | 2018-12-29 | 2023-04-07 | 重庆邮电大学 | 一种基于全局线性的相机平移标定方法 |
Also Published As
Publication number | Publication date |
---|---|
CN101865656B (zh) | 2011-12-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101865656B (zh) | 一种使用少数共面点精确定位多摄像头系统位姿的方法 | |
US11988781B2 (en) | Extrinsic calibration method of multiple 3D LiDAR sensors for autonomous navigation system | |
JP5393318B2 (ja) | 位置姿勢計測方法及び装置 | |
CN108510551B (zh) | 一种远距离大视场条件下相机参数的标定方法及系统 | |
CN110570449B (zh) | 一种基于毫米波雷达与视觉slam的定位与建图方法 | |
CN111735439B (zh) | 地图构建方法、装置和计算机可读存储介质 | |
CN107886547B (zh) | 一种鱼眼相机标定方法及系统 | |
CN104268935A (zh) | 一种基于特征的机载激光点云与影像数据融合系统及方法 | |
CN102589530A (zh) | 基于二维相机和三维相机融合的非合作目标位姿测量方法 | |
CN105678757A (zh) | 一种物体位移测量方法 | |
KR100951309B1 (ko) | 광학식 모션 캡처 장비를 위한 다중 카메라 보정 방법 | |
CN111210478A (zh) | 一种无共同视野多相机系统外参标定方法、介质及系统 | |
Gong et al. | Extrinsic calibration of a 3D LIDAR and a camera using a trihedron | |
CN109544642B (zh) | 一种基于n型靶标的tdi-ccd相机参数标定方法 | |
CN102999895B (zh) | 利用两个同心圆线性求解摄像机内参数 | |
CN102789644B (zh) | 一种基于两条相交直线的相机标定方法 | |
CN107504959B (zh) | 利用倾斜航空影像测量房屋墙基轮廓的方法 | |
Muffert et al. | The estimation of spatial positions by using an omnidirectional camera system | |
Guan et al. | An accurate calibration method for non-overlapping cameras with double-sided telecentric lenses | |
CN102609949A (zh) | 一种基于三焦点张量像素点转移的目标定位方法 | |
CN111145267B (zh) | 基于imu辅助的360度全景视图多相机标定方法 | |
Chen et al. | Low cost and efficient 3D indoor mapping using multiple consumer RGB-D cameras | |
CN101718548A (zh) | 基于平面标志物的位姿处理方法 | |
CN110044379B (zh) | 一种移动测量系统标定方法 | |
CN114004949A (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 | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
EE01 | Entry into force of recordation of patent licensing contract |
Application publication date: 20101020 Assignee: Zhejiang Guozi Robot Technology Co., Ltd. Assignor: Zhejiang University Contract record no.: 2013330000081 Denomination of invention: Method for accurately positioning position of multi-camera system by using small number of coplanar points Granted publication date: 20111214 License type: Exclusive License Record date: 20130422 |
|
LICC | Enforcement, change and cancellation of record of contracts on the licence for exploitation of a patent or utility model |