Получите значение заполнения местоположений
occMatrix = getOccupancy(map,bottomLeft,matSize)
occMatrix = getOccupancy(map,bottomLeft,matSize,"local")
Создайте пустую бинарную карту сетки заполнения.
map = binaryOccupancyMap(10,10,20);
Введите положение транспортного средства, областей значений, углов и максимальной области значений лазерного сканирования.
pose = [5,5,0]; ranges = 3*ones(100,1); angles = linspace(-pi/2,pi/2,100); maxrange = 20;
Создайте lidarScan объект с заданными областями и углами.
scan = lidarScan(ranges,angles);
Вставьте лазерные данные сканирования в карту заполнения.
insertRay(map,pose,scan,maxrange);
Покажите карту, чтобы видеть результаты вставки лазерного сканирования.
show(map)
Проверяйте заполнение пятна непосредственно перед транспортным средством.
getOccupancy(map,[8 5])
ans = logical
1
Доступ к значениям заполнения и проверке их состояние заполнения на основе занятых и свободных порогов occupancyMap объект.
Создайте матрицу и заполните ее со значениями. Используйте эту матрицу, чтобы создать карту заполнения.
p = zeros(20,20); p(11:20,11:20) = ones(10,10); map = binaryOccupancyMap(p,10); show(map)
Получите заполнение других мест и проверяйте их состояния заполнения. Состояние заполнения возвращается 0 для свободного пространства и 1 для занятого места. Неизвестные значения возвращаются –1.
pocc = getOccupancy(map,[1.5 1]);
occupied = checkOccupancy(map,[1.5 1]);
pocc2 = getOccupancy(map,[5 5],'grid');