发明名称 一种基于摄影测量提高激光跟踪仪转站精度的方法
摘要 一种基于摄影测量提高激光跟踪仪转站精度的方法,其步骤如下:一、安装设备,固定公共点;二、使用激光跟踪仪在两个站点A、B测量目标与公共点;三、使用摄影测量测量公共点的坐标;四、两个点云质心重合,且与坐标系原点重合;五、摄影测量点云绕坐标轴旋转至一组对应向量重合;六、将摄影测量点云绕坐标轴旋转至指定对应向量重合;七、对旋转后摄影测量点云进行逆质心化处理;八、求多组修正后的数据,计算其平均值作为修正值;九、对站位B中的公共点坐标进行修正;十、利用单位四元数法求解转换矩阵;十一、计算测量目标长度、角度等;通过以上步骤,达到了提高激光跟踪仪转站精度的效果,解决了激光跟踪仪测量大尺寸物体时误差大的问题。
申请公布号 CN105823417A 申请公布日期 2016.08.03
申请号 CN201610160703.X 申请日期 2016.03.21
申请人 北京航空航天大学 发明人 孙占磊;景喜双;张承阳;张宇翔;罗敏;赵罡
分类号 G01B11/00(2006.01)I 主分类号 G01B11/00(2006.01)I
代理机构 北京慧泉知识产权代理有限公司 11232 代理人 王顺荣;唐爱华
主权项 一种基于摄影测量提高激光跟踪仪转站精度的方法,其特征在于:其实施步骤如下:步骤一:安装相应的设备,固定公共点;使用激光跟踪仪在站点A测量目标A’与公共点,记录A’和公共点的测量结果;设n个公共点的坐标集合为:P<sub>L1</sub>(a<sub>1</sub>,a<sub>2</sub>,a<sub>3</sub>,……,a<sub>n</sub>);步骤二:使用激光跟踪仪在站点B测量目标B’与公共点;站点B需与站点A有一定距离,记录B’和公共点的测量结果;设该步骤中n个公共点的坐标集合为:P<sub>L2</sub>(a<sub>1</sub>,a<sub>2</sub>,a<sub>3</sub>,……,a<sub>n</sub>);步骤三:使用摄影测量测量公共点的坐标;设坐标集合为P<sub>P</sub>(b<sub>1</sub>,b<sub>2</sub>,b<sub>3</sub>,……,b<sub>n</sub>);步骤四:由于摄影测量系统与激光跟踪仪系统都有各自独立的坐标系,无法直接修正公共点测量值,因此本发明提出一种几何图形修正的方法;几何图形修正方法为:将在两个不同坐标系下的公共点云测量值都视为刚体,通过一些列旋转和平移,使得两个点云的质心完全重合,两个点云中其他点重合;再用精度高的公共点云测量值代替精度低的测量值,即完成修正;对P<sub>L1</sub>和P<sub>P</sub>两个点云进行质心化处理:<maths num="0001"><math><![CDATA[<mrow><mover><msub><mi>P</mi><mrow><mi>L</mi><mn>1</mn></mrow></msub><mo>&OverBar;</mo></mover><mo>=</mo><msub><mi>P</mi><mrow><mi>L</mi><mn>1</mn></mrow></msub><mo>-</mo><msub><mi>&rho;</mi><mi>L</mi></msub></mrow>]]></math><img file="FDA0000945855100000011.GIF" wi="318" he="66" /></maths><maths num="0002"><math><![CDATA[<mrow><mover><msub><mi>P</mi><mi>P</mi></msub><mo>&OverBar;</mo></mover><mo>=</mo><msub><mi>P</mi><mi>P</mi></msub><mo>-</mo><msub><mi>&rho;</mi><mi>P</mi></msub></mrow>]]></math><img file="FDA0000945855100000012.GIF" wi="286" he="63" /></maths><img file="FDA0000945855100000013.GIF" wi="73" he="64" />与<img file="FDA0000945855100000014.GIF" wi="48" he="61" />分别为质心化处理后的激光跟踪仪测量点云坐标和摄影测量点云坐标;其中,<img file="FDA0000945855100000015.GIF" wi="339" he="89" />为激光跟踪仪测量点云坐标质心点;<img file="FDA0000945855100000016.GIF" wi="319" he="90" />为摄影测量点云坐标质心点;此时两个点云质心重合,且与坐标系原点重合,质心记为ρ<sub>LP</sub>;步骤五:在两个质心化后的点云中,选择一对对应点a<sub>i</sub>、b<sub>i</sub>,设质心到两个点的向量分别为<img file="FDA0000945855100000017.GIF" wi="117" he="69" />和<img file="FDA0000945855100000018.GIF" wi="163" he="77" />将摄影测量点云<img file="FDA0000945855100000019.GIF" wi="49" he="62" />绕坐标轴旋转,使得<img file="FDA00009458551000000110.GIF" wi="117" he="69" />和<img file="FDA00009458551000000111.GIF" wi="117" he="81" />两个向量方向重合;点云绕Z轴逆时针旋转α的旋转矩阵为:<maths num="0003"><math><![CDATA[<mrow><msub><mi>R</mi><mi>z</mi></msub><mrow><mo>(</mo><mi>&alpha;</mi><mo>)</mo></mrow><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><mi>cos</mi><mi>&alpha;</mi></mrow></mtd><mtd><mrow><mi>sin</mi><mi>&alpha;</mi></mrow></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mrow><mo>-</mo><mi>sin</mi><mi>&alpha;</mi></mrow></mtd><mtd><mrow><mi>cos</mi><mi>&alpha;</mi></mrow></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0000945855100000021.GIF" wi="620" he="167" /></maths>点云绕Y轴逆时针旋转β的旋转矩阵为:<maths num="0004"><math><![CDATA[<mrow><msub><mi>R</mi><mi>y</mi></msub><mrow><mo>(</mo><mi>&beta;</mi><mo>)</mo></mrow><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><mi>cos</mi><mi>&beta;</mi></mrow></mtd><mtd><mn>0</mn></mtd><mtd><mrow><mo>-</mo><mi>sin</mi><mi>&beta;</mi></mrow></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mrow><mi>sin</mi><mi>&beta;</mi></mrow></mtd><mtd><mn>0</mn></mtd><mtd><mrow><mi>cos</mi><mi>&beta;</mi></mrow></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0000945855100000022.GIF" wi="622" he="177" /></maths>点云<img file="FDA0000945855100000023.GIF" wi="47" he="61" />绕坐标轴旋转,使得<img file="FDA0000945855100000024.GIF" wi="116" he="74" />和<img file="FDA0000945855100000025.GIF" wi="118" he="77" />两个向量方向重合的旋转矩阵表示为:<maths num="0005"><math><![CDATA[<mrow><msubsup><mi>P</mi><mi>p</mi><mo>&prime;</mo></msubsup><mo>=</mo><msubsup><mi>R</mi><mi>z</mi><mrow><mo>-</mo><mn>1</mn></mrow></msubsup><mrow><mo>(</mo><mo>-</mo><msub><mi>&alpha;</mi><mn>2</mn></msub><mo>)</mo></mrow><msubsup><mi>R</mi><mi>y</mi><mrow><mo>-</mo><mn>1</mn></mrow></msubsup><mo>(</mo><mrow><mo>-</mo><msub><mi>&beta;</mi><mn>2</mn></msub></mrow><mo>)</mo><msub><mi>R</mi><mi>y</mi></msub><mrow><mo>(</mo><mo>-</mo><msub><mi>&beta;</mi><mn>1</mn></msub><mo>)</mo></mrow><msub><mi>R</mi><mi>z</mi></msub><mrow><mo>(</mo><mo>-</mo><msub><mi>&alpha;</mi><mn>1</mn></msub><mo>)</mo></mrow><mover><msub><mi>P</mi><mi>p</mi></msub><mo>&OverBar;</mo></mover><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000945855100000026.GIF" wi="1245" he="74" /></maths>P′<sub>P</sub>为旋转后的摄影测量点云坐标,其中,α<sub>1</sub>,α<sub>2</sub>分别为<img file="FDA0000945855100000027.GIF" wi="115" he="83" />和<img file="FDA0000945855100000028.GIF" wi="117" he="67" />在xoy平面内投影与X轴夹角;β<sub>1</sub>,β<sub>2</sub>分别为<img file="FDA0000945855100000029.GIF" wi="116" he="78" />和<img file="FDA00009458551000000210.GIF" wi="116" he="72" />与Z轴夹角;步骤六:在变换后的点云中,选择另一对对应点a<sub>j</sub>、b<sub>j</sub>,设质心到两个点的向量分别为<img file="FDA00009458551000000211.GIF" wi="112" he="73" />和<img file="FDA00009458551000000212.GIF" wi="158" he="87" />记<img file="FDA00009458551000000213.GIF" wi="883" he="83" />将摄影测量点云P′<sub>P</sub>绕坐标轴旋转,使得<img file="FDA00009458551000000214.GIF" wi="51" he="68" />和<img file="FDA00009458551000000215.GIF" wi="55" he="70" />两个向量方向重合;<maths num="0006"><math><![CDATA[<mrow><msubsup><mi>P</mi><mi>p</mi><mrow><mo>&prime;</mo><mo>&prime;</mo></mrow></msubsup><mo>=</mo><msubsup><mi>R</mi><mi>y</mi><mrow><mo>-</mo><mn>1</mn></mrow></msubsup><mrow><mo>(</mo><mo>-</mo><msub><mi>&beta;</mi><mn>2</mn></msub><mo>)</mo></mrow><msubsup><mi>R</mi><mi>z</mi><mrow><mo>-</mo><mn>1</mn></mrow></msubsup><mo>(</mo><mrow><mo>-</mo><msub><mi>&alpha;</mi><mn>2</mn></msub></mrow><mo>)</mo><msub><mi>R</mi><mi>z</mi></msub><mo>(</mo><mi>&theta;</mi><mo>)</mo><msub><mi>R</mi><mi>y</mi></msub><mrow><mo>(</mo><mo>-</mo><msub><mi>&beta;</mi><mn>2</mn></msub><mo>)</mo></mrow><msub><mi>R</mi><mi>z</mi></msub><mrow><mo>(</mo><mo>-</mo><msub><mi>&alpha;</mi><mn>2</mn></msub><mo>)</mo></mrow><msubsup><mi>P</mi><mi>p</mi><mo>&prime;</mo></msubsup><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00009458551000000216.GIF" wi="1244" he="73" /></maths>P″<sub>P</sub>为旋转后的摄影测量点云坐标,其中,θ为<img file="FDA00009458551000000217.GIF" wi="53" he="68" />和<img file="FDA00009458551000000218.GIF" wi="52" he="66" />之间的夹角;将公式(1)与公式(2)化简为:<maths num="0007"><math><![CDATA[<mrow><msubsup><mi>P</mi><mi>p</mi><mrow><mo>&prime;</mo><mo>&prime;</mo></mrow></msubsup><mo>=</mo><msubsup><mi>R</mi><mi>y</mi><mrow><mo>-</mo><mn>1</mn></mrow></msubsup><mrow><mo>(</mo><mo>-</mo><msub><mi>&beta;</mi><mn>2</mn></msub><mo>)</mo></mrow><msubsup><mi>R</mi><mi>z</mi><mrow><mo>-</mo><mn>1</mn></mrow></msubsup><mrow><mo>(</mo><mo>-</mo><msub><mi>&alpha;</mi><mn>2</mn></msub><mo>)</mo></mrow><msub><mi>R</mi><mi>z</mi></msub><mrow><mo>(</mo><mi>&theta;</mi><mo>)</mo></mrow><msub><mi>R</mi><mi>y</mi></msub><mrow><mo>(</mo><mo>-</mo><msub><mi>&beta;</mi><mn>1</mn></msub><mo>)</mo></mrow><msub><mi>R</mi><mi>z</mi></msub><mrow><mo>(</mo><mo>-</mo><msub><mi>&alpha;</mi><mn>1</mn></msub><mo>)</mo></mrow><mover><msub><mi>P</mi><mi>p</mi></msub><mo>&OverBar;</mo></mover></mrow>]]></math><img file="FDA00009458551000000219.GIF" wi="1085" he="75" /></maths>步骤七:此时,两个点云的质心完全重合,且两个点云中其他点重合;用摄影测量点云P″<sub>P</sub>中各点坐标代替激光跟踪仪点云<img file="FDA00009458551000000220.GIF" wi="48" he="67" />中各点坐标,对点云P″<sub>P</sub>进行逆质心化处理,即得到修正后的最终点云坐标P′<sub>L1</sub>;P′<sub>L1</sub>=P″<sub>P</sub>+ρ<sub>L1</sub>;步骤八:为了提高几何图形修正方法的精度,利用两组点云中N组对应点分别进行一次修正计算,求得N组修正后的数据,计算N组数据的平均值作为最后的修正结果;分别选择a<sub>i</sub>、b<sub>i</sub>,i=1,2,……,n;作为对应点,使得每组质心与对应点的向量方向均进行一次重合,减小该方向上的修正误差;重复上述步骤五,得到n组变换后的点云;其中,步骤六中所述的“另一对对应点a<sub>j</sub>、b<sub>j</sub>”的选择有n‑1种方式,如果分别选择所有对应点进行计算,将要进行n(n‑1)次修正计算,计算量大且最后修正结果精度提高不大,因此,为了减小计算量,本发明选择a<sub>i+1</sub>、b<sub>i+1</sub>,i=1,2,……,n;作为对应点进行计算,重复上述步骤六,再重复步骤七,进行逆质心化处理,对得到的n组逆质心化后的点云每个点取平均值;实验证明,N组数据的平均值的精度高于仅进行一组数据修正的精度;步骤九:重复步骤四至步骤八,对站位B中的公共点进行坐标修正:将步骤四至步骤八中的P<sub>L1</sub>替换为P<sub>L2</sub>,按照完全相同的方法进行计算,得到一组点云P′<sub>L2</sub>;步骤十:利用单位四元数法求解两个不同站位激光跟踪仪之间的转换矩阵;<maths num="0008"><math><![CDATA[<mrow><msubsup><mi>P</mi><mrow><mi>L</mi><mn>2</mn></mrow><mo>&prime;</mo></msubsup><mo>=</mo><mi>R</mi><mrow><mo>(</mo><msup><mi>q</mi><mi>R</mi></msup><mo>)</mo></mrow><msubsup><mi>P</mi><mrow><mi>L</mi><mn>1</mn></mrow><mo>&prime;</mo></msubsup><mo>+</mo><msup><mi>q</mi><mi>T</mi></msup></mrow>]]></math><img file="FDA0000945855100000031.GIF" wi="446" he="72" /></maths>其中,R(q<sup>R</sup>)与q<sup>T</sup>为利用单位四元数法求得的旋转矩阵和平移矩阵;<maths num="0009"><math><![CDATA[<mrow><mi>R</mi><mrow><mo>(</mo><msup><mi>q</mi><mi>R</mi></msup><mo>)</mo></mrow><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><msub><mi>R</mi><mn>11</mn></msub></mtd><mtd><msub><mi>R</mi><mn>12</mn></msub></mtd><mtd><msub><mi>R</mi><mn>13</mn></msub></mtd></mtr><mtr><mtd><msub><mi>R</mi><mn>21</mn></msub></mtd><mtd><msub><mi>R</mi><mn>22</mn></msub></mtd><mtd><msub><mi>R</mi><mn>23</mn></msub></mtd></mtr><mtr><mtd><msub><mi>R</mi><mn>31</mn></msub></mtd><mtd><msub><mi>R</mi><mn>32</mn></msub></mtd><mtd><msub><mi>R</mi><mn>33</mn></msub></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0000945855100000032.GIF" wi="570" he="178" /></maths>其中,<maths num="0010"><math><![CDATA[<mfenced open = "" close = ""><mtable><mtr><mtd><mrow><msub><mi>R</mi><mn>11</mn></msub><mo>=</mo><msubsup><mi>q</mi><mn>0</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>q</mi><mn>1</mn><mn>2</mn></msubsup><mo>-</mo><msubsup><mi>q</mi><mn>2</mn><mn>2</mn></msubsup><mo>-</mo><msubsup><mi>q</mi><mn>3</mn><mn>2</mn></msubsup><mo>;</mo><msub><mi>R</mi><mn>12</mn></msub><mo>=</mo><mn>2</mn><mrow><mo>(</mo><mrow><msub><mi>q</mi><mn>1</mn></msub><msub><mi>q</mi><mn>2</mn></msub><mo>-</mo><msub><mi>q</mi><mn>0</mn></msub><msub><mi>q</mi><mn>3</mn></msub></mrow><mo>)</mo></mrow><mo>;</mo><msub><mi>R</mi><mn>13</mn></msub><mo>=</mo><mn>2</mn><mrow><mo>(</mo><mrow><msub><mi>q</mi><mn>1</mn></msub><msub><mi>q</mi><mn>3</mn></msub><mo>+</mo><msub><mi>q</mi><mn>0</mn></msub><msub><mi>q</mi><mn>2</mn></msub></mrow><mo>)</mo></mrow><mo>;</mo><msub><mi>R</mi><mn>21</mn></msub><mo>=</mo></mrow></mtd></mtr><mtr><mtd><mrow><mn>2</mn><mrow><mo>(</mo><mrow><msub><mi>q</mi><mn>1</mn></msub><msub><mi>q</mi><mn>2</mn></msub><mo>+</mo><msub><mi>q</mi><mn>0</mn></msub><msub><mi>q</mi><mn>3</mn></msub></mrow><mo>)</mo></mrow><mo>;</mo><msub><mi>R</mi><mn>22</mn></msub><mo>=</mo><msubsup><mi>q</mi><mn>0</mn><mn>2</mn></msubsup><mo>-</mo><msubsup><mi>q</mi><mn>1</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>q</mi><mn>2</mn><mn>2</mn></msubsup><mo>-</mo><msubsup><mi>q</mi><mn>3</mn><mn>2</mn></msubsup><mo>;</mo><msub><mi>R</mi><mn>23</mn></msub><mo>=</mo><mn>2</mn><mrow><mo>(</mo><mrow><msub><mi>q</mi><mn>2</mn></msub><msub><mi>q</mi><mn>3</mn></msub><mo>-</mo><msub><mi>q</mi><mn>0</mn></msub><msub><mi>q</mi><mn>1</mn></msub></mrow><mo>)</mo></mrow><mo>;</mo><msub><mi>R</mi><mn>31</mn></msub><mo>=</mo><mn>2</mn><mo>(</mo><msub><mi>q</mi><mn>1</mn></msub><msub><mi>q</mi><mn>3</mn></msub><mo>-</mo></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>q</mi><mn>0</mn></msub><msub><mi>q</mi><mn>2</mn></msub><mo>)</mo><mo>;</mo><msub><mi>R</mi><mn>32</mn></msub><mo>=</mo><mn>2</mn><mo>(</mo><mrow><msub><mi>q</mi><mn>2</mn></msub><msub><mi>q</mi><mn>3</mn></msub><mo>+</mo><msub><mi>q</mi><mn>0</mn></msub><msub><mi>q</mi><mn>1</mn></msub></mrow><mo>)</mo><mo>;</mo><msub><mi>R</mi><mn>33</mn></msub><mo>=</mo><msubsup><mi>q</mi><mn>0</mn><mn>2</mn></msubsup><mo>-</mo><msubsup><mi>q</mi><mn>1</mn><mn>2</mn></msubsup><mo>-</mo><msubsup><mi>q</mi><mn>2</mn><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>q</mi><mn>3</mn><mn>2</mn></msubsup></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000945855100000033.GIF" wi="1747" he="185" /></maths>q<sub>0</sub>、q<sub>1</sub>、q<sub>2</sub>、q<sub>3</sub>为单位四元数;步骤十一:至此,A,B两站位上坐标转换到同一坐标系,根据一般长度、角度公式进行计算;通过以上步骤,达到了提高激光跟踪仪转站精度的效果,解决了激光跟踪仪测量大尺寸物体时误差大的问题。
地址 100191 北京市海淀区学院路37号