hdgps.txt

无人机高度基于matlab卡尔曼滤波程序 数据融合

204
204
205
204
204
205
205
205
205
205
205
206
206
205
205
205
205
203
203
204
205
203
203
203
203
205
204
203
203
202
202
203
204
204
204
203
203
203
203
201
201
202
202
202
200
202
202
201
201
202
203
203
203
205
205
205
204
205
205
205
205
205
205
207
207
206
206
207
206
206
206
204
204
204
205
204
204
204
204
204
203
202
202
201
201
202
200
199
199
199
199
198
199
198
198
197
197
197
197
197
197
196
196
197
196
196
196
197
197
195
196
195
195
194
194
194
196
195
195
195
195
194
195
195
195
197
197
196
201
198
198
200
200
200
200
200
200
200
200
199
202
202
202
202
202
202
202
201
201
201
201
201
199
199
199
200
200
199
199
199
199
199
199
199
201
200
200
199
199
199
197
196
196
197
197
196
196
197
197
196
196
197
195
196
196
196
196
197
197
198
198
197
197
197
196
198
198
197
197
198
197
199
199
198
198
199
199
198
198
198
198
197
197
197
197
195
195
195
193
192
192
190
190
188
187
187
187
186
186
185
185
183
183
182
182
182
181
182
182
180
180
181
178
178
178
178
178
177
175
174
174
174
174
173
175
174
174
173
173
172
170
172
172
172
172
172
171
172
172
171
171
170
170
169
169
168
168
168
169
168
168
168
168
167
168
169
169
167
167
167
167
167
167
166
166
166
165
165
165
163
163
162
162
161
161
160
160
159
158
158
158
157
157
156
155
154
154
153
153
153
151
150
150
149
149
149
147
147
147
147
147
145
144
143
143
143
143
141
140
141
141
140
140
139
137
137
137
137
137
137
137
136
136
135
135
135
134
134
134
134
134
134
132
132
132
132
132
131
130
130
130
129
129
128
128
128
128
126
126
125
124
124
124
123
123
123
122
122
122
121
121
121
121
120
120
119
119
118
117
116
116
116
116
116
116
114
114
114
114
113
113
112
112
111
111
111
109
109
109
109
109
108
106
106
106
106
106
106
107
107
107
105
105
105
104
104
104
105
105
105
105
105
105
105
105
104
104
103
103
101
101
101
103
101
101
100
100
100
99
98
98
97
97
97
95
95
95
93
93
92
91
92
92
90
90
88
88
87
87
85
85
85
84
83
83
82
82
81
82
81
81
80
80
79
78
77
77
77
77
76
75
74
74
72
72
70
69
68
68
67
67
67
67
66
66
65
65
65
63
63
63
62
62
62
61
61
61
59
59
59
59
59
59
57
57
56
55
56
56
55
55
55
54
53
53
52
52
52
51
51
51
51
51
51
50
51
51
50
50
49
48
49
49
49
49
49
49
49
49
47
47
48
47
47
47
46
46
46
45
45
45
44
44
44
43
44
44
44
44
43
41
41
41
41
41
40
39
39
39
39
39
39
37
37
37
36
36
36
35
36
36
35
35
34
34
32
32
31
31
31
30
29
29
27
27
27
26
26
26
25
25
24
25
24
24
24
24
23
22
21
21
21
21
20
20
19
19
18
18
18
17
17
17
16
16
17
16
16
16
15
15
15
13
13
13
13
13
13
12
11
11
11
11
11
10
11
11
9
9
9
8
9
9
9
9
9
9
10
10
9
9
10
8
9
9
8
8
8
9
8
8
7
7
7
8
8
8
9
9
8
7
7
7
6
6
7
7
7
7
6
6
5
6
6
6
6
6
6
7
7
7
6
6
5
5
6
6
5
5
4
6
5
5
7
7
6
5
5
5
5
5
5
6
5
5
6
6
6
6
7
7
5
5
5
5
7
7
9
9
6
7
10
10
11
11
10
11
11
11
9
9
9
8
9
9
9
9
9
9
9
9
8
8
7
9
7
7
8
8
7
7
4
4
5
5
7
6
7
7
6
6
4
5
4
4
6
6
5
2
5
5
4
4
4
4
5
5
5
5
5
4
5
5
5
5
5
5
5
5
5
5
4
5
5
5
5
5
5
5
5
5
5
5
6
5
6
6
5
5
5
5
5
5
6
6
6
5
5
5
5
5
5
4
4
4
4
4
5
4
4
4
5
5
5
4
3
3
4
4
4
4
4
4
4
4
5
5
6
6
5
5
5
5
6
6
6
6
6
6
6
6
5
5
5
4
5
5
6
6
5
4
5
5
5
5
5
5
5
5
5
5
6
5
5
5
6
6
6
6
6
6
7
7
7
6
6
6
7
7
6
6
6
6
6
6
6
5
5
5
6
6
5
4
4
4
5
5
5
5
5
5
5
5
5
6
6
6
6
6
6
6
6
6
6
6
6
5
6
6
6
6
6
6
6
6
5
5
5
4
4
4
4
4
4
4
5
5
4
4
4
3
3
3
2
2
3
4
4
4
4
4
3
3
4
4
4
4
4
4
4
4
4
4
4
3
3
3
4
4
3
4
3
3
4
4
4
4
4
4
4
4
5
4
4
4
3
3
4
3
4
4
4
4
3
3
4
4
4
4
3
2
2
2
2
2
2
1
2
2
2
2
2
3
2
2
3
3
3
3
3
3
4
4
4
4
4
4
4
4
4
4
4
4
4
4
4
4
3
3
3
3
3
3
3
3
3
3
3
3
3
3
4
4
4
4
4
4
4
4
4
4
4
4
4
4
4
5
5
5
5
5
6
5
5
5
6
6
6
5
5
5
5
5
5
5
4
4
5
5
5
6
5
5
6
6
6
6
6
6
5
5
6
6
6
6
6
6
6
7
7
7
6
6
7
7
7
7
7
7
7
7
7
7
7
7
7
7
7
7
6
6
6
7
7
7
7
7
7
7
7
7
7
7
8
8
8
8
8
8
8
7
8
8
7
7
7
7
7
7
7
7
8
7
8
8
8
8
8
8
8
8
8
8
8
9
8
8
8
8
8
8
8
8
8
8
8
7
7
7
7
7
7
7
7
7
7
7
8
7
7
7
7
7
7
8
8
8
8
8
8
8
7
7
8
8
8
9
9
9
8
8
9
9
9
9
10
10
9
9
8
8
9
9
9
9
9
9
9
9
9
9
8
8
9
9
8
8
9
9
9
9
8
8
9
9
9
9
9
9
10
10
9
9
9
10
9
9
9
9
9
9
8
8
9
9
8
8
9
9
7
7
8
8
7
7
7
7
8
7
7
7
7
7
8
8
8
8
7
7
8
8
8
8
8
8
8
8
8
8
8
8
8
9
9
9
9
9
9
8
9
9
9
9
10
10
10
10
10
10
9
10
9
9
10
10
10
10
10
10
9
9
10
10
10
10
10
10
10
10
10
10
10
10
10
10
10
10
11
11
11
11
11
11
11
11
10
10
11
11
11
11
10
10
9
9
9
9
9
10
9
9
10
10
9
8
9
9
9
9
10
9
9
9
9
9
9
8
9
9
8
8
9
9
9
9
8
8
8
8
7
7
7
7
7
7
7
7
7
7
7
6
6
6
6
6
7
8
7
7
8
8
8
6
7
7
8
8
7
8
7
7
7
7
7
7
7
7
7
7
8
8
7
7
7
7
7
7
7
7
7
7
6
6
7
7
7
7
7
7
6
6
6
6
7
6
6
6
6
6
5
7
7
7
7
7
7
7
7
7
7
7
7
8
9
9
7
7
7
7
6
6
6
6
7
7
7
7
7
7
7
6
7
7
6
6
6
6
7
7
7
7
6
7
7
7
7
7
7
7
7
7
7
7
7
7
7
7
7
7
7
6
6
6
6
6
6
5
5
5
6
6
6
6
6
6
6
6
5
6
6
6
7
7
6
6
6
6
6
6
6
7
6
6
7
7
7
6
6
6
7
7
6
7
7
7
6
6
7
7
7
7
6
6
6
5
5
5
5
5
5
6
7
7
5
5
6
5
6
6
6
6
6
5
5
5
6
6
6
6
6
6
6
6
6
5
6
6
6
6
6
5
4
4
5
5
5
4
5
5
5
5
5
6
4
4
4
4
6
4
4
4
4
4
4
4
4
4
4
4
4
4
4
4
4
4
5
4
4
4
5
5
4
4
5
5
5
5
5
5
5
5
4
4
4
5
5
5
5
5
5
4
5
5
4
4
6
6
5
5
6
6
6
7
7
7
7
7
7
7
7
7
7
7
8
7
8
8
7
7
7
6
6
6
6
6
7
6
7
7
6
6
6
6
5
5
6
6
6
6
6
6
6
6
5
5
6
6
5
5
5
4
5
5
5
5
5
4
4
4
4
4
4
5
3
3
3
3
4
3
3
3
4
4
4
4
4
4
4
4
4
5
5
5
5
5
5
5
5
5
4
4
5
4
4
4
5
5
4
5
5
5
5
5
4
4
4
4
4
4
4
4
4
4
4
4
4
4
5
5
5
5
5
4
4
4
5
5
6
6
5
5
5
5
6
5
5
5
4
4
5
4
5
5
4
4
5
5
6
6
5
5
5
6
6
6
6
6
5
6
6
6
6
6
7
6
7
7
7
7
7
7
6
6
6
6
6
5
6
6
6
6
5
6
5
5
5
5
6
7
7
7
7
7
7
7
7
7
7
7
7
7
7
7
6
6
7
8
8
8
7
7
7
7
8
8
7
7
8
8
7
7
7
7
7
7
7
7
8
8
8
8
7
7
8
8
8
7
7
7
7
7
6
8
9
9
8
8
8
9
8
8
8
8
8
8
8
8
8
8
8
8
8
8
7
7
8
7
7
7
7
7
7
7
8
8
8
8
8
8
8
8
8
8
8
9
8
8
9
9
8
8
8
8
9
9
9
8
8
8
8
8
8
7
8
8
7
7
7
6
7
7
7
7
7
7
7
7
8
8
7
7
8
8
7
7
7
7
7
7
7
7
7
7
8
8
7
7
7
6
7
7
7
7
8
7
7
7
7
7
7
7
7
7
7
7
7
7
6
6
7
7
7
6
7
7
6
6
6
7
7
7
7
7
6
7
7
7
6
6
7
7
6
6
6
6
6
6
6
6
7
7
6
7
6
6
6
6
7
6
7
7
8
8
8
7
8
8
8
8
8
7
7
7
7
7
8
7
6
6
7
7
7
7
7
7
7
7
7
6
6
6
6
6
7
6
6
6
7
7
7
7
7
7
7
7
7
7
6
6
7
7
8
7
7
7
7
7
7
7
8
8
6
6
7
8
7
7
7
7
8
7
8
8
7
7
8
7
8
8
8
8
7
8
8
8
8
8
9
7
8
8
7
7
7
8
7
7
7
7
7
8
8
8
7
7
7
8
8
8
8
8
8
8
9
9
8
8
8
8
8
8
8
8
9
9
9
9
9
9
9
9
9
9
8
8
8
9
9
9
9
9
9
9
10
10
9
9
9
9
9
9
8
8
8
8
9
9
9
9
9
9
9
9
9
9
9
9
9
9
10
10
10
9
10
10
10
10
10
9
9
9
10
10
10
9
9
9
8
8
9
9
9
9
9
9
9
9
9
9
8
8
9
9
10
10
9
9
10
10
9
9
9
9
9
9
9
9
9
9
9
9
10
10
9
9
9
8
8
8
9
9
9
9
8
8
9
9
9
9
9
9
9
9
9
8
9
9
8
8
8
7
8
8
8
8
8
8
8
8
8
8
8
7
8
8
8
8
8
8
7
7
7
7
8
8
8
8
7
7
7
7
8
8
8
8
8
9
8
8
8
8
8
7
8
8
8
8
8
7
8
8
8
8
9
9
9
9
8
8
9
8
7
7
9
9
7
9
9
9
9
9
8
8
9
9
9
9
8
9
9
9
8
8
8
8
9
9
8
8
9
9
9
9
9
9
9
10
9
9
9
9
9
9
9
9
9
9
9
10
11
11
10
10
11
11
10
10
10
10
10
11
11
11
11
11
12
11
12
12
11
11
12
11
11
11
11
11
11
11
10
10
10
10
11
12
11
11
11
11
12
11
10
10
10
10
10
11
11
11
10
10
11
9
10
10
10
10
9
8
9
9
9
9
9
9
8
8
8
8
8
8
8
8
9
9
8
9
9
9
8
8
9
9
9
9
9
9
9
8
9
9
8
8
8
7
8
8
8
8
8
8
8
8
7
7
8
8
8
8
8
8
8
8
8
8
8
8
7
7
8
8
7
7
8
8
8
8
8
8
8
8
8
8
7
7
8
8
8
8
8
8
9
8
8
8
8
8
7
8
8
8
8
8
8
7
7
7
7
7