clear
clc
load test;
index = find(test(:,1)==1);
pos = test(index,2:4)*1000;
t = 60:15:1350;
len =length(t);
ti = 0:15:1425;
k = 1;
for i = 1:len
inter = floor(t(i)/15)+1;
index = [(inter-4):(inter-1),(inter+1):(inter+5)];
tt = ti(index);
p = pos(index,:);
x = lagrang1(p,tt,t(i));
cancha = x - pos(inter,:);
s(k,:) = cancha;
k = k+1;
end
plot(s);
xlabel('内插数据点个数');
ylabel('内插误差/m');
legend('x方向内插误差','y方向内插误差','z方向内插误差');
% % t = 0:15:1425;
% tt =[0:15:45,75:15:120];
% p = [pos(1:4,:);pos(6:9,:)];
% x = lagrang1(p,tt,60);
% x - pos(5,:)
评论10