申请/专利权人：北京航空航天大学

申请日：2017-08-22

公开（公告）日：2020-03-24

公开（公告）号：CN107290734B

主分类号：G01S7/497(20060101)

分类号：G01S7/497(20060101)

优先权：

专利状态码：有效-授权

法律状态：2020.03.24#授权;2017.11.24#实质审查的生效;2017.10.24#公开

摘要：本发明公开一种基于自制地基激光雷达垂直度误差的点云误差校正方法，该方法主要针对自制激光雷达系统45°转镜配合云台转动的扫描方式，通过计算俯仰轴与方位轴垂直度误差对自制系统测角误差的影响，建立自制激光雷达系统点云误差校正模型，采用高精度三维扫描仪对目标的扫描点云坐标作为真实值求解垂直度误差，从而实现自制激光雷达系统垂直度误差对目标点云的误差校正。所述方法主要包括以下三步：1建立由垂直度误差引起的自制激光雷达三维成像系统测角误差模型并化简；2得到自制激光雷达三维成像系统点云误差模型；3求解自制激光雷达三维成像系统点云误差模型中的垂直度误差，并根据模型对自制激光雷达系统目标点云进行校正。

主权项：1.一种基于自制地基激光雷达垂直度误差的点云误差校正方法，其特征在于，该方法针对自制激光雷达三维成像系统中45°转镜配合云台转动的扫描方式，其中所述自制激光雷达三维成像系统包括光学系统、由电机与45°转镜组成的扫描机构、云台；入射光经所述光学系统出射到所述45°转镜中心O点，伴随所述扫描机构垂直旋转、所述云台水平旋转从所述自制激光雷达三维成像系统中出射；所述自制激光雷达三维成像系统的理想坐标系O-XYZ包括理想俯仰轴X轴、初始出射光线方向Y轴和方位轴Z轴；所述自制激光雷达三维成像系统的实际坐标系O-X’YZ’在所述理想坐标系O-XYZ基础上，实际俯仰轴X’轴与X轴之间存在夹角γ，Y轴不变，根据右手坐标法则建立Z’轴；所述垂直度误差定义为所述实际俯仰轴X’轴与所述理想俯仰轴X轴之间的夹角γ；目标上一点P在所述理想坐标系O-XYZ中一维距离L定义为的长度，方位角定义为在XOY平面的投影与X轴的夹角，从X轴正半轴起算，逆时针方向为正，范围为0°至360°，俯仰角定义为90°与和Z轴之间夹角的差，所述一维距离L、所述方位角和所述俯仰角的测量误差分别为测距误差ΔL、方位角误差和俯仰角误差通过理论分析所述垂直度误差γ对所述自制激光雷达三维成像系统测角误差的影响，所述自制激光雷达三维成像系统测角误差包含所述方位角误差所述俯仰角误差建立所述自制激光雷达三维成像系统的测角误差模型；所述目标的点云定义为目标上一点的直角坐标x,y,zT，目标的点云误差定义为所述目标点云的坐标测量值与真实值的偏差Δx,Δy,ΔzT，根据所述目标的点云误差Δx,Δy,ΔzT与所述目标测角误差之间的误差传递原则，所述目标测角误差包含所述方位角误差所述俯仰角误差建立所述自制激光雷达三维成像系统的点云误差模型如下： 得到所述自制激光雷达三维成像系统对所述垂直度误差γ校正后的所述目标点云坐标为：x+Δx,y+Δy,z+ΔzT从而实现对所述自制激光雷达三维成像系统垂直度误差γ的点云误差校正；所述方法主要包括以下七步：1建立所述自制激光雷达三维成像系统理想坐标系O-XYZ，由于实际俯仰轴X’轴与方位轴Z轴之间存在所述垂直度误差，即实际俯仰轴X’轴与理想俯仰轴X轴之间夹角γ，因此实际俯仰轴变为X’轴，Y轴不变，根据右手坐标法则建立Z’轴，为所述自制激光雷达三维成像系统实际坐标系O-X’YZ’；所述目标上任意一点P在所述理想坐标系O-XYZ中的测量值为方位角俯仰角所述目标上任意一点P在所述理想坐标系O-XYZ中的真实值为方位角俯仰角所述和差值为方位角误差所述和差值为俯仰角误差2建立由所述垂直度误差γ引起的所述自制激光雷达三维成像系统测角误差模型；该模型分别描述了所述方位角误差所述俯仰角误差和所述垂直度误差γ以及所述目标的方位角俯仰角之间的数学关系，如下所示： 3基于对所述垂直度误差γ的三角函数值进行近似变换，化简所述自制激光雷达三维成像系统测角误差模型，如下所示： 4根据误差传递原则，建立所述自制激光雷达三维成像系统的点云误差Δx,Δy,ΔzT与所述测距误差ΔL、所述方位角误差所述俯仰角误差之间的映射关系，如下所示： 其中，L为所述目标上任意一点在所述自制激光雷达三维成像系统理想坐标系O-XYZ中的一维距离，ΔL为所述目标上任意一点一维距离L的测量误差；5将所述自制激光雷达三维成像系统测角误差模型转化到直角坐标系下，得到所述自制激光雷达三维成像系统的点云误差模型如下： 6利用所述自制激光雷达三维成像系统对N个所述目标进行扫描，得到所述目标在所述自制激光雷达三维成像系统中的坐标xi,yi,ziT，其中i＝1,2,…,N，作为测量值；利用高精度三维扫描仪对所述目标进行二次扫描，得到所述目标在所述高精度三维扫描仪中的坐标x′i,y′i,z′iT，其中i＝1,2,…,N，将其转化到所述自制激光雷达三维成像系统下，作为真实值；所述测量值与所述真实值之差为所述自制激光雷达三维成像系统的点云误差Δxi,Δyi,ΔziT，其中i＝1,2,…,N；根据球坐标系与直角坐标系之间的映射关系，由所述测量值得到所述目标的一维距离Li、方位角和俯仰角所述目标的测距误差ΔLi在所述一维距离Li处于一定范围内时视为一个已知常数；7求解所述自制激光雷达三维成像系统点云误差模型中的模型参数，即所述垂直度误差γ，对所述自制激光雷达三维成像系统垂直度误差γ的点云误差进行校正；将所述自制激光雷达三维成像系统的点云误差Δxi,Δyi,ΔziT，其中i＝1,2,…,N、所述目标的一维距离Li、方位角俯仰角和测距误差ΔLi代入式4中，得到3*N个非线性方程，通过求解所述非线性方程确定所述自制激光雷达三维成像系统点云误差模型中的所述垂直度误差γ；将所述垂直度误差γ代入式4，在所述自制激光雷达三维成像系统的所述目标点云坐标x,y,zT基础上，得到所述自制激光雷达三维成像系统校正后的所述目标点云坐标x+Δx,y+Δy,z+ΔzT。

