发明名称 一种基于向量法和三点共线的相机标定方法
摘要 本发明提供了一种基于向量法和三点共线的相机标定方法,利用向量法标定光轴向量,取代标定旋转矩阵,通过解析几何理论解算空间点三维坐标实现结构光视觉测量,进而实现相机的标定。本发明速度快,精度高,尤其适用于一些工作环境恶劣的场合的相机标定。
申请公布号 CN104036518B 申请公布日期 2017.02.01
申请号 CN201410313310.9 申请日期 2014.07.02
申请人 北京理工大学;东华大学;上海电气集团股份有限公司 发明人 朱炜;李建丽;田丽;辛倩倩;杨延竹;陈能洁;盛佳伟;齐亮;汤雪华;马贺贺;张茂松
分类号 G06T7/00(2006.01)I 主分类号 G06T7/00(2006.01)I
代理机构 代理人
主权项 一种基于向量法和三点共线的相机标定方法,包括:1)建立世界坐标系;2)测量所述相机的光心O在世界坐标系中的坐标O=(X Y Z);3)制作标定物,在所述相机前定位一根标杆,在所述标杆上定位共线三点P<sub>1</sub>、P<sub>2</sub>、P<sub>3</sub>;4)拍摄所述共线三点的图像,检测所述共线三点P<sub>1</sub>、P<sub>2</sub>、P<sub>3</sub>的像素坐标p<sub>1</sub>、p<sub>2</sub>、p<sub>3</sub>;5)利用所述共线三点标定图像主点横向坐标U<sub>0</sub>和相机光轴向量<img file="FDA0001110433270000011.GIF" wi="78" he="78" />其中,在步骤5)中,所述的标定包括以下步骤:5.1)计算焦距f和图像主点横向坐标U<sub>0</sub>;5.2)计算相机光轴向量<img file="FDA0001110433270000012.GIF" wi="75" he="78" />其特征在于,所述步骤5.1)进一步包括:根据相机透视投影原理得<img file="FDA0001110433270000013.GIF" wi="1734" he="367" /><maths num="0001"><math><![CDATA[<mrow><mi>tan</mi><mi>&alpha;</mi><mo>=</mo><mfrac><mrow><mo>(</mo><msub><mi>U</mi><mn>3</mn></msub><mo>-</mo><msub><mi>U</mi><mn>2</mn></msub><mo>)</mo><mo>*</mo><msub><mi>sin&theta;</mi><mn>1</mn></msub><mo>*</mo><mi>sin</mi><mo>(</mo><msub><mi>&theta;</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&theta;</mi><mn>2</mn></msub><mo>)</mo></mrow><mrow><mo>(</mo><msub><mi>U</mi><mn>2</mn></msub><mo>-</mo><msub><mi>U</mi><mn>1</mn></msub><mo>)</mo><mo>*</mo><msub><mi>sin&theta;</mi><mn>2</mn></msub><mo>-</mo><mo>(</mo><msub><mi>U</mi><mn>3</mn></msub><mo>-</mo><msub><mi>U</mi><mn>2</mn></msub><mo>)</mo><mo>*</mo><msub><mi>sin&theta;</mi><mn>1</mn></msub><mo>*</mo><mi>cos</mi><mo>(</mo><msub><mi>&theta;</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&theta;</mi><mn>2</mn></msub><mo>)</mo></mrow></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001110433270000014.GIF" wi="1710" he="151" /></maths>其中θ<sub>1</sub>,θ<sub>2</sub>分别为光心O与投影点p<sub>1</sub>、p<sub>2</sub>、p<sub>3</sub>之间形成的夹角∠p<sub>1</sub>Op<sub>2</sub>、∠p<sub>2</sub>Op<sub>3</sub>,U<sub>1</sub>、U<sub>2</sub>、U<sub>3</sub>为投影点p<sub>1</sub>、p<sub>2</sub>、p<sub>3</sub>的像素坐标,令U<sub>1</sub><U<sub>2</sub><U<sub>3</sub>;由式(1)和(2)得:<maths num="0002"><math><![CDATA[<mrow><msub><mi>U</mi><mn>0</mn></msub><mo>=</mo><msub><mi>U</mi><mn>1</mn></msub><mo>+</mo><mfrac><mrow><mi>tan</mi><mi>&alpha;</mi><mo>+</mo><mi>tan</mi><mrow><mo>(</mo><msub><mi>&theta;</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&theta;</mi><mn>2</mn></msub><mo>)</mo></mrow></mrow><mrow><mo>(</mo><msup><mi>tan</mi><mn>2</mn></msup><mi>&alpha;</mi><mo>+</mo><mn>1</mn><mo>)</mo><mo>*</mo><mi>tan</mi><mo>(</mo><msub><mi>&theta;</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&theta;</mi><mn>2</mn></msub><mo>)</mo></mrow></mfrac><mrow><mo>(</mo><msub><mi>U</mi><mn>3</mn></msub><mo>-</mo><msub><mi>U</mi><mn>1</mn></msub><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001110433270000021.GIF" wi="1526" he="150" /></maths><maths num="0003"><math><![CDATA[<mrow><mi>f</mi><mo>=</mo><mfrac><mrow><mi>tan</mi><mi>&alpha;</mi><mo>+</mo><mi>tan</mi><mrow><mo>(</mo><msub><mi>&theta;</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&theta;</mi><mn>2</mn></msub><mo>)</mo></mrow></mrow><mrow><mo>(</mo><msup><mi>tan</mi><mn>2</mn></msup><mi>&alpha;</mi><mo>+</mo><mn>1</mn><mo>)</mo><mo>*</mo><mi>tan</mi><mo>(</mo><msub><mi>&theta;</mi><mn>1</mn></msub><mo>+</mo><msub><mi>&theta;</mi><mn>2</mn></msub><mo>)</mo></mrow></mfrac><mo>*</mo><mi>tan</mi><mi>&alpha;</mi><mo>*</mo><mrow><mo>(</mo><msub><mi>U</mi><mn>3</mn></msub><mo>-</mo><msub><mi>U</mi><mn>1</mn></msub><mo>)</mo></mrow><mo>*</mo><mi>d</mi><mi>x</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001110433270000022.GIF" wi="1534" he="150" /></maths>其中,ɑ为光心O与投影点之间形成的夹角∠Op<sub>1</sub>p<sub>2</sub>。
地址 100081 北京市海淀区中关村南大街5号北京理工大学