激光雷达点云运动畸变的矫正方法技术

一种激光雷达点云运动畸变的矫正方法，属于无人车自动驾驶技术领域。本发明专利技术针对激光雷达点云运动畸变矫正中，外部传感器存在位移累积误差大的问题。包括：采用RTK作为脉冲发生器，同步触发激光雷达和IMU；对激光雷达第一帧点云，建立全局坐标系；对非第一帧点云，建立局部坐标系；同时将对应的IMU坐标系转换到所述局部坐标系下；并同步获得IMU位姿；采用插值方法获得当前帧点云中每个数据点对应的IMU位姿，并根据所述IMU位姿矫正激光雷达当前帧点云运动畸变；将所述局部坐标系转换到所述全局坐标系下，再利用RTK位姿校准IMU位姿；进行下一帧点云矫正，直到完成最后一帧激光雷达点云运动畸变的矫正。本发明专利技术增强了激光雷达点云矫正的鲁棒性和稳定性。

【技术实现步骤摘要】
激光雷达点云运动畸变的矫正方法
本专利技术涉及激光雷达点云运动畸变的矫正方法，属于无人车自动驾驶

技术介绍
随着人工智能的发展，激光雷达以其分辨率高、测距远、不受光照影响和抗干扰能力强等优点获得了广泛的关注。在无人车自动驾驶领域，激光雷达可以在未知环境中建立地图信息，为后续定位导航、路径规划等提供良好基础。基于机械旋转扫描的激光雷达在随着无人车运动时，其坐标系不断发生变化，会导致同一帧点云中的点不在同一个坐标系下而产生运动畸变，因此需要对获取的点云数据进行运动畸变矫正。目前，针对多线激光雷达运动畸变，可利用单一惯性测量单元(IMU)或惯性测量单元与轮速里程计联合作为作为外部传感器，并假设无人车只有航向角变化，推导出激光雷达的运动信息，进而对激光雷达点云进行运动畸变矫正。但是IMU和轮速里程计均需要通过积分获得位移，在长时间工作状态下存在位移累积误差大的缺陷。
技术实现思路
针对现有激光雷达点云运动畸变的矫正方法中，采用的外部传感器存在位移累积误差大的问题，本专利技术提供一种激光雷达点云运动畸变的矫正方法。本专利技术的一种激光雷达点云运动畸变的矫正方法，包括，步骤一：采用RTK作为脉冲发生器，同步触发激光雷达和IMU；对采集的激光雷达第一帧点云，以第一帧点云为原点建立全局坐标系；步骤二：采集非第一帧的激光雷达当前帧点云，以当前帧点云为原点建立局部坐标系；同时将当前帧点云采集时刻对应的IMU坐标系转换到所述局部坐标系下；并同步获得IMU位姿；步骤三：根据所述局部坐标系，采用插值方法获得当前帧点云中每个数据点对应的IMU位姿，并根据所述IMU位姿矫正激光雷达当前帧点云运动畸变；步骤四：将所述局部坐标系转换到所述全局坐标系下，再利用RTK位姿校准IMU位姿；然后返回步骤二，直到完成最后一帧激光雷达点云运动畸变的矫正。根据本专利技术的激光雷达点云运动畸变的矫正方法，步骤二中，对于采集的激光雷达点云，在局部坐标系下，第k帧第i点的坐标为其中xki、yki、zki分别为局部坐标系下第k帧第i点的X、Y、Z轴的坐标，其中k∈(1,2,3...m)，i∈(1,2,3...n)，m为点云总帧数，n为帧数据包含的数据点数；将激光雷达点云表述为矩阵形式为：根据本专利技术的激光雷达点云运动畸变的矫正方法，步骤二中，所述IMU位姿用矩阵形式表达为：其中为激光雷达点云第k帧第i点的位姿，为激光雷达点云第k帧第i点到相应局部坐标系的旋转矩阵，为激光雷达点云第k帧第i点到相应局部坐标系的平移矩阵；为激光雷达点云第k帧第i点绕局部坐标系Z轴旋转的角度，β为激光雷达点云第k帧第i点绕局部坐标系Y轴旋转的角度，α为激光雷达点云第k帧第i点绕局部坐标系X轴旋转的角度；式中sx为激光雷达点云第k帧第i点沿局部坐标系X轴的位移，sy为激光雷达点云第k帧第i点沿局部坐标系Y轴的位移，sz为激光雷达点云第k帧第i点沿局部坐标系Z轴的位移；当i＝0时，式中为当前激光雷达点云第k帧的起始位姿，为当前激光雷达点云第k帧数据到相应局部坐标系的旋转矩阵，为当前激光雷达点云第k帧数据到相应局部坐标系的平移矩阵。根据本专利技术的激光雷达点云运动畸变的矫正方法，步骤三中根据所述IMU位姿矫正激光雷达点云运动畸变包括：将激光雷达点云第k帧的帧头时间戳记为td，帧中时间戳记为te，帧尾时间戳记为tf；第k帧帧头前后两帧IMU位姿分别为和第k帧帧中前后两帧IMU位姿分别为和第k帧帧尾前后两帧IMU位姿为和对IMU位姿插值，获得第k帧帧头、帧中和帧尾的位姿依次为和再进行二次曲线拟合，得到点云位姿曲线拟合方程：Ptk＝At2+Bt+C，式中Ptk为第k帧点云中每个数据点对应的位姿，t为时间，A为二次项系数，B为一次项系数，C为常数；根据点云位姿曲线拟合方程矫正激光雷达当前帧点云运动畸变，得到：式中表示第k帧第i点的矫正后点云坐标。根据本专利技术的激光雷达点云运动畸变的矫正方法，步骤四中利用RTK位姿校准IMU位姿包括：根据局部坐标系下RTK位姿和IMU位姿，判断IMU位姿的时间戳是否小于RTK位姿的时间戳；若IMU位姿的时间戳小于RTK位姿的时间戳，将RTK位姿作为IMU位姿观测值；若IMU位姿的时间戳大于或等于RTK位姿的时间戳，寻找当前帧IMU位姿时间戳的前后两帧RTK位姿，利用RTK插值得到的位姿作为IMU位姿观测值；对局部坐标系下IMU位姿和所述IMU位姿观测值进行卡尔曼融合，得到校准后的IMU位姿。本专利技术的有益效果：本专利技术利用IMU位姿插值获得每一帧所有点在局部坐标系下的位姿，再进一步将每一帧点云去畸变后转换到当前帧的局部坐标系下，再将每一帧局部坐标系转换到全局坐标系下，最终完成激光雷达点云运动畸变的矫正。本专利技术方法利用了载波相位差分技术RTK，其平面精度和高程精度都能达到厘米级，不存在累计误差，且可作为钟源在硬件上统一各传感器时间。利用RTK实时修正IMU位姿后，可利用IMU计算出无人车的位移、航向角、俯仰角和横滚角，进而对激光雷达点云运动畸变进行矫正，相比只考虑航向角的技术更加接近真实情况。当无人车行驶到遮挡严重的地区时，尽管RTK工作会受到一定影响，但此时经过RTK修正过的IMU依旧能够提供较为准确的位姿，增强了系统鲁棒性和稳定性。附图说明图1是本专利技术所述激光雷达点云运动畸变的矫正方法的整体流程图；图2是激光雷达点云运动畸变的矫正方法具体实施流程图；图3是插值IMU位姿矫正激光雷达点云畸变的流程图；图4是利用RTK位姿校准IMU位姿的流程图。具体实施方式下面将结合本专利技术实施例中的附图，对本专利技术实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有作出创造性劳动的前提下所获得的所有其它实施例，都属于本专利技术保护的范围。需要说明的是，在不冲突的情况下，本专利技术中的实施例及实施例中的特征可以相互组合。下面结合附图和具体实施例对本专利技术作进一步说明，但不作为本专利技术的限定。具体实施方式一、结合图1和图2所示，本专利技术提供了一种激光雷达点云运动畸变的矫正方法，包括，步骤一：采用RTK作为脉冲发生器，同步触发激光雷达和IMU；对采集的激光雷达第一帧点云，以第一帧点云为原点建立全局坐标系；RTK在每完成一次触发后，可进行自身时钟的校正，由此完成硬件上的钟源时间同步；步骤二：采集非第一帧的激光雷达当前帧点云，以当前帧点云为原点建立局部坐标系；同时将当前帧点云采集时刻对应的IMU坐标系转换到所述局部坐标系下；并同步获得IMU位姿；步骤三：根据所述局部坐标系，采用插值方法获得当前帧点云中每个数据点对应的IMU位姿，并根据所述IMU本文档来自技高网...