全文数据：一种基于自制地基激光雷达垂直度误差的点云误差校正方法技术领域[0001]本发明涉及激光雷达测量技术领域，尤其是一种基于自制地基激光雷达垂直度误差的点云误差校正方法背景技术[0002]激光雷达测量技术是近些年来快速发展的一种新兴主动遥感技术，一般采用非接触式测量技术，在遥感、军事探测、海洋测绘、大气勘探领域有着广泛的应用。激光雷达中的三维扫描测量技术在传统单点测量技术的基础上，通过高速激光扫描的方式，可以快速获取目标物体表面的高分辨率点云数据，该项技术具有数据处理简单、快速性、主动性、抗干扰能力强、测量精度高、范围大等优点。但激光雷达扫描精度很大程度上受到自身仪器精度影响，实际使用中，仪器的精度本身不完全符合其标称精度，或者因使用时的外力碰撞、夕卜界条件变化、长时间使用带来的损耗以及其他未知因素造成仪器性能不稳定，扫描结果可能出现系统性误差。因此，有效消除激光雷达仪器误差，是提高扫描点云精度的关键。[0003]根据现有研究成果，激光雷达主要分为机载激光雷达和地面激光雷达两大类，关于激光雷达三维成像系统的点云误差校正方法也各有不同，第一类基于机载激光雷达系统的标定方法以飞行自标定为主，基本思想是利用激光对已知的目标点或者相对目标点进行扫描，对过程中产生的固定偏移量进行参数估计，包括重叠航带标定技术、最小二乘平差法几何标定技术等。其中，重叠航带标定技术对航带拼接技术有着较高的要求;平差法求解中的假设前提条件一般难以成立，可能造成参数估计精度下降等问题。上述机载激光雷达系统的标定方法和本发明无对比，无借鉴。[0004]第二类基于地面激光雷达系统的标定方法绝大多数是在室内或者基线场完成，一些涉及点位精度的检定实验主要采用公共点转换的方法，大多采用系统配套的标靶进行试验，包括空间长度检测法、自检校法等。空间长度检测法对检测场有着较高要求，需要场地具有很高精度，较依赖扫描目标布设的精度；自检校法一般采用全站仪、经炜仪等仪器对激光雷达系统建立检校模型，模型一般包含坐标系旋转角、平移量以及仪器内部误差等参数，将这些参数作为未知量经过统一求解得出来，该方法可以通过增加参数的方式不断完善误差模型，提高系统误差的校正精度，检校激光雷达系统的范围比较广泛，且对目标物体的布设精度没有十分高的要求。本发明就属于一种系统自检校方法。[0005]根据现有专利局提供的专利查阅，地面激光雷达系统的自检校方法主要分为以下两类:第一类方法采用公共标志点得到待校准系统与高精度扫描仪之间的坐标旋转、平移量，直接以待校准系统测量值与标准测量值之差作为系统空间坐标测量误差。该类方法针对所有空间三维坐标测量系统，得到空间坐标测量相对误差，其缺点是仅在三维点云层面评估和校正误差，未构建系统误差模型，且需要大量样本数据才能实现精确校正;上述专利包括在中国专利200810147441.9中公开的“一种电子经炜仪空间坐标测量系统的校准方法”。第二类方法采用统计学方法对系统测距误差和测角误差的概率密度分布进行分析，得到三维坐标系中的误差修正样本。该类方法针对所有三维坐标测量系统，得到系统误差修正模型，其缺点是系统误差模型参数没有物理意义，并未针对系统本身扫描方式从误差源的角度进行理论分析，因此依赖大样本数据才能实现精确校正;上述专利包括在中国专利201710014687.8中公开的“一种远距离扫描激光雷达测量误差的修正方法”。[0006]本发明与现有系统自检校方法专利的主要区别在于:提出了一种针对系统本身扫描方式从误差源的角度进行理论分析、利用少量目标点实现自制地基激光雷达垂直度误差点云误差校正的方法，适用于所有米用45°转镜配合云台转动扫描方式的三维扫描系统。本发明在激光雷达测量技术领域具有广阔的应用前景。发明内容[0007]本发明公开一种基于自制地基激光雷达垂直度误差的点云误差校正方法，其特征在于，该方法针对自制激光雷达三维成像系统中45°转镜配合云台转动的扫描方式，其中所述自制激光雷达三维成像系统包括光学系统、扫描机构（电机、45°转镜）、云台；入射光经所述光学系统出射到所述45°转镜中心0点），伴随所述扫描机构垂直旋转、所述云台水平旋转从所述自制激光雷达三维成像系统中出射;所述自制激光雷达三维成像系统的理想坐标系O-XYZ包括俯仰轴X轴）、初始出射光线方向（Y轴和方位轴Z轴）；所述自制激光雷达三维成像系统的实际坐标系（0-X’YZ’）在所述理想坐标系O-XYZ基础上，实际俯仰轴X’轴与X轴之间存在夹角γ，Y轴不变，根据右手坐标法则建立Z’轴;所述垂直度误差定义为所述实际俯仰轴X’轴与所述理想俯仰轴X轴之间的夹角γ;目标上一点P在所述理想坐标系O-XYZ中一维距离L定义为的长度，方位角定义为在XOY平面的投影与X轴的夹角，从X轴正半轴起算，逆时针方向为正，范围为0°至360°，俯仰角，定义为90°与和Z轴之间夹角的差，所述一维距离L、所述方位角和所述俯仰角.的测量误差分别为测距误差AL、方位角误差Δ钱和俯仰角误差：通过理论分析所述垂直度误差γ对所述自制激光雷达三维成像系统测角误差方位角误差的影响，建立所述自制激光雷达三维成像系统的测角误差模型;所述目标的点云定义为目标上一点的直角坐标X，y，zT，目标的点云误差定义为所述目标点云的坐标测量值与真实值的偏差τ，根据所述目标的点云误差与所述目标测角误差方位角误差、俯仰角误差.）之间的误差传递原则，建立所述自制激光雷达三维成像系统的点云误差模型如下：[0008][0009]得到所述自制激光雷达三维成像系统对所述垂直度误差γ校正后的所述目标点云坐标为：[0010][0011]从而实现对所述自制激光雷达三维成像系统垂直度误差γ的点云误差校正；[0012]所述方法主要包括以下七步：[0013]1建立所述自制激光雷达三维成像系统理想坐标系O-XYZ，由于实际俯仰轴X’轴与方位轴Ζ轴之间存在所述垂直度误差，即实际俯仰轴X’轴）与理想俯仰轴X轴之间夹角γ，因此实际俯仰轴变为X’轴，Y轴不变，根据右手坐标法则建立ζ’轴，为所述自制激光雷达三维成像系统实际坐标系ο-χ’ΥΖ’）；所述目标上任意一点P在所述理想坐标系（0-XYZ中的测量值为方位角，俯仰角；所述目标上任意一点P在所述理想坐标系O-XYZ中的真实值为方位角，俯仰角；所述和差值为方位角误差所述和差值为俯仰角误差[0014]2建立由所述垂直度误差γ引起的所述自制激光雷达三维成像系统测角误差模型;该模型分别描述了所述测角误差方位角误差、俯仰角误差）和所述垂直度误差γ以及所述目标的方位角、俯仰角之间的数学关系，如下所示：[0015][0016]3基于对所述垂直度误差γ的三角函数值进行近似变换，化简所述自制激光雷达三维成像系统测角误差模型，如下所示：[0017][0018]4根据误差传递原则，建立所述自制激光雷达三维成像系统的点云误差（Δχ，Δy，AzT与所述测距误差AL、所述测角误差方位角误差、俯仰角误差）之间的映射关系，如下所示：[0019][0020]其中，L为所述目标上任意一点在所述自制激光雷达三维成像系统理想坐标系0-XYZ中的一维距离，AL为所述目标上任意一点一维距离L的测量误差；[0021]5将所述自制激光雷达三维成像系统测角误差模型转化到直角坐标系下，得到所述自制激光雷达三维成像系统的点云误差模型如下：[0022][0023]6利用所述自制激光雷达三维成像系统对N个所述目标进行扫描，得到所述目标在所述自制激光雷达三维成像系统中的坐标Xl，yi，ZlT，（i=l，2,…，N，作为测量值;利用高精度三维扫描仪对所述目标进行二次扫描，得到所述目标在所述高精度三维扫描仪中的坐标X':，y':，z'^T，（i=1，2，…，N，将其转化到所述自制激光雷达三维成像系统下，作为真实值;所述测量值与所述真实值之差为所述自制激光雷达三维成像系统的点云误差ΔXi,Ayi,Aziτ，（i=1,2，···，N;根据球坐标系与直角坐标系之间的映射关系，由所述测量值得到所述目标的一维距离U、方位角和俯仰角，所述目标的测距误差△L1在所述一维距离L1处于一定范围内时视为一个已知常数；[0024]7求解所述自制激光雷达三维成像系统点云误差模型中的模型参数，即所述垂直度误差γ，对所述自制激光雷达三维成像系统垂直度误差γ的点云误差进行校正;将所述自制激光雷达三维成像系统的点云误差（AXl，Ayi，AZlT，（i=l，2,…，N、所述目标的一维距离L1、方位角.俯仰角和测距误差ΔL1代入所述公式4中，得到3*N个非线性方程，通过求解所述非线性方程确定所述自制激光雷达三维成像系统点云误差模型中的所述垂直度误差γ;将所述垂直度误差γ代入式⑷，在所述自制激光雷达三维成像系统的所述目标点云坐标X，y，Ζτ基础上，得到所述自制激光雷达三维成像系统校正后的所述目标点云坐标X+ΔX，y+Δy，Z+ΔΖτ。[0025]其中，建立所述自制激光雷达三维成像系统理想坐标系O-XYZ;所述自制激光雷达三维成像系统的俯仰轴定义为所述45°转镜的电机转轴，方位轴定义为所述云台的转轴；理想情况下，所述俯仰轴与所述方位轴互相垂直，所述垂直度误差γ=〇;所述45°转镜的反射面中心，即所述入射光入射到所述反射面上的交点为坐标原点0;与所述俯仰轴重合，正方向与所述激光入射到所述45°转镜上的方向相同的坐标轴定义为X轴;与理想情况下所述激光初始出射方向相同的坐标轴定义为Y轴;与所述方位轴重合，正方向竖直向上的坐标轴定义为Z轴。[0026]其中，建立由所述垂直度误差γ引起的所述自制激光雷达三维成像系统测角误差模型并化简；由于所述实际俯仰轴X’轴与所述方位轴Ζ轴之间存在所述垂直度误差γ，即所述实际俯仰轴X’轴与所述理想俯仰轴X轴之间存在夹角γ，建立所述实际坐标系0-Χ’ΥΖ’，所述自制激光雷达三维成像系统测角误差模型的建立过程如下：[0027]初始所述45°转镜法线单位矢量所述0-Χ’ΥΖ’坐标系下为：[0028][0029]理想情况下出射光线经过所述目标上一点Ρ，此时所述45°转镜法线矢量所述0-XYZ坐标系下为：[0030][0031]式6中为所述目标上一点P的所述俯仰角测量值，为所述目标上一点P的所述方位角测量值，分别为绕所述X’轴逆时针旋转所述角、绕所述Y轴逆时针旋转所述γ角、绕所述Z轴逆时针旋转所述角的旋转矩阵，所述旋转矩阵如下：[0032][0033]将式⑶和式⑵代入式6，可得所述O-XYZ坐标系下所述45°转镜的法线矢量如下：[0034][0035]初始所述入射光矢量为经所述云台转动后变为由光反射定律的矢量形式为求得出射光矢量为根据球坐标与直角坐标之间的转换关系，如下式（9，可求得所述方位角与所述俯仰角的真实值[003[0037]根据三角函数近似原则，所述方位角误差与所述俯仰角误差可以近似成如下形式：[0038][0039]得到的所述自制激光雷达三维成像系统测角误差模型包括所述方位角误差与俯仰角误差，描述了所述测角误差方位角误差、俯仰角误差）和所述垂直度误差γ以及所述方位角、所述俯仰角之间的数学关系；[0040]根据三角函数近似原则sinγ=γ，cosγ=1，并合理省略部分γ的高次项，得到化简后所述自制激光雷达三维成像系统测角误差模型如下：[0041][0042]其中，所述自制激光雷达三维成像系统球坐标系中的测角误差模型转换至所述自制激光雷达三维成像系统直角坐标系中的点云误差模型;所述自制激光雷达三维成像系统扫描后可以直接得到所述目标上一点P的所述一维距离L、所述方位角外与所述俯仰角私的测量值，根据式9转换至所述自制激光雷达三维成像系统直角坐标系下得到所述目标上一点P的空间三维坐标X，y，ζτ;[0043]由于存在所述测距误差AL和所述测角误差（方位角误差Δ%、俯仰角误差八仍），所述目标上一点P的坐标测量值为P’（x+Ax，y+Ay，z+Az，其中（Δχ,Ay,ΔζΤ为所述目标的点云误差，根据误差传递公式，得所述自制激光雷达三维成像系统点云误差模型如下：[0044][0045]其中，所述目标在所述高精度三维扫描仪中的坐标转换至所述自制激光雷达三维成像系统中；所述自制激光雷达三维成像系统点云误差模型中的所述垂直度误差γ未知且不易测量，因此利用所述自制激光雷达三维成像系统与所述高精度三维扫描仪中的点云坐标数据求解所述垂直度误差γ实现点云误差校正；利用所述自制激光雷达三维成像系统对N个所述目标进行扫描，得到全部所述目标上一点在所述自制激光雷达三维成像系统坐标系下的坐标11，71，21\1=1，2，一，吣，作为测量值;将所述测量值代入式9，得到全部所述目标的一维距离U、俯仰角和方位角I利用所述高精度三维扫描仪对相同所述目标进行扫描，得到所述目标上一点在所述高精度三维扫描仪坐标系下的坐标X^，y^，i=l，2,…，N;由于所述Xl，yi，ZlT与所述处于不同的坐标系下，因此将所述χ\转换至所述自制激光雷达三维成像系统坐标系下，作为真实值;所述高精度三维扫描仪到所述自制激光雷达三维成像系统的旋转矩阵R和平移矢量T表示如下：[0048]式（13与（14中a、b、c分别是绕所述高精度三维扫描仪坐标系各轴逆时针旋转的角度，XQ、y〇、ZQ分别是所述X、Y、Z三个方向上的位移，所述X\，太i，zτ在所述自制激光雷达三维成像系统中的坐标如下：[0049][0050]其中，求解所述自制激光雷达三维成像系统点云误差模型中的模型参数，即所述垂直度误差γ;所述自制激光雷达三维成像系统点云误差模型可写作如下形式：[0051]丨）[0052]所述测距误差AL1主要受所述自制激光雷达三维成像系统中测距电路影响，在所述一维距离Li处于一定范围内时为一个已知常数;将所述Xi，yi，ZiΤ、所述x\，y\，z\T、所述一维距离L1、所述方位角和所述俯仰角代入式（15与式（16，基于最小二乘法求解3*N个非线性方程，可以确定所述旋转矩阵R和所述平移矢量Ta，b，c，Xo，yQ，ZQ与所述垂直度误差γ共7个未知量。[0053]其中，利用求解所得的所述垂直度误差γ完善所述自制激光雷达三维成像系统的点云误差模型，实现对所述自制激光雷达三维成像系统垂直度误差的点云误差校正;将所述垂直度误差γ代入式（11和式（12，得到所述自制激光雷达三维成像系统的点云误差ΔX，Δy，Δζτ，在所述自制激光雷达三维成像系统的所述目标点云坐标x，y，ζτ基础上，得到所述自制激光雷达三维成像系统对所述垂直度误差γ校正后的所述目标点云坐标X+ΔX，y+Δy，ζ+ΔζΤ〇[0054]其中，用于所述自制激光雷达三维成像系统垂直度误差点云误差校正的所述目标包含但不限于标靶球、平面反光标靶等所有可获得所述目标上一点空间坐标的物体。附图说明[0055]图1是自制激光雷达三维成像系统对目标扫描的空间示意图；[0056]图2是自制地基激光雷达垂直度误差的点云误差校正流程示意图；[0057]图3是自制系统坐标系下俯仰轴与方位轴垂直度误差示意图；[0058]图4是自制系统全量程扫描过程中测角误差变化的仿真结果；[0059]图5是自制系统测角误差模型化简前后测角误差仿真的对比结果；[0060]图6是自制系统点云误差模型中参数确立的流程示意图；[0061]图7是自制系统点云误差模型中参数确立的扫描方案示意图；具体实施方式[0062]以下结合附图对本发明专利的具体实施方式作进一步详细描述。基于自制地基激光雷达垂直度误差的点云误差校正方法流程示意图如图2所示，先建立理想情况下自制激光雷达三维成像系统（713坐标系O-XYZ，由于实际情况下自制系统俯仰轴X’轴（204与方位轴Z轴203之间存在垂直度误差γ301，在自制激光雷达三维成像系统713坐标系下理论推导出垂直度误差γ301对于自制激光雷达三维成像系统713测角误差的影响，得到自制激光雷达三维成像系统713测角误差模型。根据三角函数近似原则，对自制激光雷达三维成像系统713测角误差模型进行化简。根据误差传递原则，将自制激光雷达三维成像系统713测角误差模型转化到直角坐标系下，得到自制激光雷达三维成像系统713点云误差模型。利用自制激光雷达三维成像系统713与高精度三维扫描仪714对相同标靶球701-712进行扫描，分别得到两组目标点云数据，在实现坐标系统一后将数据代入自制激光雷达三维成像系统713点云误差说明书表达式15与（16中，求解模型参数，即垂直度误差γ301，并利用此结果实现自制激光雷达三维成像系统（713点云的误差校正。故具体的实施方案可以分为四步：自制激光雷达三维成像系统测角误差模型的建立、自制激光雷达三维成像系统测角误差模型的化简、自制激光雷达三维成像系统点云误差模型的建立和模型的参数求解与校正。[0063]1自制激光雷达三维成像系统测角误差模型的建立[0064]自制激光雷达三维成像系统（713对目标（106扫描的空间示意图如图1所示，自制激光雷达三维成像系统713进行扫描时，激光（105经过光学系统（101后入射至45°转镜（103中心0点，该点作为坐标原点。电机（102控制45°转镜（103垂直旋转，理想情况下电机（102转轴即为俯仰轴，与X轴201重合，X轴201正方向与激光（105入射方向相同。同时云台（104绕铅垂轴水平旋转，Z轴（203与铅垂轴重合，且正方向竖直向上。建立右手坐标系，认为初始激光出射方向为Y轴202正方向，实现对三维空间的扫描。[0065]自制激光雷达三维成像系统713坐标系下俯仰轴与方位轴垂直度误差（301存在的示意图如图1和图3所示，实际情况下俯仰轴为X’轴（204，与理想情况下俯仰轴X轴201之间存在误差角γ301，因此建立了另一个0-Χ’ΥΖ’坐标系。目标物体（106是一个标靶球，标靶球上任意一点为P点（107，认为出射光线在空间中经过P点（107，此时出射激光的方位角（302和俯仰角（303分别测量为％和A，〇-ΧΥΖ坐标系下45°转镜（103的法线矢量如下：[0066][0067]入射光（105矢量已知，由反射定律的矢量形式可以得到出射光矢量。根据球坐标与直角坐标之间的转换关系，如式9，可求得方位角（302与俯仰角303的真实值根据三角函数近似原则，方位角误差与俯仰角误差可以近似成如下形式：[0068][0069]最终建立的自制激光雷达三维成像系统（713测角误差模型包括方位角误差八灼与俯仰角误差，误差模型结果如下：[0072]因此自制激光雷达三维成像系统（713测角误差（方位角误差、俯仰角误差受垂直度误差γ301以及方位角（302、俯仰角303影响。假设自制激光雷达三维成像系统713垂直度误差301参量为γ=5"，垂直扫描范围为_水平扫描范围为自制激光雷达三维成像系统（713全量程扫描过程中测角误差方位角误差、俯仰角误差变化的仿真结果如图4所示。结果表明：水平扫描过程中测角误差均不变；由下至上的垂直扫描过程中，方位角误差先递减后递增，并且在^处取得最小值为〇,俯仰角误差先递增后递减，同样在_.1处取得最大值，测角误差的数量级均在ΚΓ5。该仿真结果可以直观地显示自制激光雷达三维成像系统713中存在一定两轴垂直度误差301时，整个扫描过程中测角误差的变化情况。[0073]2自制激光雷达三维成像系统测角误差模型的化简[0074]上述自制激光雷达三维成像系统（713测角误差模型较为复杂，需要进行合理简化。根据三角函数近似原则siny=γ，cosγ=1，并且合理省略部分γ的高次项，得到化简后的自制激光雷达三维成像系统713测角误差模型如下：[0075][0076]假设垂直度误差（301参量为γ=5"，垂直扫描范围为，水平扫描范围为•由分析可知由垂直度误差（301引起的自制激光雷达三维成像系统713测角误差只随俯仰角的改变而变化，比较化简前后的模型，自制激光雷达三维成像系统713测角误差模型化简前后仿真的对比结果如图5所示。结果表明：化简前后方位角误差与俯仰角误差殖俯仰角（303测量值变化相同，模型化简过程正确，将化简后的模型作为自制激光雷达三维成像系统713的测角误差模型。[0077]3自制激光雷达三维成像系统点云误差模型的建立[0078]自制激光雷达三维成像系统（713最终得到并显示的是目标标靶球（106的点云数据，数据格式为直角坐标系下目标点（107空间三维坐标0^，7,27305，坐标转换的关系如式9，其中L是目标点的一维距离（304的测量值，是目标方位角（302的测量值，是俯仰角303的测量值。[0079]由误差传递公式，得到自制激光雷达三维成像系统713点云误差模型如下：[0080][0081]其中ΔΧ、Ay、Δz分别为X、Y、Z轴（201-203坐标分量误差值，AL为系统测距误差，在一定测距范围内可视为定值，为系统方位角误差为系统俯仰角误差，可由上述自制激光雷达三维成像系统713测角误差模型表示。[0082]⑷模型的参数求解与校正[0083]自制激光雷达三维成像系统（713点云误差模型中参数确立的流程示意图如图6所示，取N个标靶球701-712作为目标，分别用自制激光雷达三维成像系统713与高精度三维扫描仪714对其进行扫描，可得到每个标靶球701-712上多点的点云数据，利用最小二乘法对每个标靶球701-712上点云进行空间拟合，分别得到自制激光雷达三维成像系统713下的球心坐标Xi，yi，ZiT，（i=1，2，…，N和高精度三维扫描仪714下的球心坐标X'i，y'i，Z'iT，（i=1，2，…，N。将X'i，y'i，Z'iT，（i=1，2，…，N进行旋转和平移转化到自制激光雷达三维成像系统（713坐标系下，一起代入自制激光雷达三维成像系统713点云误差表达式（15和式16中，采用最小二乘法对模型参数进行求解，用得到垂直度误差γ301实现自制激光雷达三维成像系统713的点云误差校正。具体的扫描方案如下：[0084]自制激光雷达三维成像系统713点云误差模型中参数确立的扫描方案示意图如图7所示，取N=12，即准备标靶球12个701-712，在室内空旷场地内任意布设，将自制激光雷达三维成像系统713置于中心处，使标靶球701-712遍布自制激光雷达三维成像系统713水平扫描范围，高低遍布自制激光雷达三维成像系统713垂直扫描范围内，每个标靶球701-712与自制激光雷达三维成像系统（713距离大致相同，此时测距误差为一个已知的常数。利用自制激光雷达三维成像系统（713对所有标靶球701-712进行扫描，经过球心拟合后得到全部标祀球701-712球心坐标xi，yi,ziT,i=1，2,…，12，作为测量值，并求得每个标靶球（701-712球心的一维距离Li304、俯仰角A303和方位角仏302。利用高精度三维扫描仪714进行二次扫描，得到所有标靶球701-712球心坐标X'i，y'i，z'iT，（i=1，2，…，12，通过旋转和平移将其转化到自制激光雷达三维成像系统713坐标系下，作为真实值，旋转矩阵R和平移矢量T如下：[0087]式中a、b、c分别是绕高精度三维扫描仪714坐标系各轴逆时针旋转的角度，xo、yo、z〇分别是X、Y、Z201-203三个方向上的位移，自制激光雷达三维成像系统713点云误差模型可写作如下形式：[0088][0089]上述模型中有a，b，c，xQ，yQ，Z，γ共7个未知参数，将其中4个标靶球（701、704、707、710的球心坐标代入式（19，可得到12个非线性方程。首先假设不存在垂直度误差γ301，即式（19等号右侧为0,代入标靶球701、704、707、710球心坐标数据，采用最小二乘法解非线性方程组可以求得a，b，c，XQ，yQ，Zo的初始值，默认垂直度误差γ301初始值为0。初始值确定后，采用最小二乘法求解7个未知参数，将垂直度误差γ301代入式（11和式（12，得到系统点云误差（ΔX，Δy，Δζτ，利用剩余8个标靶球702、703、705、706、708、709、711和712球心的坐标数据对模型进行检验，不断修正模型，最终得到的模型可以实现自制激光雷达三维成像系统713垂直度误差γ301的点云误差校正，校正后的目标点云坐标为X+ΔX，y+Δy，ζ+ΔζΤ。[0090]综上所述，本发明提出一种基于自制地基激光雷达垂直度误差的点云误差校正方法，该方法主要针对自制激光雷达三维成像系统45°转镜配合云台转动的扫描方式，通过计算俯仰轴与方位轴垂直度误差对自制激光雷达三维成像系统测角误差的影响，建立自制激光雷达三维成像系统点云误差模型，并采用高精度三维扫描仪的点云坐标作为真实值求解垂直度误差，从而实现对自制激光雷达三维成像系统垂直度误差目标点云的误差校正。本发明是一种从自制激光雷达三维成像系统误差源出发的、利用少量目标点即可实现的、理论性与逻辑性较强的系统点云误差校正方法，该方法适用于所有采用45°转镜配合云台转动扫描方式的三维扫描系统。[0091]以上所述，仅为本发明具体实施方法的基本方案，但本发明的保护范围并不局限于此，任何熟悉本技术领域的人员在本发明公开的技术范围内，可想到的变化或替换，都应涵盖在本发明的保护范围之内。因此，本发明的保护范围应该以权利要求的保护范围为准。所有落入权利要求的等同的含义和范围内的变化都将包括在权利要求的范围之内。

