Путь более сглаженный сплайн

Сглаженный путь к автомобилю с помощью интерполяции кубическим сплайном

Библиотека:
Automated Driving Toolbox

Описание

Блок Path Smoother Spline генерирует сглаженный путь к автомобилю, состоя из последовательности дискретизированных положений, путем подбора кривой входным положениям пути к ссылке к кубическому сплайну. Учитывая входные направления контура ссылки, блок также возвращает направления, которые соответствуют каждому положению.

Используйте этот блок, чтобы преобразовать путь ^{C1-continuous} к пути ^{C2-continuous}. Пути ^{C1-continuous} включают пути Dubins или Reeds-Shepp, которые возвращены планировщиками пути. Для получения дополнительной информации на этих типах пути, см. C1-Continuous и Пути C2-Continuous.

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

Порты

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

развернуть все

`RefPoses` — Ссылочные положения
M-by-3 матрица [x, y, Θ] векторы

Ссылочные положения автомобиля вдоль пути, заданного как M-by-3 матрица [x, y, Θ] векторы, где M является количеством положений.

x и y задают местоположение автомобиля в метрах. Θ задает угол ориентации автомобиля в градусах.

Типы данных: single | double

`RefDirections` — Ссылочные направления
M-by-1 вектор-столбец 1 с (движение вперед) и –1s (инвертируют движение),

Ссылочные направления автомобиля вдоль пути, заданного как M-by-1 вектор-столбец 1 с (движение вперед) и –1s (инвертируют движение). M является количеством ссылочных направлений. Каждый элемент RefDirections соответствует положению во входном порту RefPoses.

Типы данных: single | double

Вывод

развернуть все

`Poses` — Дискретизированные положения сглаживавшего пути
N-by-3 матрица [x, y, Θ] векторы

Дискретизированные положения сглаживавшего пути, возвращенного как N-by-3 матрица [x, y, Θ] векторы. N является количеством положений, заданных в параметре Number of output poses.

x и y задают местоположение автомобиля в метрах. Θ задает угол ориентации автомобиля в градусах.

Значения в Poses имеют совпадающий тип данных как значения во входном порту RefPoses.

`Directions` — Направления движения в каждом выходном положении
N-by-1 вектор-столбец 1 с (движение вперед) и –1s (инвертируют движение),

Направления движения при каждом выводе позируют в Poses, возвращенном как N-by-1 вектор-столбец 1 с (движение вперед) и –1s (противоположное движение). N является количеством положений, заданных в параметре Number of output poses.

Значения в Directions имеют совпадающий тип данных как значения во входном порту RefDirections.

`CumLength` — Совокупные длины пути
N-by-1 вектор-столбец с действительным знаком

Совокупные длины пути при каждом выводе позируют в Poses, возвращенном как N-by-1 вектор-столбец с действительным знаком. N является количеством положений, заданных в параметре Number of output poses. Модули исчисляются в метрах.

Можно использовать CumLength и Curvatures выходные параметры, чтобы сгенерировать профиль скорости автомобиля вдоль сглаженного пути. Для получения дополнительной информации смотрите, что Автоматизированный Оставляет Камердинера в примере Simulink.

Зависимости

Чтобы включить этот порт, выберите параметр Show CumLength and Curvatures output ports.

`Curvatures` — Искривления пути со знаком
N-by-1 вектор-столбец с действительным знаком

Искривления пути со знаком при каждом выводе позируют в Poses, возвращенном как N-by-1 вектор-столбец с действительным знаком. N является количеством положений, заданных в параметре Number of output poses. Модули исчисляются в радианах на метр.

Можно использовать Curvatures и CumLength выходные параметры, чтобы сгенерировать профиль скорости автомобиля вдоль сглаженного пути. Для получения дополнительной информации смотрите, что Автоматизированный Оставляет Камердинера в примере Simulink.

Зависимости

Чтобы включить этот порт, выберите параметр Show CumLength and Curvatures output ports.

Параметры

развернуть все

`Number of output poses` — Количество сглаженных положений, чтобы возвратиться
`100` (значение по умолчанию) | положительное целое число

