Вычислите гладкость, разрешение и валидность запланированного пути на основе набора положений и связанной среды карты.
Загрузите и присвойте карту блоку проверки допустимости состояния
Создайте карту заполнения из карты в качестве примера и установите разрешение карты.
Создайте пространство состояний Dubins.
Создайте блок проверки допустимости состояния на основе карты заполнения, чтобы сохранить параметры и состояния в пространстве состояний Dubins.
Присвойте карту блоку проверки допустимости.
Установите расстояние валидации для блока проверки допустимости.
Обновите границы пространства состояний, чтобы совпасть с пределами карты.
Запланируйте путь
Создайте RRT* планировщик пути и позвольте дальнейшую оптимизацию.
Сократите максимальное количество итераций и увеличьте максимальное расстояние связи.
Задайте запускаются и целевые состояния для планировщика пути как [
x, y, theta]
векторы. X и Y являются Декартовы координаты, и тета является углом ориентации.
Запланируйте путь от начального состояния до целевого состояния. Функция плана возвращает navPath
объект.
Вычислите и визуализируйте метрики пути
Создайте метрический объект пути.
Проверяйте валидность пути. Результатом является 1 (true)
если запланированный путь является свободным препятствием. 0 (false)
указывает на недопустимый путь.
Вычислите минимальное разрешение пути.
Оцените гладкость пути. Значения близко к 0
укажите на более сглаженный путь. Прямолинейные пути возвращают значение 0
.
Визуализируйте минимальное разрешение пути.