validatorOccupancyMap

Валидатор состояния на основе 2-D сетки

Описание

The validatorOccupancyMap объект проверяет состояния и дискретизированные движения на основе значения в карте заполнения 2-D. Расположение занятой карты интерпретируется как недопустимое состояние.

Создание

Синтаксис

Описание

validator = validatorOccupancyMap создает средство проверки карты заполнения 2-D, сопоставленное с пространством состояний SE2 с настройками по умолчанию.

пример

validator = validatorOccupancyMap(stateSpace) создает валидатор в заданном определении пространства состояний, полученном из nav.StateSpace.

validator = validatorOccupancyMap(stateSpace,Name,Value) задает Map или XYIndices свойства с использованием Name,Value аргументы в виде пар.

Свойства

расширить все

Пространство состояний для проверки состояний, заданное как подкласс nav.StateSpace. Предоставляемые космические объекты состояний включают:

Карта, используемая для проверки состояний, задается как binaryOccupancyMap или occupancyMap объект.

Интервал для дискретизации между состояниями и проверки валидности состояния, заданный как положительный числовой скаляр.

Отображение переменных состояний для xy -cordinates в векторе состояний, заданное как двухэлементный вектор, [xIdx yIdx]. Для примера, если вектор состояния задан как [r p y x y z], xy -координаты [4 5].

Функции объекта

copyСоздайте глубокую копию объекта валидатора состояний
isStateValidПроверьте, является ли состояние допустимым
isMotionValidПроверьте, действителен ли путь между состояниями

Примеры

свернуть все

В этом примере показано, как проверить пути через среду видимости.

Загрузите карты примера. Используйте простую карту, чтобы создать двоичную карту заполнения.

load exampleMaps.mat
map = occupancyMap(simpleMap);
show(map)

Figure contains an axes. The axes with title Occupancy Grid contains an object of type image.

Задайте грубый путь через карту.

path = [2 2 pi/2; 10 15 0; 17 8 -pi/2];
hold on
plot(path(:,1),path(:,2),"--o")

Figure contains an axes. The axes with title Occupancy Grid contains 2 objects of type image, line.

Создайте валидатор состояния, используя stateSpaceSE2 определение. Укажите карту и расстояние для интерполяции и проверки сегментов контура.

validator = validatorOccupancyMap(stateSpaceSE2);
validator.Map = map;
validator.ValidationDistance = 0.1;

Проверяйте, что точки пути являются допустимыми состояниями. Все три точки находятся в свободном пространстве, поэтому считаются действительными.

isValid = isStateValid(validator,path)
isValid = 3x1 logical array

   1
   1
   1

Проверяйте движение между каждыми последовательными состояниями пути. The isMotionValid функция интерполируется вдоль пути между состояниями. Если сегмент контура недопустим, постройте график последней допустимой точки вдоль пути.

startStates = [path(1,:);path(2,:)];
endStates = [path(2,:);path(3,:)];
    for i = 1:2
        [isPathValid, lastValid] = isMotionValid(validator,startStates(i,:),endStates(i,:));
        if ~isPathValid
            plot(lastValid(1),lastValid(2),'or')
        end
    end
hold off

Figure contains an axes. The axes with title Occupancy Grid contains 3 objects of type image, line.

Расширенные возможности

.
Введенный в R2019b
Для просмотра документации необходимо авторизоваться на сайте