发明名称 双旋转激光平面发射机的内参数标定方法
摘要 本发明提供了一种双旋转激光平面发射机的内参数标定方法,包括步骤:(1)建立发射机模型;(2)安装光电传感器,建立三维标定台坐标系;(3)粗测发射机位置;(4)采集标定点数据;(5)进行标定;(6)推导发射机内参数。其中(6)的具体步骤为:a)计算激光平面方程;b)计算激光平面在水平面上的夹角;c)计算激光平面与旋转轴的夹角。本发明使发射机内参数快速、精确标定,从而实现全方位、大尺寸的精确测量。
申请公布号 CN105547213A 申请公布日期 2016.05.04
申请号 CN201610049835.5 申请日期 2016.01.25
申请人 上海航天设备制造总厂 发明人 方红根;郭立杰
分类号 G01B21/00(2006.01)I 主分类号 G01B21/00(2006.01)I
代理机构 上海汉声知识产权代理有限公司 31236 代理人 郭国中
主权项 一种双旋转激光平面发射机的内参数标定方法,其特征在于,包括如下步骤:(1)在匀速旋转平台上安装两个线性激光器形成发射机,所述线性激光器发出两道具有固定角度的扇形激光平面和LED脉冲信号,所述LED脉冲信号作为所述扇形激光平面旋转的初始时刻;(2)在距所述发射机的预定距离位置设置一个三维标定台,在所述三维标定台上安装一个光电器,所述光电器用于接收所述两个线性激光器的光信号,在所述三维标定台上建立三维坐标系XYZ,所述光电器设置于XZ平面上;(3)设定所述发射机动的坐标初始值,所述坐标初始值格式为<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mfenced open = "(" close = ")"><mtable><mtr><mtd><msqrt><mn>3</mn></msqrt></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><msqrt><mn>3</mn></msqrt></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mi>A</mi></mtd><mtd><mi>B</mi></mtd><mtd><mi>C</mi></mtd></mtr></mtable></mfenced><mo>,</mo></mrow>]]></math><img file="FDA0000914153110000011.GIF" wi="773" he="119" /></maths>其中(A B C)为所述发射机在三维标定台的坐标系中的坐标;(4)在所述光电固定位置上沿Z轴正方向移动光电器,采集光电器移动标定点位置的对应所述线性激光器的光信号;设所述光电器移动标定点为p行q列;(5)求解模型参数N<sub>1</sub>、N<sub>2</sub>、R及T,模型如下:<maths num="0002" id="cmaths0002"><math><![CDATA[<mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><mo>(</mo><msubsup><mi>RR</mi><mn>1</mn><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></msubsup><msub><mi>N</mi><mn>1</mn></msub><mo>)</mo><mo>&CenterDot;</mo><mo>(</mo><msup><mi>P</mi><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></msup><mo>-</mo><mi>T</mi><mo>)</mo><mo>=</mo><mn>0</mn></mrow></mtd></mtr><mtr><mtd><mrow><mo>(</mo><msubsup><mi>RR</mi><mn>2</mn><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></msubsup><msub><mi>N</mi><mn>2</mn></msub><mo>)</mo><mo>&CenterDot;</mo><mo>(</mo><msup><mi>P</mi><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></msup><mo>-</mo><mi>T</mi><mo>)</mo><mo>=</mo><mn>0</mn></mrow></mtd></mtr><mtr><mtd><mrow><mo>(</mo><msubsup><mi>RR</mi><mn>1</mn><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></msubsup><msub><mi>N</mi><mn>1</mn></msub><mo>)</mo><mo>&CenterDot;</mo><mo>(</mo><msup><mi>P</mi><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></msup><mo>-</mo><mi>T</mi><mo>)</mo><mo>=</mo><mn>0</mn></mrow></mtd></mtr><mtr><mtd><mrow><mo>(</mo><msubsup><mi>RR</mi><mn>2</mn><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></msubsup><msub><mi>N</mi><mn>2</mn></msub><mo>)</mo><mo>&CenterDot;</mo><mo>(</mo><msup><mi>P</mi><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></msup><mo>-</mo><mi>T</mi><mo>)</mo><mo>=</mo><mn>0</mn></mrow></mtd></mtr><mtr><mtd><mtable><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd></mtr></mtable></mtd></mtr><mtr><mtd><mrow><mo>(</mo><msubsup><mi>RR</mi><mn>1</mn><mrow><mo>(</mo><mi>n</mi><mo>)</mo></mrow></msubsup><msub><mi>N</mi><mn>1</mn></msub><mo>)</mo><mo>&CenterDot;</mo><mo>(</mo><msup><mi>P</mi><mrow><mo>(</mo><mi>n</mi><mo>)</mo></mrow></msup><mo>-</mo><mi>T</mi><mo>)</mo><mo>=</mo><mn>0</mn></mrow></mtd></mtr><mtr><mtd><mrow><mo>(</mo><msubsup><mi>RR</mi><mn>2</mn><mrow><mo>(</mo><mi>n</mi><mo>)</mo></mrow></msubsup><msub><mi>N</mi><mn>2</mn></msub><mo>)</mo><mo>&CenterDot;</mo><mo>(</mo><msup><mi>P</mi><mrow><mo>(</mo><mi>n</mi><mo>)</mo></mrow></msup><mo>-</mo><mi>T</mi><mo>)</mo><mo>=</mo><mn>0</mn></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000914153110000012.GIF" wi="716" he="759" /></maths>其中:n:标定点编号,n=1,2,3…p*q,R、T:发射机坐标系相对于三维标定台坐标系的旋转矩阵和平移矩阵;N<sub>1</sub>、N<sub>2</sub>:两个激光平面在初始时刻的法向量;<img file="FDA0000914153110000013.GIF" wi="252" he="95" />激光平面从初始位置旋转到光电传感器时的旋转矩阵,分别是特征时间<img file="FDA0000914153110000014.GIF" wi="189" he="94" />的函数;P<sup>(n)</sup>:三维标定台坐标系中标定点的坐标;(6)根据第(5)步的模型参数推导发射机内参数,推导步骤如下:(a)计算两个激光平面LP<sub>1</sub>和LP<sub>2</sub>在发射机坐标系下的平面方程以及与水平面的交线L<sub>1</sub>和L<sub>2</sub>的方程,模型如下:<maths num="0003" id="cmaths0003"><math><![CDATA[<mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msub><mi>LP</mi><mn>1</mn></msub><mo>:</mo><msub><mi>a</mi><mn>1</mn></msub><mi>x</mi><mo>+</mo><msub><mi>b</mi><mn>1</mn></msub><mi>y</mi><mo>+</mo><msub><mi>c</mi><mn>1</mn></msub><mi>z</mi><mo>=</mo><mn>0</mn></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>LP</mi><mn>2</mn></msub><mo>:</mo><msub><mi>a</mi><mn>2</mn></msub><mi>x</mi><mo>+</mo><msub><mi>b</mi><mn>2</mn></msub><mi>y</mi><mo>+</mo><msub><mi>c</mi><mn>2</mn></msub><mi>z</mi><mo>=</mo><mn>0</mn></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000914153110000021.GIF" wi="502" he="155" /></maths>和<maths num="0004" id="cmaths0004"><math><![CDATA[<mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msub><mi>l</mi><mn>1</mn></msub><mo>:</mo><msub><mi>a</mi><mn>1</mn></msub><mi>x</mi><mo>+</mo><msub><mi>b</mi><mn>1</mn></msub><mi>y</mi><mo>=</mo><mn>0</mn></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>l</mi><mn>2</mn></msub><mo>:</mo><msub><mi>a</mi><mn>2</mn></msub><mi>x</mi><mo>+</mo><msub><mi>b</mi><mn>2</mn></msub><mi>y</mi><mo>=</mo><mn>0</mn></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000914153110000022.GIF" wi="358" he="155" /></maths>其中:n<sub>1</sub>=(a<sub>1</sub> b<sub>1</sub> c<sub>1</sub>)<sup>T</sup>是激光平面1在初始时刻的法向量;n<sub>2</sub>=(a<sub>2</sub> b<sub>2</sub> c<sub>2</sub>)<sup>T</sup>是激光平面2在初始时刻的法向量;(b)计算两个激光平面在水平面上的夹角<img file="FDA0000914153110000023.GIF" wi="103" he="70" />模型如下:<img file="FDA0000914153110000024.GIF" wi="470" he="167" />其中:<maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><msub><mi>v</mi><mn>1</mn></msub><mo>=</mo><msup><mfenced open = "(" close = ")"><mtable><mtr><mtd><mn>1</mn></mtd><mtd><mrow><mo>-</mo><mfrac><msub><mi>a</mi><mn>1</mn></msub><msub><mi>b</mi><mn>1</mn></msub></mfrac></mrow></mtd></mtr></mtable></mfenced><mi>T</mi></msup></mrow>]]></math><img file="FDA0000914153110000025.GIF" wi="317" he="167" /></maths>是交线L<sub>1</sub>的方向向量;<maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><msub><mi>v</mi><mn>2</mn></msub><mo>=</mo><msup><mfenced open = "(" close = ")"><mtable><mtr><mtd><mn>1</mn></mtd><mtd><mrow><mo>-</mo><mfrac><msub><mi>a</mi><mn>2</mn></msub><msub><mi>b</mi><mn>2</mn></msub></mfrac></mrow></mtd></mtr></mtable></mfenced><mi>T</mi></msup></mrow>]]></math><img file="FDA0000914153110000026.GIF" wi="325" he="167" /></maths>是交线L<sub>2</sub>的方向向量;(c)计算两个激光平面与旋转轴的夹角<img file="FDA0000914153110000027.GIF" wi="53" he="55" />和<img file="FDA0000914153110000028.GIF" wi="78" he="71" />以<img file="FDA0000914153110000029.GIF" wi="54" he="55" />为例,模型如下:<img file="FDA00009141531100000210.GIF" wi="525" he="167" />其中:n<sub>1</sub>=(a<sub>1</sub> b<sub>1</sub> c<sub>1</sub>)<sup>T</sup>是激光平面1在初始时刻的法向量;<maths num="0007" id="cmaths0007"><math><![CDATA[<mrow><msub><mi>n</mi><mn>3</mn></msub><mo>=</mo><msup><mfenced open = "(" close = ")"><mtable><mtr><mtd><mn>1</mn></mtd><mtd><mfrac><msub><mi>b</mi><mn>1</mn></msub><msub><mi>a</mi><mn>1</mn></msub></mfrac></mtd><mtd><mn>0</mn></mtd></mtr></mtable></mfenced><mi>T</mi></msup></mrow>]]></math><img file="FDA00009141531100000211.GIF" wi="355" he="167" /></maths>是过旋转轴平面的法向量。
地址 200245 上海市闵行区华宁路100号