【技术保护点】
1.一种激光雷达点云运动畸变的矫正方法，其特征在于包括，/n步骤一：采用RTK作为脉冲发生器，同步触发激光雷达和IMU；对采集的激光雷达第一帧点云，以第一帧点云为原点建立全局坐标系；/n步骤二：采集非第一帧的激光雷达当前帧点云，以当前帧点云为原点建立局部坐标系；同时将当前帧点云采集时刻对应的IMU坐标系转换到所述局部坐标系下；并同步获得IMU位姿；/n步骤三：根据所述局部坐标系，采用插值方法获得当前帧点云中每个数据点对应的IMU位姿，并根据所述IMU位姿矫正激光雷达当前帧点云运动畸变；/n步骤四：将所述局部坐标系转换到所述全局坐标系下，再利用RTK位姿校准IMU位姿；然后返回步骤二，直到完成最后一帧激光雷达点云运动畸变的矫正。/n

【技术特征摘要】
1.一种激光雷达点云运动畸变的矫正方法，其特征在于包括，
步骤一：采用RTK作为脉冲发生器，同步触发激光雷达和IMU；对采集的激光雷达第一帧点云，以第一帧点云为原点建立全局坐标系；
步骤二：采集非第一帧的激光雷达当前帧点云，以当前帧点云为原点建立局部坐标系；同时将当前帧点云采集时刻对应的IMU坐标系转换到所述局部坐标系下；并同步获得IMU位姿；
步骤三：根据所述局部坐标系，采用插值方法获得当前帧点云中每个数据点对应的IMU位姿，并根据所述IMU位姿矫正激光雷达当前帧点云运动畸变；
步骤四：将所述局部坐标系转换到所述全局坐标系下，再利用RTK位姿校准IMU位姿；然后返回步骤二，直到完成最后一帧激光雷达点云运动畸变的矫正。