Количество сглаженных положений, чтобы возвратиться в выходном порту Poses, заданном как положительное целое число. Чтобы увеличить гранулярность возвращенных положений, увеличьте это значение параметров.

`Minimum separation of input poses` — Минимальное разделение между положениями
`1e-3` (значение по умолчанию) | положительный действительный скаляр

Минимальное разделение между положениями, в метрах, заданных как положительный действительный скаляр. Если Евклидово (x, y) расстояние между двумя положениями является меньше, чем это значение, то блок использует только одно из этих положений для интерполяции.

`'SampleTime'` 'SampleTime'
`-1` (значение по умолчанию) | положительный действительный скаляр

Шаг расчета блока, в секундах, заданных как -1 или как положительный действительный скаляр. Значение по умолчанию -1 означает, что блок наследовал свой шаг расчета от восходящих блоков.

`Show CumLength and Curvatures output ports` — Выведите совокупные длины пути и искривления
от (значения по умолчанию) | на

Выберите этот параметр, чтобы включить выходные порты Curvatures и CumLength.

`Simulate using` — Тип симуляции, чтобы запуститься
`Code Generation` (значение по умолчанию) | `Interpreted Execution`

Code generation — Моделируйте модель с помощью сгенерированного кода C. В первый раз, когда вы запускаете симуляцию, Simulink^® генерирует код С для блока. Код С снова используется для последующих симуляций, пока модель не изменяется. Эта опция требует дополнительного времени запуска.
Interpreted execution — Моделируйте модель с помощью интерпретатора MATLAB^®. Эта опция сокращает время запуска. В режиме Interpreted execution можно отладить исходный код блока.

Образцовые примеры

Автоматизированный камердинер парковки в Simulink

Создайте автоматизированную систему камердинера парковки в Simulink с Automated Driving Toolbox™.

Открытая модель

Больше о

развернуть все

^{C1-Continuous} и пути ^{C2-Continuous}

Путь является ^{C1-continuous}, если его производная существует и непрерывна. Пути, которые являются только ^{C1-continuous}, имеют разрывы в своем искривлении. Например, путь, состоявший из сегментов пути Dubins или Reeds-Sheep, имеет разрывы в искривлении в точках, где сегменты присоединяются. Эти разрывы приводят к изменениям направления, которые не достаточно сглаженны для управления с пассажирами.

Путем является также ^{C2-continuous}, если его вторая производная существует и непрерывна. Пути ^{C2-continuous} имеют непрерывное искривление и достаточно сглаженны для управления с пассажирами.

Алгоритмы

Алгоритм сглаживания пути интерполирует параметрический кубический сплайн, который проходит через все входные точки положения ссылки. Параметр сплайна является совокупной длиной хорды в этих точках. [1]
Направление касательной сглаживавшего вывода path приблизительно совпадает с углом ориентации автомобиля при запуске и целевых положениях.

Ссылки

[1] Плавающий предмет, Майкл С. "На Отклонении Параметрического Кубического Сплайна Interpolant от Его Полигона Данных". Компьютер помог Геометрическому Проекту. Издание 25, Номер 3, 2008, стр 148–156.

[2] Lepetic, Марко, Грегор Клэнкэр, Игорь Скрянк, Драго Матко и Бостджэн Потокник. "Время Оптимальное Планирование пути, Рассматривая Ускоряющие Пределы". Робототехника и Автономные системы. Издание 45, Числа 3-4, 2003, стр 199–210.

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

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

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

Функции

smoothPathSpline

Блоки

Боковой диспетчер Стэнли | Продольный диспетчер Стэнли

Документация

Путь более сглаженный сплайн

Описание

Порты

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

`RefPoses` — Ссылочные положения
M-by-3 матрица [x, y, Θ] векторы

`RefDirections` — Ссылочные направления
M-by-1 вектор-столбец 1 с (движение вперед) и –1s (инвертируют движение),

Вывод

`Poses` — Дискретизированные положения сглаживавшего пути
N-by-3 матрица [x, y, Θ] векторы

`Directions` — Направления движения в каждом выходном положении
N-by-1 вектор-столбец 1 с (движение вперед) и –1s (инвертируют движение),

`CumLength` — Совокупные длины пути
N-by-1 вектор-столбец с действительным знаком

