halt.txt

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

250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
250
241
237
234
243
244
238
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
244
230
228
240
236
236
228
228
228
225
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
248
232
229
228
228
227
227
227
237
232
229
225
225
226
229
234
234
233
233
233
229
226
230
227
228
228
228
229
229
226
226
226
226
226
225
228
231
227
231
229
229
226
226
226
225
224
227
229
225
226
225
225
225
224
224
224
227
226
225
227
226
228
226
228
228
228
228
228
234
230
238
231
230
245
236
234
234
230
230
230
232
228
228
232
243
232
234
231
231
232
232
232
229
229
232
228
237
231
231
233
233
233
233
233
246
230
228
229
228
229
238
237
237
232
232
232
235
235
234
233
230
233
238
235
235
233
233
233
232
234
230
252
251
251
251
251
251
251
251
251
251
251
236
235
236
238
245
240
240
239
239
239
232
234
232
233
237
233
231
235
235
231
231
231
237
233
233
236
238
233
246
236
236
250
250
250
250
250
250
250
250
250
235
240
240
233
233
233
233
235
232
232
236
232
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
253
236
229
228
234
230
229
233
233
232
232
232
237
231
230
246
232
230
233
231
231
245
245
245
234
231
231
227
228
241
233
230
230
245
245
245
245
245
245
245
245
245
245
245
245
245
245
245
245
245
245
245
235
227
224
222
222
225
225
225
224
225
224
224
221
225
225
223
223
221
221
221
220
223
225
225
224
222
222
224
224
222
222
222
220
223
221
222
222
222
222
221
221
222
222
222
222
220
223
222
233
224
222
221
221
222
222
222
223
223
222
224
223
223
223
221
221
221
221
221
223
221
220
219
224
220
220
220
220
223
223
223
221
223
220
221
220
219
219
218
218
220
220
220
220
219
221
220
220
219
220
220
220
220
220
220
222
220
221
223
221
221
220
220
220
222
222
222
222
223
222
223
226
224
226
225
225
225
225
225
227
228
227
234
230
226
227
229
229
231
231
231
229
232
232
234
230
228
243
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
235
245
244
241
244
244
239
236
236
246
246
246
242
244
249
256
256
256
256
256
256
256
256
256
256
256
256
256
256
256
256
256
256
256
256
256
256
256
256
256
256
256
256
256
256
255
255
255
255
255
255
255
255
245
227
224
224
223
223
223
234
225
223
222
223
222
222
222
222
235
235
235
226
220
220
219
219
220
219
219
219
220
220
220
221
218
218
218
217
218
218
218
218
218
218
218
218
221
220
222
235
230
233
233
233
230
230
230
239
238
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
251
239
229
234
229
229
226
226
226
223
220
220
217
218
219
218
218
218
218
218
218
218
218
217
217
219
217
214
216
216
215
215
215
213
215
214
214
213
213
214
215
215
212
212
212
214
213
211
211
210
212
212
212
212
212
212
212
215
211
212
210
210
210
212
214
214
212
212
212
211
211
213
213
213
214
213
214
214
211
211
211
213
212
216
215
213
215
217
217
217
217
217
217
215
216
217
217
219
219
217
216
216
216
216
216
217
217
217
220
217
217
219
218
218
218
218
218
218
219
219
220
223
219
222
221
221
222
222
222
224
224
226
225
225
225
225
224
224
227
227
227
227
234
226
232
235
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
246
234
232
232
226
226
226
223
235
225
222
224
224
223
223
223
222
222
222
231
230
224
226
224
221
223
224
224
243
243
243
242
242
242
242
242
242
229
228
228
230
230
230
224
225
224
226
232
229
233
231
231
231
231
231
237
227
225
231
240
229
234
233
233
234
234
234
233
235
244
244
244
244
244
244
244
244
244
244
244
244
244
244
244
244
244
244
244
244
244
244
244
244
244
244
244
244
244
244
244
244
244
244
244
236
226
226
223
224
229
228
228
227
227
227
233
228
234
225
221
223
224
223
223
224
224
224
219
222
223
224
222
221
226
226
226
223
223
223
219
218
220
219
220
216
215
215
215
216
216
216
216
215
214
214
215
213
216
215
215
217
217
217
214
215
215
214
214
221
217
215
215
215
215
215
213
214
214
212
213
215
213
213
213
215
215
215
220
218
217
217
218
214
215
217
217
216
216
216
216
217
215
217
216
217
218
216
216
219
219
219
217
217
218
217
220
217
219
220
220
219
219
219
218
224
219
220
216
216
219
219
219
220
220
220
218
216
216
219
217
218
219
218
218
220
220
220
219
215
217
217
218
214
217
216
216
215
215
215
215
215
217
214
212
212
214
215
215
215
215
215
215
211
213
212
211
210
210
213
213
210
210
210
210
210
210
211
208
209
210
211
211
208
208
208
210
210
211
212
210
212
213
211
211
212
212
212
211
213
211
212
212
213
212
212
212
212
212
212
212
213
216
214
216
216
215
213
213
214
214
214
214
214
214
216
217
216
215
215
215
214
214
214
213
213
215
215
213
212
212
213
213
212
212
212
211
211
209
209
208
210
211
209
209
208
208
208
207
208
206
206
206
206
205
204
204
202
202
202
200
199
203
200
199
199
200
200
200
200
200
200
195
196
195
197
196
195
196
195
195
195
195
195
194
194
193
192
192
194
192
192
192
194
194
194
192
189
191
188
189
189
189
187
187
187
187
187
188
186
188
186
187
186
185
186
186
185
185
185
183
183
185
184
184
184
185
186
186
183
183
183
183
184
182
184
182
183
182
183
183
181
181
181
182
183
182
181
180
180
180
181
181
180
180
180
180
180
180
180
180
180
178
179
179
178
178
178
179
178
178
179
178
179
178
177
177
178
178
178
178
179
181
177
178
176
176
176
176
177
177
177
175
176
176
176
176
174
175
175
175
174
174
174
176
173
174
175
172
174
175
174
174
172
172
172
175
171
173
172
171
169
169
169
169
168
168
168
170
167
167
166
166
166
167
165
165
164
164
164
162
164
161
162
164
161
164
162
162
160
160
160
159
160
159
158
157
158
157
156
156
155
155
155
155
156
154
153
153
153
153
153
153
152
152
152
152
152
151
150
149
149
150
149
149
149
149
149
148
147
148
148
148
147
146
146
146
146
146
146
146
145
145
145
145
144
144
144
144
144
144
144
144
144
144
143
143
142
143
143
143
142
142
142
142
142
142
142
141
141
140
140
140
140
140
140
140
140
140
140
140
139
138
138
138
138
138
138
137
137
137
136
136
136
136
135
135
135
135
135
134
134
135
134
134
133
133
133
133
134
134
134
132
132
131
131
131
130
130
129
129
129
129
129
128
128
129
129
128
128
128
128
128
127
127
127
127
127
126
126
126
126
125
125
125
125
125
125
124
124
124
124
124
124
123
122
122
122
122
122
122
122
121
121
121
121
120
120
120
119
119
119
119
120
118
118
118
117
116
116
116
117
117
117
116
116
116
115
115
115
115
115
115
114
114
114
114
114
114
113
113
112
113
113
113
113
113
113
112
112
112
112
111
110
110
110
110
111
111
111
111
111
110
111
111
110
110
110
110
110
110
110
111
110
110
110
110
110
110
110
110
109
109
109
109
109
109
109
109
108
108
108
108
108
108
108
108
107
108
107
106
106
105
106
106
106
106
106
105
104
104
103
103
103
102
102
102
102
102
102
101
100
100
99
99
99
98
98
98
98
98
98
97
96
97
95
95
94
93
93
93
93
93
93
93
92
92
90
90
89
89
89
89
89
89
89
88
88
87
87
86
86
85
85
85
85
85
85
85
84
84
84
83
83
82
82
82
82
82
82
82
82
81
81
80
79
79
79
79
78
78
78
78
77
77
76
76
75
75
75
75
74
74
74
74
74
73
73
73
72
71
71
71
71
71
71
71
70
70
70
70
69
69
69
69
69
69
69
68
67
67
67
66
66
66
65
65
65
65
65
64
64
64
63
63
63
62
62
62
62
62
62
61
61
61
61
60
60
60
60
60
59
59
59
59
59
59
58
58
57
57
57
57
57
57
57
56
56
56
56
55
55
55
54
54
54
54
54
54
54
53
53
53
52
52
52
52
52
52
52
52
52
51
51
51
51
51
51
51
51
51
51
50
50
50
49
50
50
49
49
49
49
49
49
49
49
48
49
48
48
48
48
48
47
47
47
47
47
47
46
46
46
46
46
46
45
45
45
45
45
45
44
44
44
44
43
43
43
43
43
43
43
42
42
42
41
41
41
41
41
41
41
41
40
40
40
40
39
39
39
39
39
39
39
38
38
38
38
38
37
37
37
37
36
36
36
36
36
35
35
35
34
34
34
34
33
33
33
33
33
33
32
32
32
31
31
31
31
31
31
31
30
30
29
29
28
28
28
28
27
27
27
27
26
26
25
25
25
24
24
24
24
24
24
23
23
22
22
22
21
21
21
21
21
21
21
20
20
20
19
19
19
19
19
19
18
18
18
18
18
18
17
17
17
17
16
16
16
16
16
16
16
15
15
15
14
14
14
14
14
14
14
13
13
13
13
12
12
12
12
12
12
12
12
11
11
11
11
10
10
10
10
10
10
10
10
10
9
9
9
9
8
8
8
8
8
8
8
8
8
7
7
7
7
7
7
7
6
6
6
6
6
6
6
6
6
6
6
6
6
6
6
6
6
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
4
4
4
4
4
4
4
4
4
4
4
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
3
3
3
3
3
3
3
3
3
3
3
3
2
2
2
2
2
2
2
2
2
2
2
2
2
2
2
2
2
2
2
2
2
2
2
2
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
1
2
2
2
2
2
2
2
2
2
2
2
2
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
4
4
4
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
5
4
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
2
2
2
2
2
2
2
2
2
2
2
2
1
1
1
1
1
1
1
1
1
1
1
1
1
1
0
1
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0