Сгенерируйте траектории пятого порядка
[ генерирует полином пятого порядка, который достигает заданного множества входа путевых точек с соответствующими временными точками. Функция выводит положения, скорости и ускорения в заданные временные выборки, q,qd,qdd,pp] = quinticpolytraj(wayPoints,timePoints,tSamples)tSamples. Функция также возвращает кусочный полином pp форма полиномиальной траектории относительно времени.
[ задает дополнительные параметры следующим q,qd,qdd,pp] = quinticpolytraj(___,Name,Value)Name,Value пара аргументов с использованием любой комбинации предыдущих синтаксисов.
Используйте quinticpolytraj функция с заданным набором 2-D точек пути xy. Также приведены временные моменты для путевых точек.
wpts = [1 4 4 3 -2 0; 0 1 2 4 3 1]; tpts = 0:5;
Задайте временной вектор для выборки траектории. Выборка с меньшим интервалом, чем заданный временными точками.
tvec = 0:0.01:5;
Вычислите квинтовую траекторию. Функция выводит положения траектории (q), скорость (qd), ускорение (qdd) и полиномиальные коэффициенты (pp) квинтового полинома.
[q, qd, qdd, pp] = quinticpolytraj(wpts, tpts, tvec);
Постройте график квинтовых траекторий для x- и y-положений. Сравните траекторию с каждой путевой точкой.
plot(tvec, q) hold all plot(tpts, wpts, 'x') xlabel('t') ylabel('Positions') legend('X-positions','Y-positions') hold off
Можно также проверить фактические положения в 2-D плоскости. Постройте график отдельных строк q вектор и точки пути как положения x - и y -.
figure plot(q(1,:),q(2,:),'.b',wpts(1,:),wpts(2,:),'or') xlabel('X') ylabel('Y')
bsplinepolytraj | cubicpolytraj | rottraj | transformtraj | trapveltraj