2.根据权利要求1所述的激光雷达点云运动畸变的矫正方法，其特征在于，
步骤二中，对于采集的激光雷达点云，在局部坐标系下，第k帧第i点的坐标为其中xki、yki、zki分别为局部坐标系下第k帧第i点的X、Y、Z轴的坐标，其中k∈(1,2,3...m)，i∈(1,2,3...n)，m为点云总帧数，n为帧数据包含的数据点数；
将激光雷达点云表述为矩阵形式为：


3.根据权利要求2所述的激光雷达点云运动畸变的矫正方法，其特征在于，
步骤二中，所述IMU位姿用矩阵形式表达为：



其中为激光雷达点云第k帧第i点的位姿，为激光雷达点云第k帧第i点到相应局部坐标系的旋转矩阵，为激光雷达点云第k帧第i点到相应局部坐标系的平移矩阵；




为激光雷达点云第k帧第i点绕局部坐标系Z轴旋转的角度，β为激光雷达点云第k帧第i点绕局部坐标系Y轴旋转的角度，α为激光雷达点云第k帧第i点绕局部坐标系X轴旋转的角度；



式中sx为激光雷达点云第k帧第...

【专利技术属性】
技术研发人员：刘飞，周志全，邹钰杰，屈婧婧，柴文静，杨起鸣，严景琳，
申请(专利权)人：桂林电子科技大学，
类型：发明
国别省市：广西;45