买专利卖专利找龙图腾，真高效！ 查专利查商标用IPTOP,全免费！专利年费监控用IP管家,真方便！

龙图腾网恭喜东南大学申请的专利一种面向大型救援装备的激光雷达点云畸变矫正方法获国家发明授权专利权，本发明授权专利权由国家知识产权局授予，授权公告号为：CN114296059B 。

龙图腾网通过国家知识产权局官网在2025-05-13发布的发明授权授权公告中获悉：该发明授权的专利申请号/专利号为：202111555737.6，技术领域涉及：G01S7/497；该发明授权一种面向大型救援装备的激光雷达点云畸变矫正方法是由李旭;韦坤;周晓晶设计研发完成，并于2021-12-17向国家知识产权局提交的专利申请。

本一种面向大型救援装备的激光雷达点云畸变矫正方法在说明书摘要公布了：本发明提出了一种面向大型救援装备的激光雷达点云畸变矫正方法，首先利用激光雷达处三个姿态角变化确定点云的旋转变换矩阵，然后利用激光雷达处位置变化确定点云的平移变换矩阵，最后利用卡尔曼滤波提高激光雷达点云畸变矫正的准确性。该方法兼顾激光雷达处旋转的角度和角速度，保证旋转变换矩阵的准确性；分析大型救援装备灾后施救的操作，将激光雷达处的位置变化分为两种，提高平移变换矩阵使用场景的适应性；利用卡尔曼滤波降低旋转平移变换矩阵中大型救援装备运动学参数的噪声，进而提高激光雷达点云畸变矫正的准确性。

本发明授权一种面向大型救援装备的激光雷达点云畸变矫正方法在权利要求书中公布了：1.一种面向大型救援装备的激光雷达点云畸变矫正方法，其特征在于，具体步骤如下：步骤一：利用激光雷达处三个姿态角变化确定点云的旋转变换矩阵；激光雷达固定在装备驾驶舱的顶部，坐标系满足右手准则，Z轴正方向指向驾驶舱的正上方，Y轴正方向指向驾驶舱的正前方，X轴正方向指向驾驶舱的正右方；在一帧点云中，第i个激光点的坐标系需要依次绕X,Y,Z轴旋转axi,ayi,azi度才能与第1个激光点的坐标系保持对应坐标轴同向且平行，旋转方向满足右手法则记为正值，反之记为负值； 分别为第i个激光点对应的激光雷达处俯仰角、侧倾角、航向角，角度增大方向满足右手法则；分别为第j个激光点时三个角度对应的角速度，j＝1,2,…,i-1；f为同一帧点云中相邻两个激光点的间隔时间；第i个激光点的坐标系绕X轴旋转axi度，旋转变换矩阵为第i个激光点的坐标系绕Y轴旋转ayi度，旋转变换矩阵为第i个激光点的坐标系绕Z轴旋转azi度，旋转变换矩阵为第i个激光点的旋转变换矩阵F为： 步骤二：利用激光雷达处位置变化确定点云的平移变换矩阵；装备行驶时，以第1个激光点对应的激光雷达位置为原点建立平面直角坐标系的正方向指向正东方向，的正方向指向正北方向；在坐标系中，第i个激光点对应的激光雷达位置坐标为sj为第j个激光点时装备的速度；bj为第j个激光点时装备行驶方向与正东方向的夹角，为装备行走机构中心处的航向角；坐标系逆时针旋转度得到第1个激光点的XY坐标系，在第1个激光点的XY坐标系中，第i个激光点的平移变换矩阵为装备执行回转操作时，以上部转台的旋转中心为原点建立平面直角坐标系的正方向指向正东方向，的正方向指向正北方向；在坐标系中，第1个激光点对应的激光雷达位置坐标为第i个激光点对应的激光雷达位置坐标为d为激光雷达距旋转中心的距离；ei为在坐标系中第i个激光点对应的激光雷达位置的极角，在坐标系中，第i个激光点对应的激光雷达位置坐标为在第1个激光点的XY坐标系中，第i个激光点的平移变换矩阵为第i个激光点的平移变换矩阵为： 步骤三：利用卡尔曼滤波提高激光雷达点云畸变矫正的准确性；针对装备救援过程，取状态量为其中，分别为激光雷达处的俯仰角、侧倾角和航向角，分别为激光雷达处的俯仰角速度、侧倾角速度和航向角速度，分别为装备行走机构中心处的航向角和航向角速度；以激光雷达处惯性传感器输出的俯仰角、侧倾角、航向角和装备行走机构中心处惯性传感器输出的航向角为观测量，即其中，分别为激光雷达处惯性传感器输出的俯仰角、侧倾角、航向角，为装备行走机构中心处惯性传感器输出的航向角；离散化后的卡尔曼滤波的状态方程和观测方程为： 式中，t表示离散化时刻；A表示状态转移矩阵，c表示离散周期；H表示观测矩阵，q和r是互不相关的零均值系统白噪声和观测白噪声向量，q对应的系统噪声协方差阵为Q，r对应的观测噪声协方差阵为R；递推过程包括时间更新和测量更新，下面递推过程的前两步为时间更新，剩余的三步为测量更新；时间更新： 测量更新： 利用卡尔曼滤波状态量优化后的旋转变换矩阵为平移变换矩阵为定义激光雷达一帧点云数据中第i个激光点的原始坐标为则畸变矫正后的第i个激光点的坐标为计算公式如下；

如需购买、转让、实施、许可或投资类似专利技术，可联系本专利的申请人或专利权人东南大学，其通讯地址为：210096 江苏省南京市玄武区四牌楼2号；或者联系龙图腾网官方客服，联系龙图腾网可拨打电话0551-65771310或微信搜索“龙图腾网”。