forked from lqy1989/gps-pseudo-range
-
Notifications
You must be signed in to change notification settings - Fork 0
/
CHT.m
70 lines (67 loc) · 2.41 KB
/
CHT.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
67
68
69
70
clear all;clc;
XYZ1 = [
-2615121.17723476 4732715.97467308 3371439.52390279
-2615127.08565777 4732724.79305016 3371458.72140063
-2615122.59174662 4732710.27399169 3371442.60957653
-2615097.34418873 4732698.06916454 3371445.16776879
-2615165.67849261 4732820.57947226 3371585.14950882
-2615139.24717942 4732774.37793011 3371502.85527616
-2615126.61566978 4732766.79288962 3371419.39215616
-2615132.43904436 4732788.24174579 3371493.25692833
-2615136.71247854 4732790.65061074 3371481.23411901
-2615133.68294495 4732780.19021574 3371461.19160331
];
XYZ2 =[
-2615101.29116634 4732705.88149120 3371438.26174933
-2615107.31687214 4732722.06475064 3371458.19272162
-2615102.24138369 4732708.47997726 3371441.69473275
-2615075.80282272 4732688.76309804 3371445.35158325
-2615167.50178698 4732820.00035924 3371600.23919816
-2615140.06085593 4732755.07282763 3371502.93446339
-2615132.32023204 4732748.61429490 3371424.32992274
-2615137.22270831 4732792.67072399 3371479.85722731
-2615132.68574628 4732777.51867177 3371459.92172646
-2615137.22270723 4732792.67072591 3371479.85741624
];
GXYZ1 = [
-2615144.73913163,4732740.83076951,3371492.50223923;
-2615100.79332011,4732705.76009929,3371480.48153795;
-2615132.48461787,4732688.34229569,3371438.67090270;
-2615099.39748072,4732705.18502125,3371458.80936511;
-2615159.06701664,4732803.02326474,3371585.06876236;
-2615149.45006419,4732785.16728215,3371560.66887659;
-2615126.23473701,4732725.98710502,3371419.75817207;
-2615136.92519239,4732775.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 4732774.416 3371562.91
-2615126.235 4732725.787 3371418.462
-2615132.19 4732791.922 3371498.386
-2615136.273 4732791.497 3371481.346
-2615130.76 4732793.317 3371488.761
];
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(1);
plot(1:10,D-24.45,'*r');
hold on;
legend('改正基线与软件解算');
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(2);
plot(1:10,D-24.16,'*r');
hold on;
legend('未改正基线与软件解算');