主权项 |
1、一种月球车高速三维激光成像雷达系统,该系统包括:点结构光激光测距仪,扫描双驱动无刷伺服电机系统及一个激光反射棱镜;其特征在于:所述的双驱动无刷伺服电机,为安装位置呈90度的垂直电机和水平电机,电机输出轴所在轴线与激光射线相交于棱镜反射斜面中心;其中,一个垂直电机控制棱镜在与其输出轴垂直的平面上绕轴线方向连续自旋,另一个水平电机则采用步进的方式控制该平面在垂直方向上的一定范围内俯仰转动;所述垂直电机和水平电机的前端,分别设有与其同轴安装的光电码盘和编码器;与激光测距仪配套的高速采集接口,获得的距离与棱镜滚动和俯仰角度的采样数据为同步数据;所述的采样数据,对其进行野值剔除、空间极坐标系到笛卡尔坐标系的坐标变换,最后建立扫描场景的三维点云模型;所述的坐标变换公式为:<maths id="math0001" num="0001" ><math><![CDATA[ <mrow> <mfenced open='(' close=')'> <mtable> <mtr> <mtd> <mi>x</mi> </mtd> </mtr> <mtr> <mtd> <mi>y</mi> </mtd> </mtr> <mtr> <mtd> <mi>z</mi> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mrow> <mo>(</mo> <mi>d</mi> <mo>-</mo> <msub> <mi>d</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mo>·</mo> <mrow> <mo>(</mo> <mi>I</mi> <mo>-</mo> <mn>2</mn> <mo>·</mo> <mi>n</mi> <mo>·</mo> <msup> <mi>n</mi> <mi>T</mi> </msup> <mo>)</mo> </mrow> <mo>·</mo> <mi>p</mi> <mo>+</mo> <mfenced open='(' close=')'> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mi>h</mi> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> </mtr> </mtable> </mfenced> </mrow>]]></math></maths>其中,d为激光测距仪距离读数,d0为激光发射处到棱镜反射斜面中心的距离,I为3×3单位阵,n为棱镜反射面的单位法向量,p为入射光线的单位向量,h为棱镜反射斜面中心到参考平面的距离。 |