数码相机定位方法探究曲建跃 吴修振 沈宁 指导教员：司守奎 孙玺菁（海军航空工程学院，烟台，264001）摘要：数码相机定位在交通监管等方面有广泛的应用，例如可以用数码相机摄制物体的相片确定物体表面某些特征点的位置。
双目定位是最常用的定位方法，即对物体上一个特征点，用两部固定于不同位置的相机摄得物体的像，分别获得该点在两部相机像平面上的坐标。
双目定位的关键是系统标定，即精确地确定两部相机的相对位置。
要确定两部相机的相对位置，首先应确定一个相机的像坐标系和靶标坐标系之间的转换关系，确定其内外部参数，即对一个相机进行标定。
在前三问中，本文从空间平面的几何关系入手，先对靶平面坐标进行旋转，平移和投影，然后借助于相机的小孔成像原理，得到了物与像的二维坐标关系模型，再通过抓取特征点对的坐标，用最小二乘法拟合，求得物与像二维坐标关系：⎥⎦⎤⎢⎣⎡−−+⎥⎦⎤⎢⎣⎡⎥⎦⎤⎢⎣⎡−=⎥⎦⎤⎢⎣⎡7349.296064.5907971.00231.00907.07709.0i i i i Y X y x ，进而求得靶标上五个圆的圆心的像的物理坐标为)9751.495346.50(，−,)2821.494094.27(，−，)6651.475536.26(，，)0449.324853.17(−−，，)7349.296064.59(−−， ，其对应的像素坐标为)9724.3200944.195(，，)3925.4087137.197(，，)3726.6128259.203(，，)0880.5781279.505(，（此处采用矩阵坐标表示，原点选取图像左上角的顶点）。
然后通过具体点坐标对所建立的模型进行了检验，用模型求得的像坐标与实际像坐标的距离的均值作为精确度，其距离的均方差作为稳定性，得到模型的精确度为6659.1=∇，稳定性5804.0=P 。
第四问中，通过求得的相机的内外部参数，得到像坐标系与靶标坐标系之间的转换关系，然后通过求解方程组，得到两个相机坐标系间的坐标转换矩阵H ，从而完成了系统标定。
本文特色是使用的方法简单，快捷，可操作性强，并且具有很高的精度和稳定性。
关键字：双目相机标定，几何坐标变换，小孔成像，坐标抓捕，最小二乘拟合1 问题的提出现代生活越来越多地用到通过相机来确定某一物体的具体方位和位置，比如交通监管，道路交通事故现场的准确测量，以及机器人的目标定位等。
对物体上一个特征点，用两部固定于不同位置的相机摄得物体的像，分别获得该点在两部相机像平面上的坐标。
只要知道两部相机精确的相对位置，就可用几何的方法得到该特征点在固定一部相机的坐标系中的坐标，即确定了特征点的位置。
利用相机测量的精度取决与相机标定的精度，因此，建立一种理想的相机标定模型和方法显得尤为重要。
本题中即要求给出这样一个模型，并且利用给出的模型求出靶点在像平面内的点以及其精度。
2 问题的分析相机标定方法可分为三类：传统标定方法、主动视觉标定方法、相机自标定方法。
从问题给出的条件来看，比较适合用传统的标定方法。
为此，本文先通过深入分析相机的成像原理，建立了像坐标系和靶坐标系之间的转换模型，并通过最小二乘拟合的方法具体求得了转换关系，从而完成了对一个相机的标定，然后通过求解方程组得到两个相机之间的位置关系转换模型。
解题过程如图1：图13 模型的假设（1）相机中凸透镜的直径与物距相比可忽略不计，可用小孔成像原理近似代替；（2）相机中凸透镜的厚度忽略不计；（3）相机拍照时，忽略空气对光线的影响；（4）靶标在两个相机分别拍照时不发生移动；（5）拍照时，两个相机固定不动；4 符号说明M： 靶标平面wM： 像平面cl: 像距d: 物距；f ： 凸透镜的焦距；y x −： 凸透镜光学中心处与主光轴垂直的平面；ω： 靶标平面与主光轴交点处且与主光轴垂直的面； ''y x −： 像平面上的坐标系； Y X −： 靶标面上的坐标系；y xˆˆ−： ω平面上的坐标系； v u −: 靶标面上原点位于靶标平面与主光轴交点处的辅助坐标系； v uˆˆ−： ω面上原点位于靶标平面与主光轴交点处的辅助坐标系； ),(00y x ：()i i Y X ,坐标系的原点在v u −坐标系中的坐标；L : 靶标平面与的ω面的交线； s : 物的点到w M 面的距离；θ： 靶标平面与ω面的夹角；β： v uˆˆ−坐标系与v u −坐标系夹角； γ： Y X −坐标系与y xˆˆ−坐标系的夹角； []T R ：相机的外部参数；H ： 两个相机坐标系间的坐标转换矩阵；∇： 模型的精确度； P ： 模型的稳定性；5 模型的建立与求解5.1 问题（1）的建立的求解对问题（1），本文通过对相机成像原理的分析建立了单个相机的标定模型，具体建模过程如下。
5.1.1本文建立的模型图为：图2γyˆ)vˆu)i 图35.1.2 对模型图的分析和求解过程求解过程中，本文从空间平面的几何关系入手，运用了四次点的平面坐标变换，一次平移，两次旋转，一次投影，在二维平面上建立起了靶标平面与像平面在空间上在的转换关系。
靶标平面与v u ˆˆ−坐标系的相互关系是多样性的，靶标平面与v u ˆˆ−坐标系呈θ角的同时，它们的交线跟^i x 轴往往是呈一定夹角，设其为β角，现将靶标平面上的()i i Y X ,坐标转化成v uˆˆ−坐标系上的()'',i i y x 坐标]1[，即得： ⎭⎬⎫⎩⎨⎧⎥⎦⎤⎢⎣⎡+⎥⎦⎤⎢⎣⎡⎥⎦⎤⎢⎣⎡−⎥⎦⎤⎢⎣⎡⎥⎦⎤⎢⎣⎡−=⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡00^^cos sin sin cos cos 001cos sin sin cos y x Y X y x i i i i γγγγθββββ 再利用凸透镜的小孔成像原理，近似得到点()i i Y X ,与其在像平面上所对应的点的坐标),(i y x i 的对应关系⎭⎬⎫⎩⎨⎧⎥⎦⎤⎢⎣⎡+⎥⎦⎤⎢⎣⎡⎥⎦⎤⎢⎣⎡−⎥⎦⎤⎢⎣⎡⎥⎦⎤⎢⎣⎡−⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡−−=⎥⎦⎤⎢⎣⎡00cos sin sin cos cos 001cos sin sin cos 00y x Y X s d l sd ly x i i i i γγγγθββββ 即⎥⎦⎤⎢⎣⎡+−−+⎥⎦⎤⎢⎣⎡⎥⎦⎤⎢⎣⎡+−+−−−−=⎥⎦⎤⎢⎣⎡θββθβββθγγβγθβγβγθββγβθγβγcos cos sin cos sin cos cos cos cos sin sin sin cos cos cos sin cos cos sin cos sin sin cos sin cos cos 0000y x y x s d l Y X s d l y x i i i i 由于θγβ，，和00y x ，以及d l ，都是固定值，又因为通常d 远大于l ，因而s 可近似看做与i X ，i Y 无关，因此可以用新的参数代替原来的参数，使问题进一步简化，分别用f e d c b a ，，，，，代替原来参数，把上式简化，得⎥⎦⎤⎢⎣⎡++++=⎥⎦⎤⎢⎣⎡+⎥⎦⎤⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡f dY cX e bY aX f e Y X d c b a y x i i i i i i i i其中)sin cos sin cos (cos βθγβγ−−=s d la )cos cos sin cos sin (γθββγ−−−=s d l b)sin cos cos cos (sin γθβγβ+−=s d l c)cos cos cos sin sin (βθγγβ+−−=sd l d）（θββcos sin cos 00y x s d l e −−=)cos cos sin (00θββy x sd l f +−=令⎥⎦⎤⎢⎣⎡=d c b a R ,⎥⎦⎤⎢⎣⎡=f e t ,则可得相机的外部参数，即[]T R ，以及标定的像坐标系与靶标坐标系之间的转换关系，记为：T RM M w c +=其中c M 代表像坐标系，w M 代表靶坐标系。
把转换关系分解得fdY cX y e bY aX x i i i i i i ++=++=5.2 问题（2）的求解 5.2.1 像坐标求解过程通过Matlab与画图软件结合与能用，实现了对像坐标特征值点的直接抓捕，本文规定像素坐标的原点取在像平面左上角的顶点，经过处理，得到了靶坐标和像坐标的16 组数据，分别为表１),(i i Y X),(i i y x（-12.0000,100.0000） （-60.8466,51.3228） （-12.0000,0）（-70.3704,-32.2751） （12.0000,100.0000） （-39.1534,51.8519） （12.0000,0）（-50.0000,-30.4233） （30.0000,112.0000） （-23.0159,59.7884） (100.0000,112.0000） (34.6561,55.0265) （30.0000,88.0000） (-24.0741,38.8889) （100.0000,88.0000） (32.5397,35.4497) （88.0000,100.0000） (-12.9630,50.2646) （88.0000,0）(-50.0000,-30.4233) （112.0000,100.0000） (43.3862,46.2963) （112.0000,0） (27.7778,-30.1587) （0,12.0000）(-59.2593,-21.9577) （100.0000,12.0000） (20.1058,-23.0159) （0,-12.0000）(-60.8466,-40.4762) （100.0000,-12.0000）(17.1958,-39.9471)5．2.2 最小二乘法拟合参数[]e b a ，[]f d c本文用求得的前十二组数据进行最小二乘法拟合，后四组数据进行精度和稳定性分析。
通过Matlab编程，求得回归系数为[]e b a=[]]6064.590907.07709.0−，[]f d c =[]7349.297971.00231.0−−则⎥⎦⎤⎢⎣⎡−−+⎥⎦⎤⎢⎣⎡⎥⎦⎤⎢⎣⎡−=⎥⎦⎤⎢⎣⎡7349.296064.5907971.00231.00907.07709.0i i i i Y X y x从靶图中读出五个圆心坐标为)1000(，,)10030(， ,)100100(， ,)0100(， ,)00(， ，代入上式可得五个圆心对应的像坐标为)9751.495346.50(，−,)2821.494094.27(，−，)6651.475536.26(，，)0449.324853.17(−−，，)7349.296064.59(−−， ，对应的像素坐标为)9724.3200944.195(，，)3925.4087137.197(，，)3726.6128259.203(，，)0880.5781279.505(，。
