发明名称 一种旋转立体视觉的三维重建方法
摘要 一种旋转立体视觉的三维重建方法,包括以下步骤:1)对摄像机进行手工标定,获取旋转平台未旋转时的摄像机投影矩阵;2)对旋转平台未旋转之前的摄像机投影矩阵进行分解,获取摄像机内参数矩阵及未旋转时的外参数矩阵;3)通过旋转角度及旋转前的摄像机内参数矩阵,获取旋转了任意角度的摄像机投影矩阵;4)通过两个角度或多个角度所拍摄物体的图片信息及此时的摄像机投影矩阵获取物体的空间三维信息。本发明提供一种能够大大降低标定次数、提高计算效率、降低成本的旋转立体视觉的三维重建方法。
申请公布号 CN101320483A 申请公布日期 2008.12.10
申请号 CN200810063692.9 申请日期 2008.06.25
申请人 浙江工业大学 发明人 陈胜勇;管秋;漆喜庆;刘盛;毛国红;李兰兰;骆广娟
分类号 G06T17/00(2006.01);G06T7/00(2006.01) 主分类号 G06T17/00(2006.01)
代理机构 杭州天正专利事务所有限公司 代理人 王兵;王利强
主权项 1、一种旋转立体视觉的三维重建方法,其特征在于:所述三维重建方法包括以下步骤:1)、摄像机手工标定:设定世界坐标系的一根轴与旋转轴重合,一坐标平面平行于标定板平面,标定板平面平行于旋转轴;设定与旋转轴重合的轴为Y轴,与标定板平面平行的坐标平面为XOY平面,获取标定板上圆心点的世界坐标,在Z方向上移动标定板,获取空间中不在同一平面的多个点的世界坐标,设定空间点的世界坐标(Xw,Yw,ZW),提取得到标定板上圆心的图像象素坐标值(μ,v),点的世界坐标和图像坐标存在如下关系:<math><mrow><msub><mi>Z</mi><mi>c</mi></msub><mfenced open='[' close=']'><mtable><mtr><mtd><mi>u</mi></mtd></mtr><mtr><mtd><mi>v</mi></mtd></mtr><mtr><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mo>=</mo><mi>M</mi><mo>&CenterDot;</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>X</mi><mi>w</mi></msub></mtd></mtr><mtr><mtd><msub><mi>Y</mi><mi>w</mi></msub></mtd></mtr><mtr><mtd><msub><mi>Z</mi><mi>w</mi></msub></mtd></mtr><mtr><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>m</mi><mn>11</mn></msub></mtd><mtd><msub><mi>m</mi><mn>12</mn></msub></mtd><mtd><msub><mi>m</mi><mn>13</mn></msub></mtd><mtd><msub><mi>m</mi><mn>14</mn></msub></mtd></mtr><mtr><mtd><msub><mi>m</mi><mn>21</mn></msub></mtd><mtd><msub><mi>m</mi><mn>22</mn></msub></mtd><mtd><msub><mi>m</mi><mn>23</mn></msub></mtd><mtd><msub><mi>m</mi><mn>24</mn></msub></mtd></mtr><mtr><mtd><msub><mi>m</mi><mn>31</mn></msub></mtd><mtd><msub><mi>m</mi><mn>32</mn></msub></mtd><mtd><msub><mi>m</mi><mn>33</mn></msub></mtd><mtd><msub><mi>m</mi><mn>34</mn></msub></mtd></mtr></mtable></mfenced><mo>&CenterDot;</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>X</mi><mi>w</mi></msub></mtd></mtr><mtr><mtd><msub><mi>Y</mi><mi>w</mi></msub></mtd></mtr><mtr><mtd><msub><mi>Z</mi><mi>w</mi></msub></mtd></mtr><mtr><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>式(1)中,M是摄像机投影矩阵,为3×4矩阵;Zc为点在摄像机坐标系下Z方向上的坐标分量;由上式得以下两个方程:<math><mrow><mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>X</mi><mi>w</mi></msub><msub><mi>m</mi><mn>11</mn></msub><mo>+</mo><msub><mi>Y</mi><mi>w</mi></msub><msub><mi>m</mi><mn>12</mn></msub><mo>+</mo><msub><mi>Z</mi><mi>w</mi></msub><msub><mi>m</mi><mn>13</mn></msub><mo>+</mo><msub><mi>m</mi><mn>14</mn></msub><mo>-</mo><mi>u</mi><msub><mi>X</mi><mi>w</mi></msub><msub><mi>m</mi><mn>31</mn></msub><mo>-</mo><mi>u</mi><msub><mi>Y</mi><mi>w</mi></msub><msub><mi>m</mi><mn>32</mn></msub><mo>-</mo><mi>u</mi><msub><mi>Z</mi><mi>w</mi></msub><msub><mi>m</mi><mn>33</mn></msub><mo>=</mo><msub><mi>um</mi><mn>34</mn></msub></mtd></mtr><mtr><mtd><msub><mi>X</mi><mi>w</mi></msub><msub><mi>m</mi><mn>21</mn></msub><mo>+</mo><msub><mi>Y</mi><mi>w</mi></msub><msub><mi>m</mi><mn>22</mn></msub><mo>+</mo><msub><mi>Z</mi><mi>w</mi></msub><msub><mi>m</mi><mn>23</mn></msub><mo>+</mo><msub><mi>m</mi><mn>24</mn></msub><mo>-</mo><mi>v</mi><msub><mi>X</mi><mi>w</mi></msub><msub><mi>m</mi><mn>31</mn></msub><mo>-</mo><mi>v</mi><msub><mi>Y</mi><mi>w</mi></msub><msub><mi>m</mi><mn>32</mn></msub><mo>-</mo><mi>v</mi><msub><mi>Z</mi><mi>w</mi></msub><msub><mi>m</mi><mn>33</mn></msub><mo>=</mo><msub><mi>vm</mi><mn>34</mn></msub></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>投影矩阵M有11个自由度,通过六个不在同一平面的空间点计算投影矩阵M;2)、旋转平台旋转之前的摄像机投影矩阵记为M1,通过M1所反映的点的世界坐标与图像坐标的关系用以下公式表示:<math><mrow><msub><mi>Z</mi><mrow><mi>c</mi><mn>1</mn></mrow></msub><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>u</mi><mn>1</mn></msub></mtd></mtr><mtr><mtd><msub><mi>v</mi><mn>1</mn></msub></mtd></mtr><mtr><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mo>=</mo><msup><mi>M</mi><mn>1</mn></msup><mo>&CenterDot;</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>X</mi><mi>w</mi></msub></mtd></mtr><mtr><mtd><msub><mi>Y</mi><mi>w</mi></msub></mtd></mtr><mtr><mtd><msub><mi>Z</mi><mi>w</mi></msub></mtd></mtr><mtr><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msubsup><mi>m</mi><mn>11</mn><mn>1</mn></msubsup></mtd><mtd><msubsup><mi>m</mi><mn>12</mn><mn>1</mn></msubsup></mtd><mtd><msubsup><mi>m</mi><mn>13</mn><mn>1</mn></msubsup></mtd><mtd><msubsup><mi>m</mi><mn>14</mn><mn>1</mn></msubsup></mtd></mtr><mtr><mtd><msubsup><mi>m</mi><mn>21</mn><mn>1</mn></msubsup></mtd><mtd><msubsup><mi>m</mi><mn>22</mn><mn>1</mn></msubsup></mtd><mtd><msubsup><mi>m</mi><mn>23</mn><mn>1</mn></msubsup></mtd><mtd><msubsup><mi>m</mi><mn>24</mn><mn>1</mn></msubsup></mtd></mtr><mtr><mtd><msubsup><mi>m</mi><mn>31</mn><mn>1</mn></msubsup></mtd><mtd><msubsup><mi>m</mi><mn>32</mn><mn>1</mn></msubsup></mtd><mtd><msubsup><mi>m</mi><mn>33</mn><mn>1</mn></msubsup></mtd><mtd><msubsup><mi>m</mi><mn>34</mn><mn>1</mn></msubsup></mtd></mtr></mtable></mfenced><mo>&CenterDot;</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>X</mi><mi>w</mi></msub></mtd></mtr><mtr><mtd><msub><mi>Y</mi><mi>w</mi></msub></mtd></mtr><mtr><mtd><msub><mi>Z</mi><mi>w</mi></msub></mtd></mtr><mtr><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow>通过对M1采取下述公式进行分解:令:<math><mrow><mover><msub><mi>m</mi><mn>1</mn></msub><mo>&RightArrow;</mo></mover><mo>=</mo><msup><mrow><mo>(</mo><msubsup><mi>m</mi><mn>11</mn><mn>1</mn></msubsup><mo>,</mo><msubsup><mi>m</mi><mn>12</mn><mn>1</mn></msubsup><mo>,</mo><msubsup><mi>m</mi><mn>13</mn><mn>1</mn></msubsup><mo>)</mo></mrow><mi>T</mi></msup><mo>,</mo></mrow><math><mrow><mover><msub><mi>m</mi><mn>2</mn></msub><mo>&RightArrow;</mo></mover><mo>=</mo><msup><mrow><mo>(</mo><msubsup><mi>m</mi><mn>21</mn><mn>1</mn></msubsup><mo>,</mo><msubsup><mi>m</mi><mn>22</mn><mn>1</mn></msubsup><mo>,</mo><msubsup><mi>m</mi><mn>23</mn><mn>1</mn></msubsup><mo>)</mo></mrow><mi>T</mi></msup><mo>,</mo></mrow><math><mrow><mover><msub><mi>m</mi><mn>3</mn></msub><mo>&RightArrow;</mo></mover><mo>=</mo><msup><mrow><mo>(</mo><msubsup><mi>m</mi><mn>31</mn><mn>1</mn></msubsup><mo>,</mo><msubsup><mi>m</mi><mn>32</mn><mn>1</mn></msubsup><mo>,</mo><msubsup><mi>m</mi><mn>33</mn><mn>1</mn></msubsup><mo>)</mo></mrow><mi>T</mi></msup><mo>.</mo></mrow>则,<math><mrow><msub><mover><mi>r</mi><mo>&RightArrow;</mo></mover><mn>3</mn></msub><mo>=</mo><msubsup><mi>m</mi><mn>34</mn><mn>1</mn></msubsup><msub><mover><mi>m</mi><mo>&RightArrow;</mo></mover><mrow><mn>3</mn><mo>,</mo></mrow></msub></mrow><math><mrow><msub><mi>u</mi><mn>0</mn></msub><mo>=</mo><msup><mrow><mo>(</mo><msubsup><mi>m</mi><mn>34</mn><mn>1</mn></msubsup><mo>)</mo></mrow><mn>2</mn></msup><msup><mover><msub><mi>m</mi><mn>1</mn></msub><mo>&RightArrow;</mo></mover><mi>T</mi></msup><mover><msub><mi>m</mi><mn>3</mn></msub><mo>&RightArrow;</mo></mover><mo>,</mo></mrow><math><mrow><msub><mi>v</mi><mn>0</mn></msub><mo>=</mo><msup><mrow><mo>(</mo><msubsup><mi>m</mi><mn>34</mn><mn>1</mn></msubsup><mo>)</mo></mrow><mn>2</mn></msup><msup><mover><msub><mi>m</mi><mn>2</mn></msub><mo>&RightArrow;</mo></mover><mi>T</mi></msup><mover><msub><mi>m</mi><mn>3</mn></msub><mo>&RightArrow;</mo></mover><mo>,</mo></mrow><math><mrow><msub><mi>a</mi><mi>x</mi></msub><mo>=</mo><msup><mrow><mo>(</mo><msubsup><mi>m</mi><mn>34</mn><mn>1</mn></msubsup><mo>)</mo></mrow><mn>2</mn></msup><mo>|</mo><mover><msub><mi>m</mi><mn>1</mn></msub><mo>&RightArrow;</mo></mover><mo>&times;</mo><mover><msub><mi>m</mi><mn>3</mn></msub><mo>&RightArrow;</mo></mover><mo>|</mo><mo>,</mo></mrow><math><mrow><msub><mi>a</mi><mi>y</mi></msub><mo>=</mo><msup><mrow><mo>(</mo><msubsup><mi>m</mi><mn>34</mn><mn>1</mn></msubsup><mo>)</mo></mrow><mn>2</mn></msup><mo>|</mo><mover><msub><mi>m</mi><mn>2</mn></msub><mo>&RightArrow;</mo></mover><mo>&times;</mo><mover><msub><mi>m</mi><mn>3</mn></msub><mo>&RightArrow;</mo></mover><mo>|</mo><mo>,</mo></mrow><math><mrow><mover><msub><mi>r</mi><mn>1</mn></msub><mo>&RightArrow;</mo></mover><mo>=</mo><mfrac><msubsup><mi>m</mi><mn>34</mn><mn>1</mn></msubsup><msub><mi>a</mi><mi>x</mi></msub></mfrac><mrow><mo>(</mo><mover><msub><mi>m</mi><mn>1</mn></msub><mo>&RightArrow;</mo></mover><mo>-</mo><msub><mi>u</mi><mn>0</mn></msub><mover><msub><mi>m</mi><mn>3</mn></msub><mo>&RightArrow;</mo></mover><mo>)</mo></mrow><mo>,</mo></mrow><math><mrow><mover><msub><mi>r</mi><mn>2</mn></msub><mo>&RightArrow;</mo></mover><mo>=</mo><mfrac><msubsup><mi>m</mi><mn>34</mn><mn>1</mn></msubsup><msub><mi>a</mi><mi>y</mi></msub></mfrac><mrow><mo>(</mo><mover><msub><mi>m</mi><mn>2</mn></msub><mo>&RightArrow;</mo></mover><mo>-</mo><msub><mi>v</mi><mn>0</mn></msub><mover><msub><mi>m</mi><mn>3</mn></msub><mo>&RightArrow;</mo></mover><mo>)</mo></mrow><mo>,</mo></mrow><math><mrow><msub><mi>t</mi><mi>z</mi></msub><mo>=</mo><msubsup><mi>m</mi><mn>34</mn><mn>1</mn></msubsup><mo>,</mo></mrow><math><mrow><msub><mi>t</mi><mi>x</mi></msub><mo>=</mo><mfrac><msubsup><mi>m</mi><mn>34</mn><mn>1</mn></msubsup><msub><mi>a</mi><mi>x</mi></msub></mfrac><mrow><mo>(</mo><msubsup><mi>m</mi><mn>14</mn><mn>1</mn></msubsup><mo>-</mo><msub><mi>u</mi><mn>0</mn></msub><mo>)</mo></mrow><mo>,</mo></mrow><math><mrow><msub><mi>t</mi><mi>y</mi></msub><mo>=</mo><mfrac><msubsup><mi>m</mi><mn>34</mn><mn>1</mn></msubsup><msub><mi>a</mi><mi>y</mi></msub></mfrac><mrow><mo>(</mo><msubsup><mi>m</mi><mn>24</mn><mn>1</mn></msubsup><mo>-</mo><msub><mi>u</mi><mn>0</mn></msub><mo>)</mo></mrow><mo>,</mo></mrow><math><mrow><msup><mi>M</mi><mn>1</mn></msup><mo>=</mo><msub><mi>M</mi><mn>1</mn></msub><mo>&CenterDot;</mo><msubsup><mi>M</mi><mn>2</mn><mn>1</mn></msubsup><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>a</mi><mi>x</mi></msub></mtd><mtd><mn>0</mn></mtd><mtd><msub><mi>u</mi><mn>0</mn></msub></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><msub><mi>a</mi><mi>y</mi></msub></mtd><mtd><msub><mi>v</mi><mn>0</mn></msub></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd></mtr></mtable></mfenced><mo>&CenterDot;</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msup><mover><msub><mi>r</mi><mn>1</mn></msub><mo>&RightArrow;</mo></mover><mi>T</mi></msup></mtd><mtd><msub><mi>t</mi><mi>x</mi></msub></mtd></mtr><mtr><mtd><msup><mover><msub><mi>r</mi><mn>2</mn></msub><mo>&RightArrow;</mo></mover><mi>T</mi></msup></mtd><mtd><msub><mi>t</mi><mi>y</mi></msub></mtd></mtr><mtr><mtd><msup><mover><msub><mi>r</mi><mn>3</mn></msub><mo>&RightArrow;</mo></mover><mi>T</mi></msup></mtd><mtd><msub><mi>t</mi><mi>z</mi></msub></mtd></mtr><mtr><mtd><msup><mover><mn>0</mn><mo>&RightArrow;</mo></mover><mi>T</mi></msup></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow><math><mrow><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msubsup><mi>m</mi><mn>11</mn><mn>1</mn></msubsup></mtd><mtd><msubsup><mi>m</mi><mn>12</mn><mn>1</mn></msubsup></mtd><mtd><msubsup><mi>m</mi><mn>13</mn><mn>1</mn></msubsup></mtd><mtd><msubsup><mi>m</mi><mn>14</mn><mn>1</mn></msubsup></mtd></mtr><mtr><mtd><msubsup><mi>m</mi><mn>21</mn><mn>1</mn></msubsup></mtd><mtd><msubsup><mi>m</mi><mn>22</mn><mn>1</mn></msubsup></mtd><mtd><msubsup><mi>m</mi><mn>23</mn><mn>1</mn></msubsup></mtd><mtd><msubsup><mi>m</mi><mn>24</mn><mn>1</mn></msubsup></mtd></mtr><mtr><mtd><msubsup><mi>m</mi><mn>31</mn><mn>1</mn></msubsup></mtd><mtd><msubsup><mi>m</mi><mn>32</mn><mn>1</mn></msubsup></mtd><mtd><msubsup><mi>m</mi><mn>33</mn><mn>1</mn></msubsup></mtd><mtd><msubsup><mi>m</mi><mn>34</mn><mn>1</mn></msubsup></mtd></mtr></mtable></mfenced></mrow>M1为摄像机内参数矩阵,M2 1为未旋转时的摄像机外参数矩阵;3)、旋转平台旋转之前的摄像机投影矩阵为:<math><mrow><msup><mi>M</mi><mn>1</mn></msup><mo>=</mo><msub><mi>M</mi><mn>1</mn></msub><mo>&CenterDot;</mo><msubsup><mi>M</mi><mn>2</mn><mn>1</mn></msubsup><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>a</mi><mi>x</mi></msub></mtd><mtd><mn>0</mn></mtd><mtd><msub><mi>u</mi><mn>0</mn></msub></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><msub><mi>a</mi><mi>y</mi></msub></mtd><mtd><msub><mi>v</mi><mn>0</mn></msub></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd></mtr></mtable></mfenced><mo>&CenterDot;</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msup><mover><msub><mi>r</mi><mn>1</mn></msub><mo>&RightArrow;</mo></mover><mi>T</mi></msup></mtd><mtd><msub><mi>t</mi><mi>x</mi></msub></mtd></mtr><mtr><mtd><msup><mover><msub><mi>r</mi><mn>2</mn></msub><mo>&RightArrow;</mo></mover><mi>T</mi></msup></mtd><mtd><msub><mi>t</mi><mi>y</mi></msub></mtd></mtr><mtr><mtd><msup><mover><msub><mi>r</mi><mn>3</mn></msub><mo>&RightArrow;</mo></mover><mi>T</mi></msup></mtd><mtd><msub><mi>t</mi><mi>z</mi></msub></mtd></mtr><mtr><mtd><msup><mover><mn>0</mn><mo>&RightArrow;</mo></mover><mi>T</mi></msup></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow>旋转平台旋转θ角后,摄像机投影矩阵为<math><mrow><msup><mi>M</mi><mn>2</mn></msup><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>a</mi><mi>x</mi></msub></mtd><mtd><mn>0</mn></mtd><mtd><msub><mi>u</mi><mn>0</mn></msub></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><msub><mi>a</mi><mi>y</mi></msub></mtd><mtd><msub><mi>v</mi><mn>0</mn></msub></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd></mtr></mtable></mfenced><mo>&CenterDot;</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msup><mover><msub><mi>r</mi><mn>1</mn></msub><mo>&RightArrow;</mo></mover><mi>T</mi></msup></mtd><mtd><msub><mi>t</mi><mi>x</mi></msub></mtd></mtr><mtr><mtd><msup><mover><msub><mi>r</mi><mn>2</mn></msub><mo>&RightArrow;</mo></mover><mi>T</mi></msup></mtd><mtd><msub><mi>t</mi><mi>y</mi></msub></mtd></mtr><mtr><mtd><msup><mover><msub><mi>r</mi><mn>3</mn></msub><mo>&RightArrow;</mo></mover><mi>T</mi></msup></mtd><mtd><msub><mi>t</mi><mi>z</mi></msub></mtd></mtr><mtr><mtd><msup><mover><mn>0</mn><mo>&RightArrow;</mo></mover><mi>T</mi></msup></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mo>&CenterDot;</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>cos</mi><mi>&theta;</mi></mtd><mtd><mn>0</mn></mtd><mtd><mo>-</mo><mi>sin</mi><mi>&theta;</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mi>sin</mi><mi>&theta;</mi></mtd><mtd><mn>0</mn></mtd><mtd><mi>cos</mi><mi>&theta;</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>6</mn><mo>)</mo></mrow></mrow><math><mrow><msup><mrow><mo>=</mo><mi>M</mi></mrow><mn>1</mn></msup><mo>&CenterDot;</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>cos</mi><mi>&theta;</mi></mtd><mtd><mn>0</mn></mtd><mtd><mo>-</mo><mi>sin</mi><mi>&theta;</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mi>sin</mi><mi>&theta;</mi></mtd><mtd><mn>0</mn></mtd><mtd><mi>cos</mi><mi>&theta;</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced></mrow>4)、空间中的点在世界坐标系下的坐标与图像的象素坐标的关系通过下式表示:<math><mrow><msub><mi>Z</mi><mrow><mi>c</mi><mn>2</mn></mrow></msub><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>u</mi><mn>2</mn></msub></mtd></mtr><mtr><mtd><msub><mi>v</mi><mn>2</mn></msub></mtd></mtr><mtr><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mo>=</mo><msup><mi>M</mi><mn>1</mn></msup><mo>&CenterDot;</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>cos</mi><mi>&theta;</mi></mtd><mtd><mn>0</mn></mtd><mtd><mo>-</mo><mi>sin</mi><mi>&theta;</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mi>sin</mi><mi>&theta;</mi></mtd><mtd><mn>0</mn></mtd><mtd><mi>cos</mi><mi>&theta;</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>X</mi><mi>w</mi></msub></mtd></mtr><mtr><mtd><msub><mi>Y</mi><mi>w</mi></msub></mtd></mtr><mtr><mtd><msub><mi>Z</mi><mi>w</mi></msub></mtd></mtr><mtr><mtd><mn>1</mn></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>7</mn><mo>)</mo></mrow></mrow><math><mrow><mo>=</mo><msup><mi>M</mi><mn>2</mn></msup><mo>&CenterDot;</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>X</mi><mi>w</mi></msub></mtd></mtr><mtr><mtd><msub><mi>Y</mi><mi>w</mi></msub></mtd></mtr><mtr><mtd><msub><mi>Z</mi><mi>w</mi></msub></mtd></mtr><mtr><mtd><mn>1</mn></mtd></mtr></mtable></mfenced></mrow>上式(7)中,θ是包括0度的任一角度,当为0度时即为旋转之前;通过赋值不一样的两个θ得到关于Xw,Yw,Zw的四个方程,从而求出点在世界坐标系下的三维空间坐标,进一步求出物体轮廓线上的点的三维坐标,实现整个物体的三维重建。
地址 310014浙江省杭州市下城区朝晖六区