三维航迹的最小二乘拟合 clc clear load t load X load Y load Z figure(1); plot(t,X); title('时间和X位移关系图'); xlabel('t/s'); ylabel('x/m'); ax=polyfit(t,X,10); axd=polyder(ax); xbest=polyval(ax,t); xdbest=polyval(axd,t); save ax; save axd; save xbest; save xdbest; hold on plot(t,xbest,'r'); grid on; figure(2); plot(t,Y); title('时间和Y位移关系图'); xlabel('t/s'); ylabel('y/m'); ay=polyfit(t,Y,20); ayd=polyder(ay); ybest=polyval(ay,t); ydbest=polyval(ayd,t); save ay; save ayd; save ybest; save ydbest; hold on plot(t,ybest,'r') grid on; figure(3); plot(t ,Z); title('时间和Z位移关系图'); xlabel('t/s'); ylabel('z/m'); az=polyfit(t,Z,10); azd=polyder(az); zbest=polyval(az,t); zdbest=polyval(azd,t); save az; save azd; save zbest; save zdbest; hold on plot(t,zbest,'r') grid on