CN105913439A - 一种基于激光跟踪仪的大视场摄像机标定方法 - Google Patents

一种基于激光跟踪仪的大视场摄像机标定方法 Download PDF

Info

Publication number
CN105913439A
CN105913439A CN201610256939.3A CN201610256939A CN105913439A CN 105913439 A CN105913439 A CN 105913439A CN 201610256939 A CN201610256939 A CN 201610256939A CN 105913439 A CN105913439 A CN 105913439A
Authority
CN
China
Prior art keywords
coordinate system
coordinate
scaling board
prime
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
CN201610256939.3A
Other languages
English (en)
Other versions
CN105913439B (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.)
Tsinghua University
Original Assignee
Tsinghua 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 Tsinghua University filed Critical Tsinghua University
Priority to CN201610256939.3A priority Critical patent/CN105913439B/zh
Publication of CN105913439A publication Critical patent/CN105913439A/zh
Application granted granted Critical
Publication of CN105913439B publication Critical patent/CN105913439B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Length Measuring Devices By Optical Means (AREA)
  • Image Processing (AREA)

Abstract

本发明属于视觉测量领域,涉及一种基于激光跟踪仪的大视场摄像机标定方法。本方法根据激光跟踪仪的特点制作标定板;用摄像机拍摄不同位置和角度的标定板图像,标定板分布位置布满摄像机视场;利用角点检测工具软件对标定板进行角点检测,选用标定板中心区域的角点检测结果;利用标定板四角的靶球坐标计算标定板中心区域的角点的世界坐标系坐标;利用直接线性变换法计算摄像机内部矩阵和外部矩阵,迭代计算径向畸变系数,得到高精度的标定结果。本发明可解决线性变换法在大视场标定需求下需要制作大型高精度标定板的问题,同时激光跟踪仪的测量特点有利于标定板摆放适当的角度,提高了可操作性和标定精度。本方法适用于大视场摄像机的标定。

Description

