推荐-数学建模优秀数码相机定位的数学模型 精品 精品

数码相机定位的数学模型摘要随着数码相机定位在各领域的广泛应用，对相关问题《机器视觉》的研究也成为热点。

因此建立一个精度较高，稳定性好的数码相机定位的数学模型，具有很好的现实意义。

问题1要求给出确定靶标上圆的圆心在给定相机像平面的像坐标的算法，问题2利用问题1的模型对给定数据求解。

为此，首先建立了四个空间直角坐标系，在MATLAB中把图3的数字信息提取出来，主要是五个椭圆的边缘点的信息；同时为了便于运算，通过坐标变换将计算机图像坐标变换为图像坐标；并用提取的图像边界坐标拟合出5个椭圆的方程，利用“曲线切线的投影仍与曲线的投影相切，而且切点的投影仍为投影的切点”这一引理，提取出靶标上圆及其像上的公切点的坐标作为特征点，利用RAC两步法标定过程和最小二乘法建立了计算世界坐标系到相机坐标系的旋转变换矩阵R和平移向量T及径向畸变系数k的算法。

利用16个公切点作为特征点，通过Matalb编程求得靶标上圆的圆心在文中给定相机像平面的五个坐标(单位：mm)：A(-49.7132, 51.1289 417.1958)，B(-23.3475, 49.1539 417.1958)，C(33.8194, 44.8716, 417.1958)，D(18.8173,-31.5798, 417.1958)，E(-59.7830, -31.1754, 417.1958)。

问题3的解决分为两步：一是通过对模型计算出的焦距及畸变系数及上面五个坐标值的分析得出模型的精度较高的结论；二是采用改变特征点数的方法或利用“A,B,C三个标靶的中心的像应在一条直线上”验证模型的稳定性。

问题4采用二目立体视觉模型确定了给出两部固定相机相对位置的数学模型和方法。

本文建立的算法可操作性强，精度较高，稳定性好，对解决类似问题的计算有一定的推广价值。

关键词：拟合椭圆特征点提取 RAC两步法坐标旋转矩阵公切点数码相机定位的数学模型一问题的提出数码相机定位的数学模型来源于20XX 年全国大学生数学建模竞赛的A 题。

一般地在物平面上画若干个圆（称为靶标），它们的圆心就是几何的点了，它们的像一般会变形为椭圆，从靶标上的这些圆的像中把圆心的像精确地找到，标定就可实现。

现设计靶标如下，取1个边长为100mm 的正方形，分别以四个顶点（对应为A 、C 、D 、E ）为圆心，12mm 为半径作圆。

以AC 边上距离A 点30mm 处的B 为圆心，12mm 为半径作圆，如图1所示，用一位置固定的数码相机摄得其像，如图2所示。

(1) 建立数学模型和算法以确定靶标上圆的圆心在该相机像平面的像坐标, 这里坐标系原点取在该相机的光学中心，x-y 平面平行于像平面；(2) 对由图2、图3分别给出的靶标及其像，计算靶标上圆的圆心在像平面上的像坐标, 该相机的像距（即光学中心到像平面的距离）是1577个像素单位(1毫米约为3.78个像素单位)，相机分辨率为1024×768；(3) 设计一种方法检验你们的模型，并对方法的精度和稳定性进行讨论； (4) 建立用此靶标给出两部固定相机相对位置的数学模型和方法。

图1 靶标示意图 图2 靶标的像二 模型的假设及符号说明1．模型的假设(1) 假设题目中给出的图3的尺寸是实际物理尺寸；(2) 图像坐标系的坐标原点是图3的中心，称为主心坐标； (3) 相机不需做任何的运动；(4) 标定物为共面点，将靶标所在的面作为世界坐标系的坐标平面； (5) 相机的有效焦距不变。

