Создайте карту заполнения из сканирований лидара и положений

buildMap функционируйте берет в показаниях сканирования лидара и сопоставленных положениях, чтобы создать сетку заполнения как lidarScan объекты и сопоставленный [x y theta] положения, чтобы создать occupancyMap.

Загрузите сканирование и оценки положения, собранные из датчиков на роботе в гараже. Собранные данные сопоставляются с помощью lidarSLAM алгоритм, который выполняет сканирование, соответствующее, чтобы сопоставить сканирования и настроить положения по полной траектории робота. Проверяйте, чтобы убедиться, сканирования и положения являются той же длиной.

load scansAndPoses.mat
length(scans) == length(poses)

ans = logical
   1

Создайте карту. Задайте сканирования и положения в buildMap функционируйте и включайте желаемое разрешение карты (10 ячеек на метр) и макс. область значений лидара (19,2 метров). Каждое сканирование добавляется в связанных положениях, и значения вероятности в сетке заполнения обновляются.

occMap = buildMap(scans,poses,10,19.2);
figure
show(occMap)
title('Occupancy Map of Garage')