一种基于激光跟踪仪的大视场摄像机标定方法
技术领域
本发明属于视觉测量领域,特别涉及一种基于激光跟踪仪的大视场摄像机标定方法。
背景技术
摄像机的标定是基于摄像机的视觉系统能够进行测量的关键,标定得到的摄像机的内外参数和畸变系数对视觉系统测量的精度有着很大的影响。在大视场标定中,摄像机的视野较大较远,大型高精度的靶标难以加工、运输和维护,也难以在实际场景中应用,小型的标靶仅能覆盖小部分视场,这会对摄像机标定结果带来巨大的误差,并且标定精度在视场中分布不均匀。
现有的技术文献中,发明专利“摄像机大视场高精度快速现场全局标定方法”,公开号为CN102208108B,将标定分为预标定和现场校正两个步骤,预标定包括:首先进行基于控制线的摄像机畸变参数的标定,然后进行基于控制点的摄像机非畸变参数的全局标定;最后进行快速现场校正。该方法的缺点是,预标定控制点需要逐个进行采集,高精度的测量需要大量的控制点,预标定控制点的采集环节耗时较大。另外,该方法现场控制点的三维世界坐标系直接用预标定的参数计算,但是摄像机更换环境后由于温度等原因内外参数已经发生了变化,计算出的结果将是有误差的,且后续的现场校正环节将不能解决这部分的误差。
当前,随着制造业的发展,各种精密测量仪器不断出现,对视觉测量工作的发展起到了推动作用。激光跟踪仪系统(Laser Tracker System)就是其中一种具有高精度、高效率、实时跟踪测量、安装快捷、操作简便等特点的测量系统,适合于较长距离的高精度测量。激光跟踪仪系统主要包括激光跟踪仪、靶球、靶球底座等部分,该系统的测量方法如图1所示。激光跟踪仪1能自动对准靶球2中心,测出靶球中心的世界坐标系坐标;靶球底座3可以放置在关注的采样点位置上,把靶球2放置在底座3上即可算出采样点的世界坐标系坐标。利用激光跟踪仪的优点,可以在标定现场构成一个虚拟的覆盖整个视场的高精度靶标,为大视场摄像机的标定提供新的思路。
发明内容
本发明的目的是为克服已有技术的不足之处,提出一种基于激光跟踪仪的大视场摄像机标定方法。利用激光跟踪仪的优点,在摄像机的视场中选择多个空间采样点,利用激光跟踪仪测量出它们的三维坐标,创建一个能覆盖整个摄像机视场的大型高精度的虚拟标靶,然后用直接线性变换的方法对摄像机进行标定。
本发明提出的基于激光跟踪仪的大视场摄像机标定方法,其特征在于,该方法包括以下步骤:
1)制作单元格为正方形的棋盘格标定板;制作黑白棋盘格标定板,设棋盘格角点个数为Length×Height,Length表示标定板列数,Height表示标定板行数,标定板单元格为正方形,在标定板的4个顶点安装激光跟踪仪的靶球底座,设靶球底座的底板厚度与靶球半径之和为L,则L表示靶球中心到棋盘格顶点的空间距离;
2)现场采集数据,使用摄像机拍摄包含标定板的图片,使用激光跟踪仪采集标定板顶点上靶球中心的世界坐标系坐标,具体步骤如下:
2-1)在摄像机视场中选择位置稳定摆放步骤1)制作的标定板,摆放的位置和角度以摄像机能完整拍摄到标定板、激光跟踪仪能测量到标定板4个顶点上的靶球和标定板与摄像机拍摄角度呈45°到90°范围内为准;
2-2)使用摄像机拍包含摄标定板的图片,设为图片pic_1,使用激光跟踪仪测量4个顶点的靶球中心的世界坐标系坐标,设先从左到右再从上到下4个靶球分别为a,b,c,d,设a点的世界坐标系坐标为Pa1=(xa1,ya1,za1),4个靶球的世界坐标系坐标依次表示为Pa1、Pb1、Pc1、Pd1,即为激光跟踪仪测量所得的标定板4个顶点对应的靶球中心的世界坐标系坐标;
2-3)重复步骤2-1)和2-2),每次更换标定板的位置和角度并采集数据,使标定板分布布满整个摄像机视场空间,设采集n组数据,则得到n张图片pic_1~pic_n,n组标定板顶点对应的靶球中心的世界坐标系坐标Pai=(xai,yai,zai)、Pbi、Pci、Pdi,其中i=1~n;
3)检测标定板角点的图像坐标系原始坐标:使用棋盘格角点检测工具软件,对步骤2)得到的图片进行亚像素的角点检测,检测的角点为Length×Height的棋盘格除去四条边上的角点外剩余中心区域的k个角点,,设k=(Length-1)×(Height-1),先从左到右再从上到下k个角点为J1~Jk,角点J1的图像坐标系原始坐标为Q1=(u'1,v'1),则k个角点的图像坐标系原始坐标为Q1~Qk,重复步骤3),直至得到所有n张图片中可用角点的图像坐标系原始坐标,设得到的坐标为Qji=(u'ji,v'ji),其中j=1~k,i=1~n;
4)利用步骤2)得到的n组标定板顶点对应的靶球中心的世界坐标系坐标,计算标定板4个顶点的世界坐标系坐标和标定板除去四条边以外的中心区域的角点的世界坐标系坐标;
5)根据步骤3)和步骤4)得到的一一对应的角点图像坐标系原始坐标和角点世界坐标系坐标,对摄像机进行标定,获得摄像机内参数矩阵M1_final、外参数矩阵M2_final和径向畸变系数q1_final、q2_final;
6)解出摄像机内参数矩阵M1_final、外参数矩阵M2_final和径向畸变系数q1_final、q2_final,大视场摄像机标定完成。
本发明提出的基于激光跟踪仪的大视场摄像机标定方法,具有以下优点:
1、本发明利用激光跟踪仪创建一个大型高精度的虚拟标靶,使采样点能尽可能地覆盖摄像机的整个视场,克服了直接线性变换法进行标定时需要制作大型高精度靶标的缺点。
2、本发明利用激光跟踪仪基于靶球而不是反射面测量的特点,使标定板的摆放角度不受测量设备位置的限制,能够根据摄像头的角度调整到适当的拍摄角度,提高标定板角点检测的精度,从而提高标定精度。
附图说明
图1为本发明所涉及的激光跟踪仪系统的测量方法示意图。
图2为本发明的基于激光跟踪仪的大视场摄像机标定方法流程框图。
图3为本发明实施例中标定板靶球底座位置和角点位置示意图。
图4为本发明实施例中摄像机相关坐标系示意图。
具体实施方式
本发明提出的一种基于激光跟踪仪的大视场摄像机标定方法,下面结合附图和具体实施例,进一步详细说明如下。
本发明提出的一种基于激光跟踪仪的大视场摄像机标定方法,其流程如图2所示,包括以下步骤:
1)制作单元格为正方形的棋盘格标定板;制作黑白棋盘格标定板(标定板精度越高越好,本实施例中精度为1毫米),设棋盘格角点个数为Length×Height,Length表示标定板列数,Height表示标定板行数,(标定板行数、列数可以不同),标定板单元格为正方形,(标定板大小、单元格宽度根据运输和使用需求酌情制定,本实施例中角点个数为4×4,标定板整体长度和宽度约为1.2米,标定板样式如图3所示),在标定板的4个顶点安装激光跟踪仪的靶球底座,设靶球底座的底板厚度与靶球半径之和为L,则L表示靶球中心到棋盘格顶点的空间距离;
2)现场采集数据,使用摄像机拍摄包含标定板的图片,使用激光跟踪仪采集标定板顶点上靶球中心的世界坐标系坐标,具体步骤如下:
2-1)在摄像机视场中选择位置稳定摆放步骤1)制作的标定板,摆放的位置和角度以摄像机能完整拍摄到标定板、激光跟踪仪能测量到标定板4个顶点上的靶球和标定板与摄像机拍摄角度呈45°到90°范围内为准;
2-2)使用摄像机拍包含摄标定板的图片,设为图片pic_1,使用激光跟踪仪测量4个顶点的靶球中心的世界坐标系坐标(以下简称靶球坐标),如图2所示,设先从左到右再从上到下4个靶球分别为a,b,c,d,靶球位置如图3所示,设a点的世界坐标系坐标为Pa1=(xa1,ya1,za1),4个靶球的世界坐标系坐标依次表示为Pa1、Pb1、Pc1、Pd1,即为激光跟踪仪测量所得的标定板4个顶点对应的靶球中心的世界坐标系坐标;
2-3)重复步骤2-1)和2-2),每次更换标定板的位置和角度并采集数据,使标定板分布布满整个摄像机视场空间(根据时间限制酌情控制次数,采集到的数据越多,分布越合理,则最终标定结果越精确),设采集n组数据,则得到n张图片pic_1~pic_n,n组标定板顶点对应的靶球中心的世界坐标系坐标Pai=(xai,yai,zai)、Pbi、Pci、Pdi,其中i=1~n;
3)检测标定板角点的图像坐标系原始坐标:使用棋盘格角点检测工具软件(本实施例中使用的是MATLAB的摄像机标定工具箱TOOLBOX_calib),对步骤2)得到的图片进行亚像素的角点检测,对于Length×Height的棋盘格除去四条边上的角点不使用则剩余中心区域的(Length-1)×(Height-1)个可用角点,设k=(Length-1)×(Height-1)(本实施例中剩余k=(4-1)×(4-1)=9个可用角点,角点位置如图3所示,先从左到右再从上到下k个角点为J1~Jk(本实施例中,如图3所示,剩余角点为J1~J9),角点J1的图像坐标系原始坐标为Q1=(u'1,v'1),则k个角点的图像坐标系原始坐标为Q1~Qk,重复步骤3),直至得到所有n张图片中可用角点的图像坐标系原始坐标,设得到的坐标为Qji=(u'ji,v'ji),其中j=1~k,i=1~n;
4)利用步骤2)得到的n组标定板顶点对应的靶球中心的世界坐标系坐标,计算标定板4个顶点的世界坐标系坐标和标定板除去四条边以外的中心区域的角点(四条边上的角点检测误差较大,所以不使用)的世界坐标系坐标,具体步骤如下:
4-1)计算所有采集图像中靶球中心对应的标定板上的4个顶点的世界坐标系坐标,由步骤2)激光跟踪仪得到的靶球中心的世界坐标系坐标,将靶球中心坐标沿垂直于4个靶球中心点构成的平面的方向向标定板平移,移动距离为靶球中心到棋盘格顶点的空间距离L,计算得到靶球底座对应的标定板上顶点的世界坐标系坐标;具体方法是:利用步骤2-2)得到的4个靶球的世界坐标系坐标Pa1、Pb1、Pc1、Pd1,得到相邻靶球之间的方向矢量4个靶球中心所在平面的方向矢量为(这里的“×”表示向量间的叉乘),单位化则4个靶球对应的标定板上顶点的世界坐标系坐标通过靶球坐标平移得到,设为Oa1~Od1,其中
4-2)插值计算标定板中心区域角点的坐标;对于任意一张图片,图片中第j个角点Jj相对于第1个标定板顶点Oa1的从左到右的单位偏移量为
从上到下的单位偏移量为:
则图片中第j个角点Jj相对于第1个标定板顶点Oa1的左右偏移量为%表示取余,相对于第1个标定板顶点Oa1的上下偏移量为[]表示取整,则图片中第j个角点Jj对应的的世界坐标系坐标为其中j=1~k;
4-3)重复步骤4-1)和4-2),直至得到所有n张采集图像pic_1~pic_n对应的角点的世界坐标系坐标,即得到Rji=(xji,yji,zji),其中j=1~k,i=1~n;
5)根据步骤3)和步骤4)得到的一一对应的角点图像坐标系原始坐标和角点世界坐标系坐标,对摄像机进行标定,获得摄像机内参数矩阵M1_final、外参数矩阵M2_final和径向畸变系数q1_final、q2_final,具体步骤如下:
5-1)摄像机成像模型相关坐标系如图4所示,设任意空间点G在摄像机坐标系C中的坐标为G(xc,yc,zc),将该点在摄像机成像平面M上的投影坐标设为G(x,y),由小孔成像原理得到,空间点G在摄像机坐标系C中的坐标G(xc,yc,zc)与投影坐标G(x,y)的坐标变换关系为:其中f为摄像机焦距;
5-2)设一个像素在摄像机成像平面坐标系N中的x轴和y轴方向上的物理尺寸分别为dx和dy,步骤5-1)所述的空间点G(xc,yc,zc)通过成像原理得到的图像坐标系U上的理想坐标(u,v)和摄像机成像平面M上的投影坐标G(x,y)存在以下坐标变换关系:其中,O(u0,v0)为位于摄像机主光轴OcZc上任意一点在摄像机成像平面坐标系N中的成像坐标,该成像坐标即主点坐标;
5-3)根据上述步骤5-1)和步骤5-2)的坐标变换关系,得到摄像机的内参数矩阵M1为:其中,为摄像机焦距f在图像坐标系U的u轴上的归一化焦距,为摄像机焦距f在图像坐标系U的v轴上的归一化焦距;
5-4)设空间点G在世界坐标系W中的坐标为G(xW,yW,zW),空间点G在摄像机坐标系C中的坐标和在世界坐标系W中的坐标存在以下关系:其中,R为3×3的单位正交矩阵,t为摄像机坐标系C和世界坐标系W之间的三维平移向量,定义其中的[R t]为摄像机外参数矩阵M2
5-5)设投影矩阵为P=M1M2,则投影变换关系为:
s u v 1 = M 1 x c y c z c = M 1 R t x W y W z W 1 = M 1 M 2 x W y W z W 1 = P x W y W z W 1 - - - ( 1 )
其中s是任意的比例因子,P为从世界坐标系到图像坐标系的投影矩阵,
将矩阵P写成如下的形式:
P = p 11 p 12 p 13 p 14 p 21 p 22 p 23 p 24 p 31 p 32 p 33 p 34 - - - ( 2 )
将公式(2)代入投影变换关系公式(1)中,再消去s,得到如下的方程组:
p 11 x W + p 12 y W + p 13 z W + p 14 - p 31 x W u - p 32 y W u - p 33 z W u = p 34 u p 21 x W + p 22 y W + p 23 z W + p 24 - p 31 x W v - p 32 y W v - p 33 z W v = p 34 v - - - ( 3 )
对于任意在世界坐标系和图像坐标系已知的空间点,每个点的世界坐标系坐标和图像坐标系坐标都符合公式(3)所示的两个方程。利用步骤3)和步骤4)得到的k*n个可用的角点图像坐标系原始坐标Qji=(u'ji,v'ji)和世界坐标系坐标Rji=(xji,yji,zji),其中j=1~k,i=1~n,进而得到一个含有2*k*n个方程的方程组:
AL=B (4)
其中,
A = x 11 y 11 z 11 1 0 0 0 0 - u ′ 11 x 11 - u ′ 11 y 11 - u ′ 11 z 11 0 0 0 0 x 11 y 11 z 11 1 - v ′ 11 x 11 - v ′ 11 y 11 - v ′ 11 z 11 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . x k n y k n z k n 1 0 0 0 0 - u ′ k n x k n - u ′ k n y k n - u ′ k n z k n 0 0 0 0 x k n y k n z k n 1 - v ′ k n x k n - v ′ k n y k n - v ′ k n z k n - - - ( 5 )
L=[p11 p12 p13 p14 p21 p22 p23 p24 p31 p32 p33]T (6)
B=[u'11p34 v'11p34 … u'knp34 v'knp34]T (7)
T表示矩阵的转置计算;
因为p34≠0,式(3)两端同时除以p34,相当于给出约束p34=1,得:
AL'=B' (8)
其中,
L ′ = L p 34 - - - ( 9 )
B'=[u'11 v'11 … u'kn v'kn]T (10)
利用最小二乘法,求解L':
L'=(ATA)-1ATB' (11)
将摄像机的外参数矩阵M2和投影矩阵P改写成如公式(12)的形式:
M 2 = R y = r 1 T t x r 2 T t y r 3 T t z , P = p 1 T p 14 p 2 T p 24 p 3 T p 34 - - - ( 12 )
其中依次对应3×3单位正交矩阵R的第1行至第3行,
由P=M1M2得到:
p 1 T p 14 p 2 T p 24 p 3 T p 34 = f x r 1 T + u 0 r 3 T f x t x + u 0 t z f y r 2 T + v 0 r 3 T f y t y + v 0 t z r 3 T t z - - - ( 13 )
解出摄像机的各个内外参数:
| | p 3 T | | = | | r 3 T | | = 1 - - - ( 14 )
p34=1/||p3|| (15)
f x = | | p 1 × p 3 | | f y = | | p 2 × p 3 | | u 0 = p 1 T p 3 v 0 = p 2 T p 3 - - - ( 16 )
r 1 = ( p 1 - u 0 p 3 ) / f x r 2 = ( p 2 - v 0 p 3 ) / f y r 3 = p 3 - - - ( 17 )
t x = ( p 14 - u 0 p 34 ) / f x t y = ( p 24 - v 0 p 34 ) / f y t z = p 34 - - - ( 18 )
至此,解出了摄像机的内参数矩阵M1和外参数矩阵M2;
5-6)设摄像机的径向畸变参数为q1和q2,则q1和q2满足以下方程组:
u ′ = u ( 1 + q 1 r 2 + q 2 r 4 ) v ′ = v ( 1 + q 1 r 2 + q 2 r 4 ) - - - ( 19 )
其中,(u',v')为空间点G在图像坐标系中的原始坐标,(u,v)为空间点G通过成像原理得到的图像坐标系理想坐标;计算时,G点的图像坐标系中的原始坐标代入由步骤3)得到的k*n个可用角点的图像坐标系原始坐标Qji=(u'ji,v'ji),其中j=1~k,i=1~n,得到2*k*n个方程的方程组,使用最小二乘法求解该方程组,得到摄像机的径向畸变参数q1、q2
5-7)计算空间点G的图像坐标系近似理想坐标(u”,v”),如式(20)所示:
u ′ ′ = u ′ / ( 1 + q 1 r ′ 2 + q 2 r ′ 4 ) v ′ ′ = v ′ / ( 1 + q 1 r ′ 2 + q 2 r ′ 4 ) - - - ( 20 )
其中,q1、q2为步骤5-6)得到的畸变系数;
公式(20)计算得到k*n个可用角点对应的图像坐标系近似理想坐标Q'ji=(u”ji,v”ji),其中j=1~k,i=1~n;
5-8)用步骤5-7)得到的Q'ji替换Qji,其中j=1~k,i=1~n,重新进行步骤5-5)、5-6)、5-7)的计算,得到新的摄像机内参数矩阵M1_new、外参数矩阵M2_new和径向畸变系数q1_new、q2_new,迭代若干次直到用最小二乘法解方程组误差不再减小,得到最终的摄像机内参数矩阵M1_final、外参数矩阵M2_final和径向畸变系数q1_final、q2_final;
6)解出摄像机内参数矩阵M1_final、外参数矩阵M2_final和径向畸变系数q1_final、q2_final,大视场摄像机标定完成。