Зависимости

`Curvatures` — Искривления пути со знаком
N-by-1 вектор-столбец с действительным знаком

Зависимости

Параметры

`Number of output poses` — Количество сглаженных положений, чтобы возвратиться
`100` (значение по умолчанию) | положительное целое число

`Minimum separation of input poses` — Минимальное разделение между положениями
`1e-3` (значение по умолчанию) | положительный действительный скаляр

`'SampleTime'` 'SampleTime'
`-1` (значение по умолчанию) | положительный действительный скаляр

`Show CumLength and Curvatures output ports` — Выведите совокупные длины пути и искривления
от (значения по умолчанию) | на

`Simulate using` — Тип симуляции, чтобы запуститься
`Code Generation` (значение по умолчанию) | `Interpreted Execution`

Образцовые примеры

Автоматизированный камердинер парковки в Simulink

Больше о

^{C1-Continuous} и пути ^{C2-Continuous}

Алгоритмы

Ссылки

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

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

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

Функции

Блоки

Введенный в R2019a

Документация Automated Driving Toolbox

Поддержка

Документация

Путь более сглаженный сплайн

Описание

Порты

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

RefPoses — Ссылочные положения M-by-3 матрица [x, y, Θ] векторы

RefDirections — Ссылочные направления M-by-1 вектор-столбец 1 с (движение вперед) и –1s (инвертируют движение),

Вывод

Poses — Дискретизированные положения сглаживавшего пути N-by-3 матрица [x, y, Θ] векторы

Directions — Направления движения в каждом выходном положении N-by-1 вектор-столбец 1 с (движение вперед) и –1s (инвертируют движение),

CumLength — Совокупные длины пути N-by-1 вектор-столбец с действительным знаком

Зависимости

Curvatures — Искривления пути со знаком N-by-1 вектор-столбец с действительным знаком

Зависимости

Параметры

Number of output poses — Количество сглаженных положений, чтобы возвратиться 100 (значение по умолчанию) | положительное целое число

Minimum separation of input poses — Минимальное разделение между положениями 1e-3 (значение по умолчанию) | положительный действительный скаляр

'SampleTime' 'SampleTime' -1 (значение по умолчанию) | положительный действительный скаляр

Show CumLength and Curvatures output ports — Выведите совокупные длины пути и искривления от (значения по умолчанию) | на

Simulate using — Тип симуляции, чтобы запуститься Code Generation (значение по умолчанию) | Interpreted Execution

Образцовые примеры

Автоматизированный камердинер парковки в Simulink

Больше о

C1-Continuous и пути C2-Continuous

Алгоритмы

Ссылки

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

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

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

Функции

Блоки

Введенный в R2019a

Документация Automated Driving Toolbox

Поддержка

`RefPoses` — Ссылочные положения
M-by-3 матрица [x, y, Θ] векторы

`RefDirections` — Ссылочные направления
M-by-1 вектор-столбец 1 с (движение вперед) и –1s (инвертируют движение),

`Poses` — Дискретизированные положения сглаживавшего пути
N-by-3 матрица [x, y, Θ] векторы

`Directions` — Направления движения в каждом выходном положении
N-by-1 вектор-столбец 1 с (движение вперед) и –1s (инвертируют движение),

`CumLength` — Совокупные длины пути
N-by-1 вектор-столбец с действительным знаком

`Curvatures` — Искривления пути со знаком
N-by-1 вектор-столбец с действительным знаком

`Number of output poses` — Количество сглаженных положений, чтобы возвратиться
`100` (значение по умолчанию) | положительное целое число

`Minimum separation of input poses` — Минимальное разделение между положениями
`1e-3` (значение по умолчанию) | положительный действительный скаляр

`'SampleTime'` 'SampleTime'
`-1` (значение по умолчанию) | положительный действительный скаляр

`Show CumLength and Curvatures output ports` — Выведите совокупные длины пути и искривления
от (значения по умолчанию) | на

`Simulate using` — Тип симуляции, чтобы запуститься
`Code Generation` (значение по умолчанию) | `Interpreted Execution`

^{C1-Continuous} и пути ^{C2-Continuous}

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