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

龙图腾网获悉广东工业大学申请的专利一种激光雷达与加速度传感器结合的无人车建图方法获国家发明授权专利权，本发明授权专利权由国家知识产权局授予，授权公告号为：CN115540850B 。

龙图腾网通过国家知识产权局官网在2025-09-23发布的发明授权授权公告中获悉：该发明授权的专利申请号/专利号为：202211077055.3，技术领域涉及：G01C21/00；该发明授权一种激光雷达与加速度传感器结合的无人车建图方法是由孟伟;邹志键;陈浩冬;臧家瑶;杨远林设计研发完成，并于2022-09-05向国家知识产权局提交的专利申请。

本一种激光雷达与加速度传感器结合的无人车建图方法在说明书摘要公布了：本发明公开了一种激光雷达与加速度传感器结合的无人车建图方法，通过在无人车上安装激光雷达和加速度传感器，采集周围环境信息与无人车自身位姿信息；将无人车的位姿信息转换到世界坐标系下，通过无人车位姿的离散信息构建里程计数学模型；对里程计模型进行粒子滤波，将预测估计位姿与测量得到的位姿进行计算，求出噪声较小的无人车位姿，基于此生成的栅格地图；在生成的栅格地图下插入帧数点云数据，使用四叉树搜索算法找到局部最优匹配帧，再将得到的局部最优匹配帧进行一次点云对地图匹配得到更准确的全局匹配帧，利用这些全局匹配帧构建更精确的栅格地图。本方法可增强对长廊环境以及相似环境的建图效果，进而提高建图的精度。

本发明授权一种激光雷达与加速度传感器结合的无人车建图方法在权利要求书中公布了：1.一种基于加速度传感器与激光雷达融合构建地图的方法，其特征在于，包括以下步骤： 步骤1，首先在无人车的正前方安装加速度传感器，用于测量无人车的位姿；激光雷达安装在无人车的顶部，用于获取雷达点云数据； 将无人车放在待建图的道路上，启动无人车，无人车在行进的过程中，激光雷达与加速度传感器实时获取点云数据以及速度数据； 步骤2，根据采集到的速度数据，计算得到无人车在激光雷达坐标系下的位姿信息，然后利用坐标变换矩阵将以激光雷达坐标系下的位姿信息转换到世界坐标系下；在世界坐标系下，建立里程计模型： 步骤2.1，加速度传感器采集到的当前时刻i下无人车的速度数据根据下式计算在激光雷达坐标系下的无人车的位姿： Sx＝Sxi-1+Vx*Δt+ax*Δt2 上式中，Vx表示无人车投影到激光雷达坐标系x方向上行驶的速度，ax表示无人车投影到x方向上行驶的加速度，Δt表示测出Vx和ax的瞬时时间间隔，Sxi-1表示i-1时刻下投影到x轴的坐标，Sx表示i时刻下投影到x轴的坐标；i时刻下投影到y轴的坐标为Sy，则有从而得到激光雷达坐标系下i时刻无人车的位姿Sx,Sy,Sθ； 将得到的Sx,Sy,Sθ通过坐标变换从激光雷达坐标系下转化到世界坐标系下： 无人车在雷达坐标系下的位姿S以Sx,Sy,Sθ表示，那么它在世界坐标系的位姿为U＝Ux,Uy,UθT： 矩阵TU为正交旋转矩阵其中表示无人车的姿态角度，Ux表示无人车在世界坐标系下的横坐标，Uy表示无人车在世界坐标系下的纵坐标，Uθ表示无人车在世界坐标系下与横坐标的夹角； 步骤2.2，采样周期内无人车运动的路程长度Δs和旋转过的角度Δθ可以表示为： 式子中Δsr为无人车的右动力轮在采样间隔Δt时刻下走过的路程，Δsl为左动力轮在采样间隔Δt时刻下走过的路程；因此根据递推可以得到无人车从k时刻到k+1时刻估计位姿数学表达式，即里程计模型如下： 其中Zxk+1,Zyk+1,Zθk+1表示估计k+1时刻下无人车在世界坐标系下的横坐标、纵坐标以及与横坐标之间的夹角；Uxk,Uyk,Uθk表示k时刻无人车在世界坐标系下的位姿； 步骤3，对里程计模型进行粒子滤波处理，具体步骤为以下几步： 步骤3.1，通过式1可得到无人车在k时刻世界坐标系下的位姿估计k时刻下无人车的估计位姿Zk，根据式2和式3，Zk可以表示为 步骤3.2，根据下面式子，利用粒子滤波预测环境信息变化时，在k时刻无人车估计位姿的条件下，得到无人车测量位姿的概率pUk|Zk： 其中表示无人车在k时刻抽取的第i个粒子，一共抽取N个粒子，狄拉克函数用σ.表示，代表了归一化粒子的重要权值，取 步骤3.3，根据步骤3.2得到的概率pUk|Zk与步骤3.1得到的Uk和Zk，通过以下公式计算得到滤波后k时刻的无人车位姿态Pk： Pk＝A*Uk+B*Zk-pUk|Zk*Uk5 上式中，A表示测量值的超参数，B表示估计值与测量概率处理过的测量值作差的超参数；相比Uk，滤波处理后的Pk更接近无人车的实际位姿；Pk可以表示为 步骤3.4，重复步骤3.1，3.2和步骤3.3，生成各个时刻下滤波后的无人车位姿集合，这些位姿的集合按运动的时间进行连接构建出栅格地图； 步骤4，构建全局地图 步骤4.1，在生成的栅格地图插入设定好帧数的点云数据，点云数据来自于步骤1雷达采集的点云数据，采用四叉树搜索算法，以深度优先为原则，对栅格地图进行简化，通过引入无人车位姿方向上激光扫描点所对应栅格点的占有概率值Mnearest，降低搜索算法的时间复杂度；Mnearest计算方式如式7，上述过程的数学表示如下： 式6中W代表搜索空间也即生成的栅格地图，Mnearest表示无人车位姿方向上激光扫描点所对应栅格点的占有概率值，ξ表示栅格，Tξ表示栅格的一个点云坐标，其中下标ξ∈W表示遍历栅格地图的所有栅格；K表示构建栅格地图的总时刻，hk表示k时刻下Tξ所表示点云坐标在栅格地图的权重值，参数a,b∈0,1，ξ*表示栅格地图搜索的局部最优匹配帧； 步骤4.2，在使用四叉树搜索算法找到局部最优匹配帧之后，在得到的局部最优匹配帧插入步骤1激光雷达获取到的点云数据，将点云数据与局部最优匹配帧按采集时间顺序进行注册，从而得到出全局最优关键帧； 步骤4.3，重复步骤4.1和步骤4.2，当插入的点云数据达到完全覆盖栅格的时候，就构出了一个以全局匹配帧为基础的更加精确的栅格地图。

如需购买、转让、实施、许可或投资类似专利技术，可联系本专利的申请人或专利权人广东工业大学，其通讯地址为：510062 广东省广州市越秀区东风东路729号；或者联系龙图腾网官方客服，联系龙图腾网可拨打电话0551-65771310或微信搜索“龙图腾网”。