Claims (3)

1.一种基于激光跟踪仪的大视场摄像机标定方法,其特征在于,该方法包括以下步骤:
1)制作单元格为正方形的棋盘格标定板;制作黑白棋盘格标定板,设棋盘格角点个数为Length×Height,Length表示标定板列数,Height表示标定板行数,标定板单元格为正方形,在标定板的4个顶点安装激光跟踪仪的靶球底座,设靶球底座的底板厚度与靶球半径之和为L,则L表示靶球中心到棋盘格顶点的空间距离;
2)现场采集数据,使用摄像机拍摄包含标定板的图片,使用激光跟踪仪采集标定板顶点上靶球中心的世界坐标系坐标,具体步骤如下:
2-1)在摄像机视场中选择位置稳定摆放步骤1)制作的标定板,摆放的位置和角度以摄像机能完整拍摄到标定板、激光跟踪仪能测量到标定板4个顶点上的靶球和标定板与摄像机拍摄角度呈45°到90°范围内为准;
2-2)使用摄像机拍包含摄标定板的图片,设为图片pic_1,使用激光跟踪仪测量4个顶点的靶球中心的世界坐标系坐标,设先从左到右再从上到下4个靶球分别为a,b,c,d,设a点的世界坐标系坐标为Pa1=(xa1,ya1,za1),4个靶球的世界坐标系坐标依次表示为Pa1、Pb1、Pc1、Pd1,即为激光跟踪仪测量所得的标定板4个顶点对应的靶球中心的世界坐标系坐标;
2-3)重复步骤2-1)和2-2),每次更换标定板的位置和角度并采集数据,使标定板分布布满整个摄像机视场空间,设采集n组数据,则得到n张图片pic_1~pic_n,n组标定板顶点对应的靶球中心的世界坐标系坐标Pai=(xai,yai,zai)、Pbi、Pci、Pdi,其中i=1~n;
3)检测标定板角点的图像坐标系原始坐标:使用棋盘格角点检测工具软件,对步骤2)得到的图片进行亚像素的角点检测,检测的角点为Length×Height的棋盘格除去四条边上的角点外剩余中心区域的k个角点,设k=(Length-1)×(Height-1),先从左到右再从上到下k个角点为J1~Jk,角点J1的图像坐标系原始坐标为Q1=(u'1,v'1),则k个角点的图像坐标系原始坐标为Q1~Qk,重复步骤3),直至得到所有n张图片中可用角点的图像坐标系原始坐标,设得到的坐标为Qji=(u'ji,v'ji),其中j=1~k,i=1~n;
4)利用步骤2)得到的n组标定板顶点对应的靶球中心的世界坐标系坐标,计算标定板4个顶点的世界坐标系坐标和标定板除去四条边以外的中心区域的角点的世界坐标系坐标;
5)根据步骤3)和步骤4)得到的一一对应的角点图像坐标系原始坐标和角点世界坐标系坐标,对摄像机进行标定,获得摄像机内参数矩阵M1_final、外参数矩阵M2_final和径向畸变系数q1_final、q2_final;
6)解出摄像机内参数矩阵M1_final、外参数矩阵M2_final和径向畸变系数q1_final、q2_final,大视场摄像机标定完成。
2.如权利要求1所述方法,所述步骤4)计算标定板4个顶点的世界坐标系坐标和标定板除去四条边以外的中心区域的角点的世界坐标系坐标,具体步骤如下:
4-1)计算所有采集图像中靶球中心对应的标定板上的4个顶点的世界坐标系坐标,由步骤2)中激光跟踪仪得到的靶球中心的世界坐标系坐标,将靶球中心坐标沿垂直于4个靶球中心点构成的平面的方向向标定板平移,移动距离为靶球中心到棋盘格顶点的空间距离L,计算得到靶球底座对应的标定板顶点的世界坐标系坐标;具体方法是:利用步骤2-2)得到的4个靶球的世界坐标坐标系坐标Pa1、Pb1、Pc1、Pd1,得到相邻靶球之间的方向矢量4个靶球中心所在平面的方向矢量为“×”表示向量间的叉乘,单位化则4个靶球对应的标定板顶点的世界坐标系坐标通过靶球坐标平移得到,设为Oa1~Od1,其中
4-2)插值计算标定板中心区域角点的坐标;对于任意一张图片,图片中第j个角点Jj相对于第1个标定板顶点Oa1的从左到右的单位偏移量为:
从上到下的单位偏移量为:
则图片中第j个角点Jj相对于第1个标定板顶点Oa1的左右偏移量为:
%表示取余,相对于第1个标定板顶点Oa1的上下偏移量为:
[]表示取整,则图片中第j个角点Jj对应的的世界坐标系坐标为
R j = ( x j , y j , z j ) = O a 1 + s x _ py j + z y _ py j = ( x o a 1 + x s x + x z y , y o a 1 + y s x + y z y , z o a 1 + z s x + z z y ) ,
其中j=1~k;
4-3)重复步骤4-1)和4-2),直至得到所有n张采集图像pic_1~pic_n对应的角点的世界坐标系坐标,即得到Rji=(xji,yji,zji),其中j=1~k,i=1~n。
3.如权利要求1所述方法,所述步骤5)获得摄像机内参数矩阵M1_final、外参数矩阵M2_final和径向畸变系数q1_final、q2_final,具体步骤如下:
5-1)摄像机成像模型相关坐标系如图4所示,设任意空间点G在摄像机坐标系中的坐标为将该点在摄像机成像平面上的投影坐标设为G(x,y),由小孔成像原理得到,空间点G在摄像机坐标系中的坐标与投影坐标G(x,y)的坐标变换关系为:其中f为摄像机焦距;
5-2)设一个像素在摄像机成像平面坐标系中的x轴和y轴方向上的物理尺寸分别为dx和dy,步骤5-1)所述的空间点通过成像原理得到的图像坐标系理想坐标(u,v)和摄像机成像平面投影坐标G(x,y)存在以下坐标变换关系:其中,O(u0,v0)为位于摄像机主光轴上任意一点在摄像机成像平面坐标系中的成像坐标,该成像坐标即主点坐标;
5-3)根据上述步骤5-1)和步骤5-2)的坐标变换关系,得到摄像机的内参数矩阵M1为:其中,为摄像机焦距f在图像坐标系的u轴上的归一化焦距,为摄像机焦距f在图像坐标系的v轴上的归一化焦距;
5-4)设空间点G在世界坐标系中的坐标为空间点G在摄像机坐标系中的坐标和在世界坐标系中的坐标存在以下关系:其中,R为3×3的单位正交矩阵,t为摄像机坐标系和世界坐标系之间的三维平移向量,定义其中的[R t]为摄像机外参数矩阵M2
5-5)设投影矩阵为P=M1M2,则投影变换关系为:
s u v 1 = M 1 x c y c z c = M 1 [ R t ] x W y W z W 1 = M 1 M 2 x W y W z W 1 = P x W y W z W 1 - - - ( 1 )
其中s是任意的比例因子,P为从世界坐标系到图像坐标系的投影矩阵,将矩阵P写成如下的形式:
P = p 11 p 12 p 13 p 14 p 21 p 22 p 23 p 24 p 31 p 32 p 33 p 34 - - - ( 2 )
将公式(2)代入投影变换关系公式(1)中,再消去s,得到如下的方程组:
p 11 x W + p 12 y W + p 13 z W + p 14 - p 31 x W u - p 32 y W u - p 33 z W u = p 34 u p 21 x W + p 22 y W + p 23 z W + p 24 - p 31 x W v - p 32 y W v - p 33 z W v = p 34 v - - - ( 3 )
对于任意在世界坐标系和图像坐标系已知的空间点,每个点的世界坐标系坐标和图像坐标系坐标都符合公式(3)所示的两个方程;利用步骤3)和步骤4)得到的k*n个可用的角点图像坐标系原始坐标Qji=(u'ji,v'ji)和世界坐标系坐标Rji=(xji,yji,zji),其中j=1~k,i=1~n,进而得到一个含有2*k*n个方程的方程组:
AL=B (4)
其中,
A = x 11 y 11 z 11 1 0 0 0 0 - u ′ 11 x 11 - u ′ 11 y 11 - u ′ 11 z 11 0 0 0 0 x 11 y 11 z 11 1 - v ′ 11 x 11 - v ′ 11 y 11 - v ′ 11 z 11 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . x k n y k n z k n 1 0 0 0 0 - u ′ k n x k n - u ′ k n y k n - u ′ k n z k n 0 0 0 0 x k n y k n z k n 1 - v ′ k n x k n - v ′ k n y k n - v ′ k n z k n - - - ( 5 )
L=[p11 p12 p13 p14 p21 p22 p23 p24 p31 p32 p33]T (6)
B=[u'11p34 v'11p34 … u'knp34 v'knp34]T (7)
T表示矩阵的转置计算;
因为p34≠0,公式(3)两端同时除以p34,相当于给出约束p34=1,得:
AL'=B' (8)
其中,
L ′ = L p 34 - - - ( 9 )
B'=[u'11 v'11 … u'kn v'kn]T (10)
利用最小二乘法,求解L':
L'=(ATA)-1ATB' (11)
将摄像机的外参数矩阵M2和投影矩阵P改写成如公式(12)的形式:
M 2 = [ R t ] = r 1 T t x r 2 T t y r 3 T t z , P = p 1 T p 14 p 2 T p 24 p 3 T p 34 - - - ( 12 )
其中依次对应3×3单位正交矩阵R的第1行至第3行,
由P=M1M2得到:
p 1 T p 14 p 2 T p 24 p 3 T p 34 = f x r 1 T + u 0 r 3 T f x t x + u 0 t z f y r 2 T + v 0 r 3 T f y t y + v 0 t z r 3 T t z - - - ( 13 )
解出摄像机的各个内外参数:
| | p 3 T | | = | | r 3 T | | = 1 - - - ( 14 )
p34=1/||p3|| (15)
f x = | | p 1 × p 3 | | f y = | | p 2 × p 3 | | u 0 = p 1 T p 3 v 0 = p 2 T p 3 - - - ( 16 )
r 1 = ( p 1 - u 0 p 3 ) / f x r 2 = ( p 2 - v 0 p 3 ) / f y r 3 = p 3 - - - ( 17 )
t x = ( p 14 - u 0 p 34 ) / f x t y = ( p 24 - v 0 p 34 ) / f y t z = p 34 - - - ( 18 )
至此,解出了摄像机的内参数矩阵M1和外参数矩阵M2;
5-6)设摄像机的径向畸变参数为q1和q2,则q1和q2满足以下方程组:
u ′ = u ( 1 + q 1 r 2 + q 2 r 4 ) v ′ = v ( 1 + q 1 r 2 + q 2 r 4 ) - - - ( 19 )
其中,(u',v')为空间点G在图像坐标系中的原始坐标,(u,v)为空间点G通过成像原理得到的图像坐标系理想坐标;计算时,G点的图像坐标系中的原始坐标代入由步骤3)得到的k*n个可用角点的图像坐标系原始坐标Qji=(u'ji,v'ji),其中j=1~k,i=1~n,得到2*k*n个方程的方程组,使用最小二乘法求解该方程组,得到摄像机的径向畸变参数q1、q2
5-7)计算空间点G的图像坐标系近似理想坐标(u”,v”),如公式(20)所示:
u ′ ′ = u ′ / ( 1 + q 1 r ′ 2 + q 2 r ′ 4 ) v ′ ′ = v ′ / ( 1 + q 1 r ′ 2 + q 2 r ′ 4 ) - - - ( 20 )
其中,q1、q2为步骤5-6)得到的畸变系数;
公式(20)计算得到k*n个可用角点对应的图像坐标系近似理想坐标Q'ji=(u”ji,v”ji),其中j=1~k,i=1~n;
5-8)用步骤5-7)得到的Q'ji替换Qji,重新进行步骤5-5)、5-6)、5-7)的计算,得到新的摄像机内参数矩阵M1_new、外参数矩阵M2_new和径向畸变系数q1_new、q2_new,迭代若干次直到用最小二乘法解方程组误差不再减小,得到最终的摄像机内参数矩阵M1_final、外参数矩阵M2_final和径向畸变系数q1_final、q2_final。
CN201610256939.3A 2016-04-22 2016-04-22 一种基于激光跟踪仪的大视场摄像机标定方法 Active CN105913439B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610256939.3A CN105913439B (zh) 2016-04-22 2016-04-22 一种基于激光跟踪仪的大视场摄像机标定方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610256939.3A CN105913439B (zh) 2016-04-22 2016-04-22 一种基于激光跟踪仪的大视场摄像机标定方法

