的buildMap
函数接受激光雷达扫描读数和相关的姿势,以建立一个占用网格lidarScan
对象和相关(x yθ)
建立一个occupancyMap
.
装载扫描和姿态估计从传感器收集在一个停车场的机器人。将收集到的数据用lidarSLAM
算法,该算法执行扫描匹配,以关联扫描和调整整个机器人轨迹的姿态。检查以确保扫描和姿势是相同的长度。
负载scansAndPoses.mat长度(扫描)= =(姿势)
ans =逻辑1
构建地图。指定扫描和姿态buildMap
功能和包括所需的地图分辨率(10单元每米)和激光雷达的最大范围(19.2米)。每次扫描都在相关的姿势处添加,并更新占用网格中的概率值。
occMap = buildMap(扫描,姿势10 19.2);图显示(occMap)标题(《车库占用地图》)