发明内容
有鉴于此,本发明提供了一种MR混合摄影相机的标定方法和系统,
为了实现上述目的,本发明采用如下技术方案:
一方面,本发明公开了一种MR混合摄影相机的标定方法,其特征在于,包括:
S1、获取多对物理相机中的像素坐标及对应的虚拟相机坐标系中的坐标;
S2、根据所述多对物理相机中的像素坐标及对应的虚拟坐标系中的坐标,求解矩阵G;
S3、分解所述矩阵G,得到旋转矩阵、位移向量及内参矩阵;
S4、根据所述旋转矩阵、位移向量及内参矩阵设置虚拟相机的位姿和内参。
优选的,S1中,利用定位基站和跟踪器获取所述多对物理相机中的像素坐标及对应的虚拟相机坐标系中的坐标,所述跟踪器有两个。
优选的,所述定位基站的数量由跟踪的物理空间大小确定。
优选的,S1中,获取步骤包括:
S11、根据所述定位基站建立世界坐标系,所述跟踪器一作为三维世界中的点,所述跟踪器二作为虚拟相机,且与所述物理相机保持位置固定不变;
S12、根据所述世界坐标系,得到所述虚拟相机坐标系;
S13、将所述跟踪器一在所述世界坐标系中的坐标,转换到所述虚拟坐标系中的坐标;
S14、通过物理相机,得到所述跟踪器一的像素坐标。
S15、移动所述跟踪器一,重复步骤S11-S14,得到多对所述物理相机中的像素坐标及对应的虚拟坐标系中的坐标。
优选的,所述多对物理相机中的像素坐标及对应的虚拟相机坐标系中的坐标至少有6对。
另一方面,本发明公开了一种执行权利要求1-5任一所述的一种MR混合摄影相机的标定方法的MR混合摄影相机的标定系统,其特征在于,包括:
数据获取模块,用于获取多对物理相机中的像素坐标及对应的虚拟相机坐标系中的坐标;
数据处理模块,用于根据多对所述物理相机中的像素坐标及对应的虚拟相机坐标系中的坐标求解旋转矩阵、位移向量及内参矩阵;
虚拟相机参数更新模块,用于根据所述旋转矩阵、位移向量及内参矩阵设置虚拟相机位姿和内参。
优选的,所述数据获取模块包括定位基站和两个跟踪器,所述定位基站的数量由跟踪的物理空间大小确定。
经由上述的技术方案可知,与现有技术相比,本发明公开的标定方法和系统,能够得到物理相机的位姿和内参,并设置虚拟相机,使其具有和物理相机一致的位姿和内参,以提高虚拟相机和物理相机的校准效率及精度,从而使虚拟相机的坐标系与物理相机坐标系重合,虚拟相机中的像与在物理相机中的像重合,以达到两个相机拍摄的画面充分对齐,拍摄的像完美的嵌合在一起的效果。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明实施例公开了一种MR混合摄影相机的标定方法和系统,通过本发明公开的标定方法和系统,能够使虚拟相机的坐标系与物理相机坐标系重合,虚拟相机中的像与在物理相机中的像重合,从而使两个相机拍摄的画面充分对齐,拍摄的像完美的嵌合在一起,达到栩栩如生的效果。
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图和具体实施方式对本发明作进一步详细的说明。
一方面,本发明公开了一种MR混合摄影相机的标定方法,其特征在于,包括如下步骤:(如图1)
S1、获取多对物理相机中的像素坐标及对应的虚拟相机坐标系中的坐标;
本发明中,满足一定精度的所有的室内定位系统都可以用于坐标数据的获取,在一种实施例中,利用比较便宜常见的VR定位系统,即基于Lighthouse室内定位系统实现MR混合摄影相机的标定,
具体的,Lighthouse室内定位系统需要的设备包括:定位基站和跟踪器一和跟踪器二,本发明实施例中,使用tracker1和tracker2作为跟踪器,
其中,定位基站数量的根据需要跟踪的物理空间大小,从2个到4个不等;另外两个tracker,用于MR相机标定,具体的,将tracker1作为定位器,也可以理解为下面算法中三维世界中的点,tracker2作为虚拟相机,固定到物理相机上面,在整个标定流程中,要始终保证这两者的位置(旋转及位移)是固定不变的,如图2;
然后,利用定位基站建立世界坐标系,并根据世界坐标系,建立虚拟相机的虚拟坐标系,此时,虚拟相机实际上为HTC tracker,该系统会提供每一个连接到基站的tracker的位姿,包括世界坐标和世界旋转,
进一步,数据获取流程如图3所示,
打开HTC vive系统,获取到定位tracker1的位置坐标(这里不用管旋转,我们将其作为一个三维世界中的点来看待),即世界坐标系中的坐标,进一步,将作为定位器的tracker位置由HTC vive系统自动换算到虚拟相机坐标系下,得到该定位器在虚拟坐标系中的坐标;
同时打开物理相机,拍摄一张包括定位tracker1的物理图片,获得该物理tracker1在图片中的像素坐标,即该定位器在物理相机中的像素坐标;该像素坐标通过物理相机的二维像素坐标系获得,具体的,该坐标系以物理相机拍摄到的画面左上角为坐标原点,向右为x轴正方向,想下为y轴正方向;
通过上述步骤,便可得到一组定位tracker的虚拟三维坐标到二维像素坐标的映射关系,然后,移动定位跟踪器,改变其位置,使其均匀分布于图片中,从而重复上述步骤,以获得足够多的点对(保证6对以上),
S2、根据所述多对物理相机中的像素坐标及对应的虚拟坐标系中的坐标,求解矩阵G;
若使虚拟相机的像和物理相机的像重合,就需要某个三维世界的点在虚拟相机坐标系下的表示在经过位姿变换后应与在物理相机坐标系下的表示重合,即对应关系如下:
PI=GPM
其中,PI=[xi,yi]T,定义为物理相机下的tracker的像素的坐标,
PM=[xM,yM,zM]T,定义为三维世界的tracker的坐标在虚拟相机坐标系下的表示;
根据上述对应关系及步骤1获得的多个点对组合可解出矩阵G;
具体的,使虚拟相机的像和物理相机的像重合,涉及到两个步骤,一是刚体的位姿,包括位移和旋转,另一个是虚拟相机内参的设定;
而刚体的位移和旋转,是由一个旋转矩阵R和位移向量T构成,由此得到刚体的位姿可用如下公式表示:
对于相机内参,是根据小孔成像原理得到相机的内参矩阵进而把一个点从三维坐标(相机坐标系下)投影到像素坐标系下,因此,可得到如下公式:
其中,内参矩阵可以进一步的表示为齐次形式:
由上分析,可得G=TprojTpose;
进一步,可得PI=TprojTposePM,已知PM是三维世界的tracker的坐标在虚拟相机坐标系下的表示;我们假定虚拟相机坐标系为A,tracker的世界坐标系为Pw,根据数学定义,tracker在虚拟相机坐标系下的坐标PM=A-1Pw,
由此,有PI=TprojTposeA-1Pw,
而本申请的目的是找到虚拟相机坐标系偏移到物理相机坐标系下的偏移矩阵Tpose,因此也就有PI=Tproj(ATpose -1)-1Pw,
综上也就是说,根据Tpose可以得到物理相机坐标系ATpose -1,有了物理相机坐标系,我们就可以把tracker先从世界坐标系Pw转换到物理相机坐标系下,然后再应用投影变换,得到像素上的点!
具体的,矩阵G为:
在一个实施例中,G的一个3*4矩阵为:
[[247.6831,410.4999,0.00088,-2130.42580],
[1.4157488351899853e-05,142.9999,-247.6826,-8431.482037271988],
[5.8509535853e-07,0.999999,1.8749893022852892e-06,-6.999949]]
可见,矩阵G实际上是相机内参矩阵K与旋转矩阵R构成的3x3矩阵以及相机内参矩阵K与位移向量T构成的3x1向量,拼接而构成的一个3x4矩阵,即G=[KR|KT],
也就是说,矩阵G包含12个未知量,根据公式PI=GPM,每个点对可以得到两个独立的方程,
若矩阵G的表示为:
则每个点对得到的两个独立的方程为:
xi(g31xM+g32yM+g33zM+g34)=g11xM+g12yM+g13zM+g14
yi(g31xM+g32yM+g33zM+g34)=g21xM+g22yM+g23zM+g24
如上,因此需要至少6组数据点对,可将矩阵G的全部未知量求出。
S3、分解所述矩阵G,得到旋转矩阵、位移向量及内参矩阵;
矩阵G的前三列是矩阵乘法KR的结果,K的形式为上三角阵,将矩阵G的前三列进行RQ分解,得到的第一个矩阵是3x3的上三角矩阵,符合内参矩阵K的构型,第二个矩阵自然就是旋转矩阵R了,G的最后一列是矩阵乘法KT的结果,得到K后,将K的逆左乘G的最后一列就得出了位移向量T。
S4、根据所述旋转矩阵、位移向量及内参矩阵设置虚拟相机位姿和内参。
将这个R和T应用到虚拟相机的位姿,可以将其偏移到物理相机的位姿,这也就达到了虚拟相机的坐标系与物理相机坐标系重合的目的;
将内参矩阵K应用到虚拟相机上,可以使得定位tracker在虚拟相机中的像与在物理相机中的像完全重合。
另一方面,本发明实施例公开了一种MR混合摄影相机的标定方法的MR混合摄影相机的标定系统,其特征在于,包括:
数据获取模块,用于获取多对物理相机中的像素坐标及对应的虚拟相机坐标系中的坐标;其中,数据获取模块包括定位基站和两个跟踪器,所述定位基站的数量由跟踪的物理空间大小确定。
数据处理模块,用于根据多对所述物理相机中的像素坐标及对应的虚拟相机坐标系中的坐标求解旋转矩阵、位移向量及内参矩阵;
虚拟相机参数更新模块,用于根据所述旋转矩阵、位移向量及内参矩阵设置虚拟相机位姿和内参。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的装置而言,由于其与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。
对所公开的实施例的上述说明,使本领域专业技术人员能够实现或使用本发明。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本发明的精神或范围的情况下,在其它实施例中实现。因此,本发明将不会被限制于本文所示的这些实施例,而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。