Класс: робототехника. OccupancyGrid
Пакет: робототехника
Вычислите индексы ячейки вдоль луча
[endpoints,midpoints]
= raycast(map,pose,range,angle)[endpoints,midpoints]
= raycast(map,p1,p2)[ возвращает индексы ячейки заданного endpoints,midpoints]
= raycast(map,pose,range,angle)map для всех ячеек, пересеченных лучом, происходящим из заданного pose в заданном angle и значениях range. endpoints содержит все индексы, затронутые к концу луча со всеми другими точками, включенными в midpoints.
Используйте метод raycast, чтобы сгенерировать индексы ячейки для всех ячеек, пересеченных лучом.
Создайте пустую карту. С низким разрешением карта используется, чтобы проиллюстрировать влияние местоположений сетки.
map = robotics.OccupancyGrid(10,10,1); show(map)
Получите индексы сетки средних точек и конечные точки луча от p1 до p2. Установите значения заполнения для этих индексов сетки. Средние точки обработаны как открытое пространство. Конечные точки обновляются с занятым наблюдением.
p1 = [2 3]; p2 = [8.5 8]; [endPts,midPts] = raycast(map,p1,p2); setOccupancy(map,midPts,zeros(length(midPts),1),'grid'); setOccupancy(map,endPts,ones(length(endPts),1),'grid');
Постройте исходный луч по карте. Заметьте, что каждая ячейка сетки, затронутая строкой, обновляется. Отправная точка перекрывает несколько ячеек, и строка касается ребра определенных ячеек, но все ячейки все еще обновляются.
show(map) hold on plot([p1(1) p2(1)],[p1(2) p2(2)],'-b','LineWidth',2) plot(p2(1),p2(2),'or') grid on
robotics.BinaryOccupancyGrid | robotics.OccupancyGrid | robotics.OccupancyGrid.insertray