• 大小: 2KB
    文件类型: .m
    金币: 1
    下载: 0 次
    发布日期: 2021-05-29
  • 语言: Matlab
  • 标签:

资源简介

用于卫星的定位解算,常见的定位解算有最小二程法,卡尔曼滤波等

资源截图

代码片段和文件信息

%最小二乘法
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

评论

共有 条评论