僞距定位算法（MATLAB）

**web 僞距定位算法 ** %函數定義dingwei_fun function f=dingwei_fun(xyzt,sat,r) c=299792.458;%光速 [m,n]=size(sat) for i=1:m f(i)=norm(sat(i,:)-xyzt(1:3))+c*xyzt(4)-r(i); end f=f’;算法 %函數定義dingwei_dfun function df=d

>>阅读原文<<