16 lines
371 B
Matlab
16 lines
371 B
Matlab
% [ T X V A ] = fastest_track_function(x0,v0,xT,vT,vmax,amax,dmax,t0,dt)
|
|
|
|
|
|
% List of Points at time (one point = one line in matrix)
|
|
% Each Line: t, x, y, z
|
|
P = [0, 0,0,0;...
|
|
1, 1,1,1;...
|
|
2, 0,1,1;...
|
|
3, 2,3,1;...
|
|
4, 4,4,3];
|
|
|
|
% For each dimension interpolate the fastest track function
|
|
X = pvt_varVmax(P(:,1), P(:,2));
|
|
plot (X,Y,Z);
|
|
|
|
|