一种2D激光雷达SLAM地图动态加载方法及系统与流程

文档序号:26001087发布日期:2021-07-23 21:17阅读:来源:国知局

技术特征:

1.一种2d激光雷达slam地图动态加载方法,其特征在于,包括:

步骤1,根据2d激光雷达slam地图存储的地图图片上所包含的坐标系信息、比例尺分辨率与选定角点像素信息,得到全局坐标x-y与图像坐标u-v中任意点的转换矩阵m;

步骤2,将所述地图图片按照n行m列划分为若干子地图gi,每个子地图gi的图像宽度和高度分别为wi、hi;并利用转换矩阵m,子地图gi中点j的像素坐标对应的全局坐标由式(4)获得:

其中,col(gi)表示子地图gi在划分好的所述地图图片所对应的列的值,row(gi)表示子地图gi在划分好的所述地图图片所对应行的值,wk表示第k个子地图gk的图像宽度,k小于col(gi),hl表示第l个子地图gl的图像高度,l小于row(gi);

步骤3,根据划分好的子地图,动态加载子地图。

2.如权利要求1所述的2d激光雷达slam地图动态加载方法,其特征在于,所述步骤3具体包括:

步骤31,通过图结构描述步骤2划分好的各所述子地图之间的相对位置和连接关系,所述图结构包括节点和边,其中,一个所述节点对应一个所述子地图,记为子地图节点,一条所述边对应两个所述子地图之间的存在连通道路;

步骤32,通过邻接矩阵方式描述所述图结构,所述邻接矩阵中的(n×m)行和(n×m)列的每一行和每一列对应设置为一个所述子地图节点的通行状态向量,每一所述通行状态向量包括预设数量的元素,每一所述元素通过两种可区分的符号,来表征其所在所述通行状态向量对应的行和列的两个所述子地图节点之间是否存在所述边;

步骤33,依据当前车辆行驶方向,搜索车辆当前处的第一子地图节点所在所述邻接矩阵的行或列中是否存在满足当前行驶方向的元素及该元素对应的子地图节点,如果存在,则进行预加载;如果不存在,则不加载。

3.如权利要求2所述的2d激光雷达slam地图动态加载方法,其特征在于,所述两种可区分的符号为0和1,其中,0表示该元素所在所述通行状态向量对应的行和列的两个所述子地图节点之间不存在所述边,1表示该元素所在所述通行状态向量对应的行和列的两个所述子地图节点之间存在所述边。

4.如权利要求2或3所述的2d激光雷达slam地图动态加载方法,其特征在于,所述步骤3具体还包括:

步骤34,当由于行驶方向的变化导致可能的后继子地图节点变化时,将释放掉之前的预加载地图节点,再加载此时可能的后继子地图节点,并返回步骤33。

5.如权利要求4所述的2d激光雷达slam地图动态加载方法,其特征在于,所述步骤3具体还包括:

步骤35,当车辆由所述第一子地图节点进入到所述后继子地图节点后,切换并加载所述后继子地图节点为当前的所述子地图节点,并释放掉所述第一子地图节点。

6.如权利要求2至5中任意一项所述的2d激光雷达slam地图动态加载方法,其特征在于,所述步骤3具体还包括:

步骤36,在步骤33同时预加载多个子地图节点的情形下,选取车辆的当前行驶朝向θ与预加载多个子地图节点所对应的预设联通方向夹角最小的子地图节点,作为后续可能行驶的子地图节点。

7.一种2d激光雷达slam地图动态加载系统,其特征在于,包括:

转换矩阵获取装置,其用于根据2d激光雷达slam地图存储的地图图片上所包含的坐标系信息、比例尺分辨率与选定角点像素信息,得到全局坐标x-y与图像坐标u-v中任意点的转换矩阵m;

地图划分装置,其用于将地图图片按照n行m列划分为若干子地图gi,每个子地图gi尺寸为(wi,hi),其中,wi表示第i个子地图gi的图像宽度,hi表示第i个子地图gi的图像高度,并利用转换矩阵m,对于任意子地图gi中任意一点j的像素坐标对应的全局坐标计算式描述为式(4):

其中,col(gi)表示子地图gi在划分好的所述地图图片所对应的列的值,row(gi)表示子地图gi在划分好的所述地图图片所对应行的值,wk表示第k个子地图gk的图像宽度,k小于col(gi),hl表示第l个子地图gl的图像高度,l小于row(gi);

动态加载子地图装置,其用于根据划分好的子地图,动态加载子地图。

8.如权利要求6所述的2d激光雷达slam地图动态加载系统,其特征在于,所述动态加载子地图装置具体包括:

图结构描述单元,其用于通过图结构描述划分好的各所述子地图之间的相对位置和连接关系,所述图结构包括节点和边,其中,一个所述节点对应一个所述子地图,记为子地图节点,一条所述边对应两个所述子地图之间的存在连通道路;

邻接矩阵描述单元,其用于通过邻接矩阵方式描述所述图结构,所述邻接矩阵中的(n×m)行和(n×m)列的每一行和每一列对应设置为一个所述子地图节点的通行状态向量,每一所述通行状态向量包括预设数量的元素,每一所述元素通过两种可区分的符号,来表征其所在所述通行状态向量对应的行和列的两个所述子地图节点之间是否存在所述边;

子地图加载单元,其用于依据当前车辆行驶方向,搜索车辆当前处的第一子地图节点所在所述邻接矩阵的行或列中是否存在满足当前行驶方向的元素及该元素对应的子地图节点,如果存在,则进行预加载;如果不存在,则不加载;当由于行驶方向的变化导致可能的后继子地图节点变化时,将释放掉之前的预加载地图节点,再加载此时可能的后继子地图节点;当车辆由所述第一子地图节点进入到所述后继子地图节点后,切换并加载所述后继子地图节点为当前的所述子地图节点,并释放掉所述第一子地图节点;同时预加载多个子地图节点的情形下,选取车辆的当前行驶朝向θ与预加载多个子地图节点所对应的预设联通方向夹角最小的子地图节点,作为后续可能行驶的子地图节点。

9.如权利要求8所述的2d激光雷达slam地图动态加载系统,其特征在于,所述两种可区分的符号为0和1,其中,0表示该元素所在所述通行状态向量对应的行和列的两个所述子地图节点之间不存在所述边,1表示该元素所在所述通行状态向量对应的行和列的两个所述子地图节点之间存在所述边。


技术总结
本发明公开了一种2D激光雷达SLAM地图动态加载方法及系统,该方法包括:步骤1,根据2D激光雷达SLAM地图存储的地图图片上所包含的坐标系信息、比例尺分辨率与选定角点像素信息,得到全局坐标x‑y与图像坐标u‑v中任意点的转换矩阵M;步骤2,将所述地图图片按照n行m列划分为若干子地图Gi,每个子地图Gi的图像宽度和高度分别为wi、hi;并利用转换矩阵M,获得子地图Gi中点j的像素坐标对应的全局坐标;步骤3,根据划分好的子地图,动态加载子地图。本发明每次仅加载地图的一部分,并根据行驶的位置,动态加载剩余的地图,因此能够减少系统资源的消耗,使得应用场景更加广泛。

技术研发人员:王雷;王更泽;王毅
受保护的技术使用者:紫清智行科技(北京)有限公司
技术研发日:2021.05.17
技术公布日:2021.07.23
当前第2页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1