Publications (2)

Publication Number Publication Date
CN105913439A true CN105913439A (zh) 2016-08-31
CN105913439B CN105913439B (zh) 2018-12-11

Family

ID=56752762

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610256939.3A Active CN105913439B (zh) 2016-04-22 2016-04-22 一种基于激光跟踪仪的大视场摄像机标定方法

Country Status (1)

Country Link
CN (1) CN105913439B (zh)

Cited By (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106803271A (zh) * 2016-12-23 2017-06-06 成都通甲优博科技有限责任公司 一种视觉导航无人机的摄像机标定方法及装置
CN107330942A (zh) * 2017-06-20 2017-11-07 成都通甲优博科技有限责任公司 一种标定模板、标定方法、标定操作方法及标定系统
CN107507244A (zh) * 2017-07-26 2017-12-22 成都通甲优博科技有限责任公司 一种单帧图像的相机标定方法、标定操作方法及标定装置
CN107730559A (zh) * 2017-09-30 2018-02-23 东风商用车有限公司 一种基于图像处理的车载摄像头的标定方法
CN107941153A (zh) * 2017-12-29 2018-04-20 厦门大学 一种激光测距优化标定的视觉系统
CN107993268A (zh) * 2017-12-26 2018-05-04 广东工业大学 一种相机自标定的方法及系统
CN108876859A (zh) * 2018-04-28 2018-11-23 苏州赛腾精密电子股份有限公司 一种点胶机的标定方法、装置、设备和介质
CN108921901A (zh) * 2018-05-04 2018-11-30 北京航空航天大学 一种基于精密二轴转台和激光跟踪仪的大视场相机标定方法
CN109961484A (zh) * 2017-12-22 2019-07-02 比亚迪股份有限公司 摄像头标定方法、装置和车辆
CN110006406A (zh) * 2019-04-26 2019-07-12 昆明理工大学 一种摄影测量后处理辅助尺度恢复及定向的标定装置
CN110111394A (zh) * 2019-05-16 2019-08-09 湖南三一快而居住宅工业有限公司 基于机械手特征对摄像机自动标定的方法及装置
WO2020014845A1 (zh) * 2018-07-16 2020-01-23 深圳配天智能技术研究院有限公司 一种标定板、内参数标定方法、机器视觉系统及存储装置
CN110969662A (zh) * 2018-09-28 2020-04-07 杭州海康威视数字技术股份有限公司 鱼眼摄像机内参标定方法、装置、标定装置控制器和系统
CN111508027A (zh) * 2019-01-31 2020-08-07 杭州海康威视数字技术股份有限公司 摄像机外参标定的方法和装置
CN111798521A (zh) * 2019-04-09 2020-10-20 Oppo广东移动通信有限公司 标定方法、装置、存储介质及电子设备
CN112037284A (zh) * 2020-08-13 2020-12-04 重庆守愚科技有限公司 棋盘格格子中心点检测方法、摄像机畸变标定方法及系统
CN112132891A (zh) * 2020-11-26 2020-12-25 三代光学科技(天津)有限公司 一种扩大标定空间的方法
CN113496517A (zh) * 2020-03-20 2021-10-12 华为技术有限公司 超广角畸变标定方法及装置
CN117516485A (zh) * 2024-01-04 2024-02-06 东北大学 一种飞机发动机自动引导安装的位姿视觉测量方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001264037A (ja) * 2000-03-22 2001-09-26 Nippon Telegr & Teleph Corp <Ntt> カメラキャリブレーション方法及び装置及びカメラキャリブレーションプログラムを格納した記憶媒体
CN102208108A (zh) * 2011-04-01 2011-10-05 哈尔滨工业大学 摄像机大视场高精度快速现场全局标定方法
CN103438798A (zh) * 2013-08-27 2013-12-11 北京航空航天大学 主动双目视觉系统全局标定方法
CN104851104A (zh) * 2015-05-29 2015-08-19 大连理工大学 采用柔性靶标高速摄相机近景大视场标定方法
CN104897060A (zh) * 2015-06-17 2015-09-09 大连理工大学 采用坐标跟踪控制板的大视场全局测量方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001264037A (ja) * 2000-03-22 2001-09-26 Nippon Telegr & Teleph Corp <Ntt> カメラキャリブレーション方法及び装置及びカメラキャリブレーションプログラムを格納した記憶媒体
CN102208108A (zh) * 2011-04-01 2011-10-05 哈尔滨工业大学 摄像机大视场高精度快速现场全局标定方法
CN103438798A (zh) * 2013-08-27 2013-12-11 北京航空航天大学 主动双目视觉系统全局标定方法
CN104851104A (zh) * 2015-05-29 2015-08-19 大连理工大学 采用柔性靶标高速摄相机近景大视场标定方法
CN104897060A (zh) * 2015-06-17 2015-09-09 大连理工大学 采用坐标跟踪控制板的大视场全局测量方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
TUOTUO LI, ET AL.: "Geometric Calibration of a Camera-Projector 3D Imaging System", 《VRCAI 2011》 *
范勇 等: "靶丸空间坐标的高精度测定技术", 《强激光与粒子束》 *

Cited By (30)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106803271B (zh) * 2016-12-23 2020-04-28 成都通甲优博科技有限责任公司 一种视觉导航无人机的摄像机标定方法及装置
CN106803271A (zh) * 2016-12-23 2017-06-06 成都通甲优博科技有限责任公司 一种视觉导航无人机的摄像机标定方法及装置
CN107330942A (zh) * 2017-06-20 2017-11-07 成都通甲优博科技有限责任公司 一种标定模板、标定方法、标定操作方法及标定系统
CN107507244A (zh) * 2017-07-26 2017-12-22 成都通甲优博科技有限责任公司 一种单帧图像的相机标定方法、标定操作方法及标定装置
CN107730559A (zh) * 2017-09-30 2018-02-23 东风商用车有限公司 一种基于图像处理的车载摄像头的标定方法
CN107730559B (zh) * 2017-09-30 2020-05-08 东风商用车有限公司 一种基于图像处理的车载摄像头的标定方法
CN109961484A (zh) * 2017-12-22 2019-07-02 比亚迪股份有限公司 摄像头标定方法、装置和车辆
CN107993268A (zh) * 2017-12-26 2018-05-04 广东工业大学 一种相机自标定的方法及系统
CN107941153A (zh) * 2017-12-29 2018-04-20 厦门大学 一种激光测距优化标定的视觉系统
CN108876859A (zh) * 2018-04-28 2018-11-23 苏州赛腾精密电子股份有限公司 一种点胶机的标定方法、装置、设备和介质
CN108876859B (zh) * 2018-04-28 2022-06-07 苏州赛腾精密电子股份有限公司 一种点胶机的标定方法、装置、设备和介质
CN108921901A (zh) * 2018-05-04 2018-11-30 北京航空航天大学 一种基于精密二轴转台和激光跟踪仪的大视场相机标定方法
CN108921901B (zh) * 2018-05-04 2022-03-22 北京航空航天大学 一种基于精密二轴转台和激光跟踪仪的大视场相机标定方法
WO2020014845A1 (zh) * 2018-07-16 2020-01-23 深圳配天智能技术研究院有限公司 一种标定板、内参数标定方法、机器视觉系统及存储装置
CN111699513B (zh) * 2018-07-16 2024-04-09 深圳配天机器人技术有限公司 一种标定板、内参数标定方法、机器视觉系统及存储装置
CN111699513A (zh) * 2018-07-16 2020-09-22 深圳配天智能技术研究院有限公司 一种标定板、内参数标定方法、机器视觉系统及存储装置
CN110969662A (zh) * 2018-09-28 2020-04-07 杭州海康威视数字技术股份有限公司 鱼眼摄像机内参标定方法、装置、标定装置控制器和系统
CN110969662B (zh) * 2018-09-28 2023-09-26 杭州海康威视数字技术股份有限公司 鱼眼摄像机内参标定方法、装置、标定装置控制器和系统
CN111508027B (zh) * 2019-01-31 2023-10-20 杭州海康威视数字技术股份有限公司 摄像机外参标定的方法和装置
CN111508027A (zh) * 2019-01-31 2020-08-07 杭州海康威视数字技术股份有限公司 摄像机外参标定的方法和装置
CN111798521A (zh) * 2019-04-09 2020-10-20 Oppo广东移动通信有限公司 标定方法、装置、存储介质及电子设备
CN111798521B (zh) * 2019-04-09 2023-10-31 Oppo广东移动通信有限公司 标定方法、装置、存储介质及电子设备
CN110006406A (zh) * 2019-04-26 2019-07-12 昆明理工大学 一种摄影测量后处理辅助尺度恢复及定向的标定装置
CN110111394A (zh) * 2019-05-16 2019-08-09 湖南三一快而居住宅工业有限公司 基于机械手特征对摄像机自动标定的方法及装置
CN113496517A (zh) * 2020-03-20 2021-10-12 华为技术有限公司 超广角畸变标定方法及装置
CN112037284A (zh) * 2020-08-13 2020-12-04 重庆守愚科技有限公司 棋盘格格子中心点检测方法、摄像机畸变标定方法及系统
CN112037284B (zh) * 2020-08-13 2024-02-27 重庆守愚科技有限公司 棋盘格格子中心点检测方法、摄像机畸变标定方法及系统
CN112132891A (zh) * 2020-11-26 2020-12-25 三代光学科技(天津)有限公司 一种扩大标定空间的方法
CN117516485A (zh) * 2024-01-04 2024-02-06 东北大学 一种飞机发动机自动引导安装的位姿视觉测量方法
CN117516485B (zh) * 2024-01-04 2024-03-22 东北大学 一种飞机发动机自动引导安装的位姿视觉测量方法

Also Published As

Publication number Publication date
CN105913439B (zh) 2018-12-11

Similar Documents

Publication Publication Date Title
CN105913439A (zh) 一种基于激光跟踪仪的大视场摄像机标定方法
CN105698699B (zh) 一种基于时间转轴约束的双目视觉测量方法
CN104240262B (zh) 一种用于摄影测量的相机外参数标定装置及标定方法
CN104851104B (zh) 采用柔性靶标高速摄相机近景大视场标定方法
CN103822615B (zh) 一种多控制点自动提取与聚合的无人机地面目标实时定位方法
CN104616292B (zh) 基于全局单应矩阵的单目视觉测量方法
CN104897175B (zh) 多相机光学推扫卫星在轨几何定标方法及系统
CN100429476C (zh) 一种双传感器激光视觉三维测量系统校准方法
Xie et al. Study on construction of 3D building based on UAV images
CN107144241B (zh) 一种基于景深补偿的双目视觉高精度测量方法
CN106097300A (zh) 一种基于高精度运动平台的多相机标定方法
CN107274453A (zh) 一种结合标定与校正的摄像机三维测量装置、系统及方法
CN107464264A (zh) 一种基于gps的相机参数标定方法
CN104034305B (zh) 一种单目视觉实时定位的方法
CN101149836B (zh) 一种三维重构的双摄像机标定方法
CN110375648A (zh) 棋盘格靶标辅助的单台相机实现的空间点三维坐标测量方法
CN109141226A (zh) 单相机多角度的空间点坐标测量方法
CN105931222A (zh) 用低精度二维平面靶标实现高精度相机标定的方法
CN109900205B (zh) 一种高精度的单线激光器和光学相机的快速标定方法
CN104729481B (zh) 一种基于pnp透视模型的合作目标位姿精度测量方法
CN102136140B (zh) 一种基于矩形图样的视频图像距离检测方法
CN106056605A (zh) 一种基于图像匹配的在轨高精度图像定位方法
CN108020175A (zh) 一种多光栅投影双目视觉舌体表面三维整体成像方法
CN101545775B (zh) 利用数字地图计算像片方位元素和建筑物高度的方法
CN112308926B (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