forked from lqy1989/gps-pseudo-range
-
Notifications
You must be signed in to change notification settings - Fork 0
/
huatull.m
66 lines (63 loc) · 2.28 KB
/
huatull.m
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
clear all;
clc;
XYZ1 = [-2615115.33910994,4732700.37999562,3371454.26569144;
-2615122.01136071,4732690.85252210,3371463.16270271;
-2615119.68838501,4732693.92802906,3371457.68190758;
-2615096.01412787,4732691.48731117,3371460.58772749;
-2615155.11969511,4732804.23079155,3371584.87130954;
-2615154.48504050,4732796.73059178,3371508.94457617;
-2615141.29620724,4732734.88036652,3371421.94362086;
-2615137.39084127,4732779.14209310,3371512.05942656;
-2615126.50441866,4732780.49695452,3371511.85267054;
-2615132.61588192,4732784.14943678,3371505.88927420];
XYZ2 =[-2615101.437 4732705.065 3371439.205
-2615127.086 4732704.793 3371458.721
-2615122.592 4732710.274 3371442.61
-2615097.344 4732698.069 3371445.168
-2615155.678 4732820.579 3371575.15
-2615139.247 4732774.378 3371502.855
-2615126.616 4732726.793 3371419.392
-2615132.439 4732788.242 3371493.257
-2615126.712 4732785.651 3371491.234
-2615130.384 4732793.034 3371489.463];
GXYZ1 = [-2615130.73913163,4732740.83076951,3371492.50223923;
-2615110.79332011,4732705.76009929,3371480.48153795;
-2615132.48461787,4732688.34229569,3371438.67090270;
-2615099.39748072,4732705.18502125,3371468.80936511;
-2615159.06701664,4732803.02326474,3371585.06876236;
-2615149.45006419,4732775.16728215,3371560.66887659;
-2615143.70473701,4732772.4871092,3371506.75817207;
-2615140.92519239,4732785.30747918,3371510.86033316;
-2615127.27967821,4732779.47606291,3371511.18327521;
-2615130.75944910,4732784.08608705,3371505.55778417];
GXYZ2 = [-2615130.402 4732723.903 3371479.049
-2615118.916 4732712.937 3371458.243
-2615122.091 4732709.903 3371442.498
-2615098.013 4732698.224 3371444.537
-2615155.678 4732820.47 3371575.008
-2615139.303 4732794.416 3371562.91
-2615123.235 4732765.787 3371498.462
-2615122.19 4732771.922 3371498.386
-2615136.273 4732791.497 3371491.346
-2615130.76 4732793.317 3371488.761
];
for i =1:10
a = GXYZ1(i,1)-GXYZ2(i,1);
b = GXYZ1(i,2)-GXYZ2(i,2);
c = GXYZ1(i,3)-GXYZ2(i,3);
D(i) = sqrt(a^2+b^2+c^2);
end
figure(1);
plot(D-24.45);
hold on;
legend('改正后基线与软件解算');
for i =1:10
a = XYZ1(i,1)-XYZ2(i,1);
b = XYZ1(i,2)-XYZ2(i,2);
c = XYZ1(i,3)-XYZ2(i,3);
D(i) = sqrt(a^2+b^2+c^2);
end
figure(2);
plot(D-24.45);
hold on;
legend('改正前基线与软件解算');