权利要求：I.一种基于自制地基激光雷达垂直度误差的点云误差校正方法，其特征在于，该方法针对自制激光雷达三维成像系统中45°转镜配合云台转动的扫描方式，其中所述自制激光雷达三维成像系统包括光学系统、扫描机构（电机、45°转镜）、云台；入射光经所述光学系统出射到所述45°转镜中心0点），伴随所述扫描机构垂直旋转、所述云台水平旋转从所述自制激光雷达三维成像系统中出射;所述自制激光雷达三维成像系统的理想坐标系O-XYZ包括俯仰轴X轴）、初始出射光线方向Y轴和方位轴Z轴）；所述自制激光雷达三维成像系统的实际坐标系0-X’YZ’）在所述理想坐标系O-XYZ基础上，实际俯仰轴X’轴与X轴之间存在夹角γ，Y轴不变，根据右手坐标法则建立Z’轴;所述垂直度误差定义为所述实际俯仰轴X’轴）与所述理想俯仰轴X轴）之间的夹角γ;目标上一点P在所述理想坐标系（0-ΧΥΖ中一维距离L定义为，的长度，方位角％定义为在XOY平面的投影与X轴的夹角，从X轴正半轴起算，逆时针方向为正，范围为0°至360°，俯仰角死定义为90°与西3和Z轴之间夹角的差，所述一维距离L、所述方位角％和所述俯仰角代的测量误差分别为测距误差AL、方位角误差^灼和俯仰角误差通过理论分析所述垂直度误差γ对所述自制激光雷达三维成像系统测角误差方位角误差、俯仰角误差武）的影响，建立所述自制激光雷达三维成像系统的测角误差模型；所述目标的点云定义为目标上一点的直角坐标目标的点云误差定义为所述目标点云的坐标测量值与真实值的偏差，根据所述目标的点云误差τ与所述目标测角误差方位角误差Δ%、俯仰角误差八釣）之间的误差传递原则，建立所述自制激光雷达三维成像系统的点云误差模型如下：得到所述自制激光雷达三维成像系统对所述垂直度误差γ校正后的所述目标点云坐标为：从而实现对所述自制激光雷达三维成像系统垂直度误差γ的点云误差校正；所述方法主要包括以下七步：1建立所述自制激光雷达三维成像系统理想坐标系（O-XYZ，由于实际俯仰轴X’轴）与方位轴Ζ轴之间存在所述垂直度误差，即实际俯仰轴X’轴与理想俯仰轴X轴之间夹角γ，因此实际俯仰轴变为X’轴，Y轴不变，根据右手坐标法则建立Ζ’轴，为所述自制激光雷达三维成像系统实际坐标系（0-Χ’ΥΖ’）；所述目标上任意一点P在所述理想坐标系O-XYZ中的测量值为方位角％，俯仰角武;所述目标上任意一点P在所述理想坐标系（O-XYZ中的真实值为方位角^，俯仰角心;所述仍,和I差值为方位角误差Δ%，:所述队和％,差值为俯仰角误差Δή;2建立由所述垂直度误差γ引起的所述自制激光雷达三维成像系统测角误差模型；该模型分别描述了所述测角误差方位角误差△%、俯仰角误差Δρ,和所述垂直度误差γ以及所述目标的方位角外、俯仰角％之间的数学关系，如下所示：3基于对所述垂直度误差γ的三角函数值进行近似变换，化简所述自制激光雷达三维成像系统测角误差模型，如下所示：4根据误差传递原则，建立所述自制激光雷达三维成像系统的点云误差（ΔX，Δy，Δz7与所述测距误差ΔL、所述测角误差方位角误差Δ%、俯仰角误差Δα之间的映射关系，如下所示：其中，L为所述目标上任意一点在所述自制激光雷达三维成像系统理想坐标系O-XYZ中的一维距离，AL为所述目标上任意一点一维距离L的测量误差；5将所述自制激光雷达三维成像系统测角误差模型转化到直角坐标系下，得到所述自制激光雷达三维成像系统的点云误差模型如下：6利用所述自制激光雷达三维成像系统对N个所述目标进行扫描，得到所述目标在所述自制激光雷达三维成像系统中的坐杨，作为测量值;利用高精度三维扫描仪对所述目标进行二次扫描，得到所述目标在所述高精度三维扫描仪中的坐I将其转化到所述自制激光雷达三维成像系统下，作为真实值;所述测量值与所述真实值之差为所述自制激光雷达三维成像系统的点云误差（AX1，根据球坐标系与直角坐标系之间的映射关系，由所述测量值得到所述目标的一维距离U、方位角矜;和俯仰角％，所述目标的测距误差ΔL1在所述一维距离L1处于一定范围内时视为一个已知常数；7求解所述自制激光雷达三维成像系统点云误差模型中的模型参数，即所述垂直度误差γ，对所述自制激光雷达三维成像系统垂直度误差γ的点云误差进行校正;将所述自制激光雷达三维成像系统的点云误差所述目标的一维距离1^、方位角私、俯仰角也和测距误差ΔL1代入所述公式⑷中，得到3*Ν个非线性方程，通过求解所述非线性方程确定所述自制激光雷达三维成像系统点云误差模型中的所述垂直度误差γ;将所述垂直度误差γ代入式4，在所述自制激光雷达三维成像系统的所述目标点云坐标X，y，Ζτ基础上，得到所述自制激光雷达三维成像系统校正后的所述目标点云坐相2.根据权利要求1所述的一种基于自制地基激光雷达垂直度误差的点云误差校正方法，其特征在于，建立所述自制激光雷达三维成像系统理想坐标系（O-XYZ;所述自制激光雷达三维成像系统的俯仰轴定义为所述45°转镜的电机转轴，方位轴定义为所述云台的转轴;理想情况下，所述俯仰轴与所述方位轴互相垂直，所述垂直度误差γ=0;所述45°转镜的反射面中心，即所述入射光入射到所述反射面上的交点为坐标原点0;与所述俯仰轴重合，正方向与所述激光入射到所述45°转镜上的方向相同的坐标轴定义为X轴；与理想情况下所述激光初始出射方向相同的坐标轴定义为Y轴;与所述方位轴重合，正方向竖直向上的坐标轴定义为Z轴。3.根据权利要求1所述的一种基于自制地基激光雷达垂直度误差的点云误差校正方法，其特征在于，建立由所述垂直度误差γ引起的所述自制激光雷达三维成像系统测角误差模型并化简；由于所述实际俯仰轴X’轴与所述方位轴Ζ轴之间存在所述垂直度误差γ，即所述实际俯仰轴X’轴与所述理想俯仰轴X轴之间存在夹角γ，建立所述实际坐标系ο-χ’ΥΖ’，所述自制激光雷达三维成像系统测角误差模型的建立过程如下：初始所述45°转镜法线单位矢量所述ο-χ’ΥΖ’坐标系下为：理想情况下出射光线经过所述目标上一点P，此时所述45°转镜法线矢量所述O-XYZ坐标系下为：式6中灼为所述目标上一点P的所述俯仰角测量值，灼为所述目标上一点P的所述方位角测量值，1分别为绕所述X’轴逆时针旋转所述巧角、绕所述Y轴逆时针旋转所述γ角、绕所述Z轴逆时针旋转所述％-90°角的旋转矩阵，所述旋转矩阵如下，将式⑶和式⑵代入式6，可得所述O-XYZ坐标系下所述45°转镜的法线矢量如下：初始所述入射光矢量为，经所述云台转动后变^由光反射定律的矢量形式^，求得出射光矢量戈；根据球坐标与直角坐标之间的转换关系，如下式9，可求得所述方位角与所述俯仰角的真实1根据三角函数近似原则，所述方位角误差与所述俯仰角误差可以近似成如下形式：得到的所述自制激光雷达三维成像系统测角误差模型包括所述方位角误差与俯仰角误差△氕，描述了所述测角误差方位角误差△%、俯仰角误差A%和所述垂直度误差γ以及所述方位角釣、所述俯仰角R之间的数学关系；根据三角函数近似原则siny=γ，cosy=1，并合理省略部分γ的高次项，得到化简后所述自制激光雷达三维成像系统测角误差模型如下：4.根据权利要求1所述的一种基于自制地基激光雷达垂直度误差的点云误差校正方法，其特征在于，所述自制激光雷达三维成像系统球坐标系中的测角误差模型转换至所述自制激光雷达三维成像系统直角坐标系中的点云误差模型;所述自制激光雷达三维成像系统扫描后可以直接得到所述目标上一点P的所述一维距离L、所述方位角咚与所述俯仰角私的测量值，根据式9转换至所述自制激光雷达三维成像系统直角坐标系下得到所述目标上一点P的空间三维坐較_由于存在所述测距误差AL和所述测角误差方位角误差△各、俯仰角误差△氣），所述目标上一点P的坐标测量值为纟所述目标的点云误差，根据误差传递公式，得所述自制激光雷达三维成像系统点云误差模型如下：5.根据权利要求1所述的一种基于自制地基激光雷达垂直度误差的点云误差校正方法，其特征在于，所述目标在所述高精度三维扫描仪中的坐标转换至所述自制激光雷达三维成像系统中；所述自制激光雷达三维成像系统点云误差模型中的所述垂直度误差γ未知且不易测量，因此利用所述自制激光雷达三维成像系统与所述高精度三维扫描仪中的点云坐标数据求解所述垂直度误差γ实现点云误差校正;利用所述自制激光雷达三维成像系统对N个所述目标进行扫描，得到全部所述目标上一点在所述自制激光雷达三维成像系统坐标系下的坐标丨^^:^^:以二^^^吣“乍为测量值:将所述测量值代入式⑴沁得到全部所述目标的一维距离U、俯仰角A和方位角私;:利用所述高精度三维扫描仪对相同所述目标进行扫描，得到所述目标上一点在所述高精度三维扫描仪坐标系下的坐标x’uy’i，;由于所述1，71，217与所述1’，7’1，2’1广处于不同的坐标系下，因此将所述Xl’，y’：，z’^τ转换至所述自制激光雷达三维成像系统坐标系下，作为真实值;所述高精度三维扫描仪到所述自制激光雷达三维成像系统的旋转矩阵R和平移矢量T表示如下，式（13与（14中a、b、c分别是绕所述高精度三维扫描仪坐标系各轴逆时针旋转的角度，XQ、yQ、ZQ分别是所述X、Y、Z三个方向上的位移，所述X’i，y’i，Z’iτ在所述自制激光雷达三维成像系统中的坐标如下：6.根据权利要求1或5所述的一种基于自制地基激光雷达垂直度误差的点云误差校正方法，其特征在于，求解所述自制激光雷达三维成像系统点云误差模型中的模型参数，即所述垂直度误差γ;所述自制激光雷达三维成像系统点云误差模型可写作如下形式：所述测距误差AL1主要受所述自制激光雷达三维成像系统中测距电路影响，在所述一维距离1^处于一定范围内时为一个已知常数;将所述Xl，yi，ZlT、所述、所述一维距离U、所述方位角％,和所述俯仰角代入式（15与式（16，基于最小二乘法求解3*N个非线性方程，可以确定所述旋转矩阵R和所述平移矢量Ta，b，c，XO，yo，ZQ与所述垂直度误差y共7个未知量。7.根据权利要求1所述的一种基于自制地基激光雷达垂直度误差的点云误差校正方法，其特征在于，利用求解所得的所述垂直度误差γ完善所述自制激光雷达三维成像系统的点云误差模型，实现对所述自制激光雷达三维成像系统垂直度误差的点云误差校正;将所述垂直度误差γ代入式（11和式（12，得到所述自制激光雷达三维成像系统的点云误差Δχ,Ay,Δζτ，在所述自制激光雷达三维成像系统的所述目标点云坐标x，y，zT基础上，得到所述自制激光雷达三维成像系统对所述垂直度误差γ校正后的所述目标点云坐标X+ΔX，y+Δy，ζ+Δζ丁。8.根据权利要求1所述的一种基于自制地基激光雷达垂直度误差的点云误差校正方法，其特征在于，用于所述自制激光雷达三维成像系统垂直度误差点云误差校正的所述目标包含但不限于标靶球、平面反光标靶等所有可获得所述目标上一点空间坐标的物体。

百度查询： 北京航空航天大学 一种基于自制地基激光雷达垂直度误差的点云误差校正方法

免责声明
1、本报告根据公开、合法渠道获得相关数据和信息，力求客观、公正，但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解，仅供参考使用，不能作为本公司承担任何法律责任的依据或者凭证。

阅读全文 双屏查看 官方信息 专利公告 收藏专利 下载PDF 下载WORD