"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
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