2. 符号说明(1) R ：表示世界坐标系到相机坐标系旋转变换矩阵，⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡=333231232221131211r r r r r r r r r R ； (2) T ：表示世界坐标系到相机坐标系的平移向量，⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡=z y x t t t T ； (3) f ：表示相机的有效焦距，mm f 78.3/1577=；(4) ),,(w w w Z Y X ：表示世界坐标系下物点P 的坐标；(5) ),(d d Y X ：表示图像坐标系下物点P 有径向畸变的实际像坐标； (6) ),(u u Y X ：表示图像坐标系下物点P 的针孔成像的理想坐标； (7) ),,(z y x ：表示相机坐标系下物点P 的坐标；(8) ),(00y x ：主点坐标，即图像坐标系下坐标原点的像素坐标； (9) ),(v u ：表示计算机坐标系下P 的像的像素坐标。

(10) k ：表示径向畸变系数。

(11) dX 、dY ：每个像素在X 轴与Y 轴方向上的物理尺寸。

三 问题的分析为了确定靶标上圆的圆心在文中给定相机像平面的像坐标，要把图3中的数据信息提取出来。

由于图3中的数据信息是以像素为单位的，为了与图2的毫米单位一致，同时便于运算，通过坐标变换，将计算机图像坐标变换为图像坐标，并用图像边界坐标的信息拟合出5个椭圆的方程，从而可以求出椭圆的几何中心。

1．坐标系的建立计算过程中需要建立如下的四个坐标系，如图4所示。

(1) 相机坐标系xyz O -：原点O 定义在相机的光学中心，z 轴与光轴重合； (2) 图像坐标系XY O -1：原点1O （主点）定义为相机光轴与图像平面的交点，X 轴和Y 轴与x ，y 轴平行，1OO 为相机的有效焦距mm f 78.3/1577=；(3) 计算机图像坐标系uv O -2：原点2O 位于CCD 图像平面的左上角，u 轴和v 轴分别与X 轴和Y 轴平行。

u 、v 分别表示该像素在数组中的列数和行数，且以像素为单位。

在计算机图像坐标系uv O -2中，主点坐标记为1O ),(00v u ，假设主点坐标是图像坐标的中点，本文中可表示为3842/768,5122/102400====v u 。

(4) 世界坐标系w w w w Z Y X O -：原点w O 位于靶标所在正方形的中心，w X 和w Y 轴分别平行AC 、DC （轴的正向为向量的正方向），因此物点P 的坐标可表示为)0,,(w w Y X 。

设),(u u Y X P 为物点P 在小孔成像的理想图像坐标中的像点坐标，),(d d Y X P 是由透镜径向畸变引起的物点P 实际图像点，考虑畸变的径向摄像机模型图，如图4所示]2[。

一般情况下，CCD 镜头畸变主要为一阶径向畸变，在这里我们只考虑一阶径向畸变。

用一个二阶多项式近似：)](1[22u u u d Y X k X X ++= )](1[22u u u d Y X k Y Y ++= 式中k 为畸变系数，u d x X X -=σ，u d y Y Y -=σ为畸变坐标。

2．提取图像数据(1) 提取图3并以.bmp 格式保存。

(2) 在MATLAB 中用imread 命令读入该图片并转换成RGB 图像矩阵。

(3) 使用rgb2gray 和im2bw 命令将上述图像矩阵转化成二值图像矩阵。

(4) 使用bwlabel 命令对二值图像矩阵进行分块标识（每个椭圆域标记为一块，共5块）。

(5) 对每一块椭圆域用edge 命令提取边缘点，并求出这些边缘点在计算机图像坐标系下的坐标。

3．计算机图像坐标与图像坐标的转换如图4所示，计算机图像坐标系以像素为单位，为便于计算，需将其转换为图像坐标系。

设XY O -1坐标系原点在uv O -坐标系中坐标为),(00v u ，每个像素在X 轴与Y 轴方向上的物理尺寸为dX 、dY ，则图像中任意一个像素在两个坐标系下的坐标有如下关系：WX WY W ZW O)u 图4 考虑畸变的径向摄像机模型图⎪⎩⎪⎨⎧+=+=00v dY y v u dX x u(1)用齐次坐标与矩阵形成，将式(1)表示为⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎣⎡=⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡11001001100y x v dY u dX v u 逆关系可写成⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡--=⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡110000100v u dY v dYdX u dX y x (2) 已知相机分辨率为7681024⨯，若题中给定图3尺寸为实际物理尺寸，则82.3%37/1.99110241≈-=dX ，81.3%37/4.7417681≈-=dY考虑到题中给出78.31≈dZ ，为方便计算，取78.311==dYdX ，即1毫米均表示3.78个像素单位。

设),(00v u 取在靶标像平面的中心位置，根据式(2)，可将像平面五个椭圆边缘点坐标变换到图像坐标系下的坐标。

4．椭圆拟合[1]椭圆拟合是对已提取的图3的五个椭圆边缘点的数据N i y x i i ,...,2,1),,(=，进行曲线拟合。

设椭圆曲线的一般表达式为0),(22=+++++=f ey dx cy bxy ax f其椭圆的中心点),(c c Y X 可由式(3)求得：ac b be cd X c 422--=，)04(4222≠---=ac b ac b bd ae Y c(3) 为了用数据N i y x i i ,...,2,1),,(=作曲线拟合，首先设][f e d c b a a =，]1[22y x y xy x x =，利用线性最小二乘法拟合，用MATLAB 编程得到五个拟合椭圆曲线方程系数如表1所示，椭圆A 的拟合曲线如图5所示。

D 6.2735×10-4 -2.3887×10-5 6.9264×10-4 -0.0311 0.0482 1.0000 E 2.3416×10-4 -5.3764×10-5 2.8754×10-40.02650.01471.0000将椭圆方程标准化，由式(3)得到A 、B 、C 、D 、E 五个靶标的像的几何中心点),(c c Y X 的坐标如表2所示。

A B C D E c X -49.9705 -23.4935 33.8868 18.7601 -60.0926 c Y51.402449.430345.1492-31.5326-31.2101Z=1577/3.78 单位：mm5．用椭圆的公切线提取特征点(1) 引理：曲线切线的投影仍与曲线的投影相切，而且切点的投影仍为投影的切点。

[3](2)两椭圆公切线的计算设像平面上任意两个椭圆（基于图像坐标系）的曲线方程为：065423221=+++++k y k x k y k xy k x k065423221=+++++l y l x l y l xy l x l(4)(5)其公切线方程为：n mx y += (6)将式(6)代入式(4)并整理得： 02=++c bx ax(7) 其中，2321m k m k k a ++=，m k k mn k n k b 54322+++=，6523k n k n k c ++=图5 椭圆A 的拟合曲线根据切线的判别法则：042=-=∆ac b ，得：065423221=+++++s n s m s n s mn s m s (8)其中，632514k k k s -=，5243224k k k k s -=，312234k k k s -=，6254442k k k k s -=，5142542k k k k s -=，612464k k k s -=同理，将式(6)代入式(5)，可得与式(8)形式相同的结果：065423221=+++++q n q m q n q mn q m q (9)其中，632514l l l q -=，5243224l l l l q -=，312234l l l q -=，6254442l l l l q -=， 5142542l l l l q -=，612464l l l q -=求解(8)、(9)联立的方程组，可得出四组),(n m ，即确立了任意两个椭圆的四条公切线。