plan

Запланируйте оптимальную траекторию

Описание

пример

[traj,index,cost,flag] = plan(planner,start) вычисляет выполнимую траекторию, traj, из списка траекторий кандидата, сгенерированных от trajectoryOptimalFrenet объект, plannerзапуск задан как векторный [s, ds/dt, d2s/dt2, l, dl/ds, d2l/ds2] с шестью элементами, где s является длиной дуги от первой точки в ссылочном пути, и l является нормальным расстоянием от самой близкой точки в s на ссылочном пути.

Выходная траектория, traj, также имеет связанный cost и index для свойства TrajectoryList планировщика. flag числовое выходное состояние указания флага решения.

Чтобы улучшить результаты планирования выход, измените параметры на planner объект.

Примеры

свернуть все

В этом примере показано, как запланировать оптимальную траекторию с помощью trajectoryOptimalFrenet объект.

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

Создайте объект блока проверки допустимости состояния для проверки столкновения.

stateValidator = validatorOccupancyMap;

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

grid = zeros(50,100);
grid(24:26,48:53) = 1;

Создайте binaryOccupancyMap с картой сетки.

map = binaryOccupancyMap(grid);

Присвойте карту блоку проверки допустимости состояния.

stateValidator.Map = map;

Запланируйте и визуализируйте траекторию

Создайте ссылочный путь для планировщика, чтобы следовать.

refPath = [0,25;100,25];

Объявите, что указатель функции стоимости приоритизирует оставленный изменения маршрута.

leftLaneChangeCost = @(states)((states(end,2) < refPath(end,2))*10);

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

planner = trajectoryOptimalFrenet(refPath,stateValidator,'CostFunction',leftLaneChangeCost);

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

planner.TerminalStates.Longitudinal = 100;
planner.TerminalStates.Lateral = -10:10:10;
planner.FeasibilityParameters.MaxAcceleration = 10;

Планирование траектории

Начальное состояние Frenet транспортного средства.

initFrenetState = zeros(1,6);

Запланируйте траекторию от начального состояния Frenet.

plan(planner,initFrenetState);

Визуализация траектории

Визуализируйте карту и траектории.

show(map)
hold on
show(planner,'Trajectory','all')

В этом примере показано, как разделить продольные конечные состояния в оптимальном планировании траектории с помощью trajectoryOptimalFrenet объект.

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

Создайте объект блока проверки допустимости состояния для проверки столкновения.

statevalidator = validatorOccupancyMap; 

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

grid = zeros(50,100);
grid(22:24,28:33) = 1;
grid(18:20,37:42) = 1;
grid(29:31,72:77) = 1;

Создайте binaryOccupancyMap с картой сетки.

map = binaryOccupancyMap(grid);

Присвойте карту блоку проверки допустимости состояния.

statevalidator.Map = map; 

Запланируйте и визуализируйте траекторию

Создайте ссылочный путь для планировщика, чтобы следовать.

refPath = [0,25;30,30;75,20;100,25];

Инициализируйте объект планировщика ссылочным путем и блок проверки допустимости состояния.

planner = trajectoryOptimalFrenet(refPath,statevalidator);

Присвойте продольное конечное состояние и максимальные ускоряющие значения.

planner.TerminalStates.Longitudinal = 100;
planner.FeasibilityParameters.MaxAcceleration = 10;

Планирование траектории

Начальное состояние Frenet транспортного средства.

initFrenetState = zeros(1,6);

Присвойте номер разделов для продольного конечного состояния.

planner.NumSegments = 3; 

Запланируйте траекторию от начального состояния Frenet.

plan(planner,initFrenetState);

Визуализация траектории

Визуализируйте карту и траектории.

show(map)
hold on
show(planner,'Trajectory','all')

Входные параметры

свернуть все

Оптимальный планировщик траектории на пробеле Frenet в виде trajectoryOptimalFrenet объект.

Начальное состояние Frenet в виде 1 6 векторного [s, ds/dt, d2s/dt2, l, dl/ds, d2l/ds2].

  • s задает длину дуги от первой точки в ссылочном пути в метрах.

  • ds/dt задает первую производную длины дуги.

  • d2s/dt2 задает вторую производную длины дуги.

  • l задает нормальное расстояние от самой близкой точки в ссылочном пути в метрах.

  • dl/ds задает первую производную нормального расстояния.

  • d2l/ds2 задает вторую производную нормального расстояния.

Выходные аргументы

свернуть все

Выполнимая траектория с минимальной стоимостью, возвращенной как n-by-7 матрица [x, y, theta, kappa, speed, acceleration, time], где n является количеством траектории waypoints.

  • x и y задают положение в метрах.

  • theta задает угол ориентации в радианах.

  • kappa задает искривление в m-1.

  • speed задает скорость в m/s.

  • acceleration задает ускорение в m/s2.

  • time задает время в s.

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

Наименьшее количество стоимости выполнимой траектории, возвращенной как положительная скалярная величина.

Выйдите из флага, указывающего на состояние решения, возвратил любого как 0 или 1.

  • 0 — Оптимальная траектория была найдена.

  • 1 — Никакая выполнимая траектория не существует.

Когда никакая выполнимая траектория не существует, планировщик возвращает пустую траекторию.

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

Генерация кода C/C++
Генерация кода C и C++ с помощью MATLAB® Coder™.

Смотрите также

|

Введенный в R2019b

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