資源簡介
用于衛星的定位解算,常見的定位解算有最小二程法,卡爾曼濾波等
代碼片段和文件信息
%最小二乘法
function?LeastSquare
X_true=[961333.82910;-5674076.3699;2740537.6613;-36000.0000];
eps=1e-6;
m=4;
D_a1=[16414028.668660383.61820932036.907;16896800.648-18784061.365-7418318.856;
????9339639.616-14514964.65820305107.161;-18335582.591-11640868.30515028599.071;
????-2077142.705-20987755.987-15879741.196;-4957166.885-23306741.03912039027.096;
????17977519.820-13089823.31214331151.065;9682727.508-24060519.4853985404.530];
rou01=[24658975.3174322964286.4122821338550.6453623606547.2935924263298.5040120758264.1082321847468.8168920352077.19349]‘;
k=0;n=5;
format?long?e
while?n>=5&&n<=8
????D_a=D_a1(1:n:);
????rou0=rou01(1:n:);
????A=zeros(n4);
????L=zeros(n1);
????t=[1?1?1]‘;
????X0=[0?0?0?0]‘;
while(norm(t)>eps)%t=X(k+1)-X(k)收斂條件為|X(k+1)-X(k)|<=eps
????for?j=1:n
????????D_rou
評論
共有 條評論