quinticpolytraj

5 次軌跡の生成

構文

[q,qd,qdd,pp] = quinticpolytraj(wayPoints,timePoints,tSamples)

[q,qd,qdd,pp] = quinticpolytraj(___,Name,Value)

説明

[q,qd,qdd,pp] = quinticpolytraj(wayPoints,timePoints,tSamples) は、指定された一連の入力ウェイポイントと対応する時間点を通る 5 次多項式を生成します。この関数は、指定された時間サンプル tSamples における位置、速度、および加速度を出力します。また、この関数は、時間に対する多項式軌跡の区分的多項式 pp も返します。

[q,qd,qdd,pp] = quinticpolytraj(___,Name,Value) は、前述の構文の任意の組み合わせを使用し、Name,Value のペアの引数として追加パラメーターを指定します。

例

2 次元平面運動の 5 次軌跡の計算

一連の 2 次元 "xy" ウェイポイントを指定して、関数 quinticpolytraj を使用します。ウェイポイントの時間点も指定します。

wpts = [1 4 4 3 -2 0; 0 1 2 4 3 1];
tpts = 0:5;

軌跡をサンプリングする時間ベクトルを指定します。指定した時間点よりも短い間隔でサンプリングします。

tvec = 0:0.01:5;

5 次軌跡を計算します。関数は、5 次多項式の軌跡の位置 (q)、速度 (qd)、加速度 (qdd)、および多項式係数 (pp) を出力します。

[q,qd,qdd,pp] = quinticpolytraj(wpts,tpts,tvec);

"x" 位置および "y" 位置の 5 次軌跡をプロットします。軌跡を各ウェイポイントと比較します。

plot(tvec,q)
hold on
scatter(tpts,wpts)
xlabel("Time")
ylabel("Positions")
legend("X-positions","Y-positions")
title(["Quintic Trajectory","X- and Y-Positions"])
axis padded
hold off

2 次元平面における実際の位置も確認できます。q ベクトルとウェイポイントの個別の行を、"x" 位置および "y" 位置としてプロットします。

figure
plot(q(1,:),q(2,:),".",LineWidth=0.10)
hold on
scatter(wpts(1,:),wpts(2,:))
xlabel("X")
ylabel("Y")
title("Quintic Trajectory")
axis padded
hold off

入力引数

wayPoints — 軌跡のウェイポイント

n 行 p 列の行列

軌跡のウェイポイントを表す点。n 行 p 列の行列として指定します。ここで、n は軌跡の次元で、p はウェイポイントの数です。

例: [1 4 4 3 -2 0; 0 1 2 4 3 1]

データ型: single | double

timePoints — 軌跡のウェイポイントの時間点

p 要素ベクトル

軌跡のウェイポイントの時間点。p 要素ベクトルとして指定します。

例: [0 2 4 5 8 10]

データ型: single | double

tSamples — 軌跡の時間サンプル

m 要素ベクトル

軌跡の時間サンプル。m 要素ベクトルとして指定します。出力の位置 q、速度 qd、および加速度 qdd は、これらの時間間隔でサンプリングされます。

例: 0:0.01:10

データ型: single | double

名前と値の引数

オプションの引数のペアを Name1=Value1,...,NameN=ValueN として指定します。ここで、Name は引数名で、Value は対応する値です。名前と値の引数は他の引数の後に指定しなければなりませんが、ペアの順序は重要ではありません。

R2021a より前では、コンマを使用して名前と値をそれぞれ区切り、Name を引用符で囲みます。

例: 'VelocityBoundaryCondition',[1 0 -1 -1 0 0; 1 1 1 -1 -1 -1]

VelocityBoundaryCondition — 各ウェイポイントの速度境界条件

zeroes(n,p) (既定値) | n 行 p 列の行列

各ウェイポイントの速度境界条件。'VelocityBoundaryCondition' と n 行 p 列の行列からなるコンマ区切りのペアとして指定します。各行は、軌跡の各変数についての p 個のすべてのウェイポイントにおける速度に対応します。

例: [1 0 -1 -1 0 0; 1 1 1 -1 -1 -1]

データ型: single | double

AccelerationBoundaryCondition — 各ウェイポイントの加速度境界条件

zeroes(n,p) (既定値) | n 行 p 列の行列

各ウェイポイントの加速度境界条件。'AccelerationBoundaryCondition' と n 行 p 列の行列からなるコンマ区切りのペアとして指定します。各行は、軌跡の各変数についての p 個のすべてのウェイポイントにおける加速度に対応します。

例: [1 0 -1 -1 0 0; 1 1 1 -1 -1 -1]

データ型: single | double

出力引数

q — 軌跡の位置

m 要素ベクトル

tSamples で指定された時間サンプルにおける軌跡の位置。m 要素ベクトルとして返されます。ここで、m は tSamples の長さです。

データ型: single | double

qd — 軌跡の速度

ベクトル

tSamples で指定された時間サンプルにおける軌跡の速度。ベクトルとして返されます。

データ型: single | double

qdd — 軌跡の加速度

ベクトル

tSamples で指定された時間サンプルにおける軌跡の加速度。ベクトルとして返されます。

データ型: single | double

pp — 区分的多項式

構造体

区分的多項式。区分的軌跡の各セクションの多項式を定義する構造体として返されます。mkpp を使用して独自の区分的多項式を作成するか、ppval を使用して指定した時間の多項式を評価できます。構造体には次のフィールドが含まれます。

• form: 'pp'.

• breaks: 区分的軌跡が形を変える時間の p 要素ベクトル。p はウェイポイントの数です。

• coefs: 多項式の係数の n(p–1) 行 order 列の行列。n(p–1) は、軌跡の次元と pieces の数の積です。n 行の各セットは、各変動軌跡を記述した多項式の係数を定義します。

• pieces: p–1。ブレーク数から 1 を引いた値。

• order:多項式の次数 + 1。たとえば、3 次多項式の次数は 4 です。

• dim: n.制御点の位置の次元。

拡張機能

C/C++ コード生成
MATLAB® Coder™ を使用して C および C++ コードを生成します。

バージョン履歴

R2019a で導入

参考

bsplinepolytraj | contopptraj | cubicpolytraj | rottraj | transformtraj | trapveltraj