halt.txt

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

219
220
219
222
220
221
221
219
220
220
219
219
219
222
219
219
220
223
222
222
221
221
224
224
224
224
221
225
223
221
223
222
224
224
221
221
221
222
223
224
224
222
222
226
225
225
221
221
221
224
223
233
224
223
218
222
222
222
223
223
223
222
219
219
218
217
219
218
219
219
220
220
220
221
218
220
220
218
216
217
216
216
222
222
222
219
219
219
219
218
217
219
221
221
219
219
219
222
223
221
219
217
217
217
219
219
217
217
217
218
218
218
217
219
216
218
216
216
217
217
217
219
218
218
216
217
217
219
218
218
217
217
217
220
219
218
218
218
218
219
219
219
217
217
217
220
221
220
219
221
220
220
219
219
221
221
221
219
220
221
222
222
222
220
220
220
220
220
220
222
222
222
218
224
220
220
220
220
220
220
220
220
217
220
220
220
220
221
223
223
222
222
222
219
221
218
222
221
221
220
224
224
221
221
221
222
219
220
220
220
219
221
220
220
220
220
220
221
222
221
221
220
222
220
221
221
220
220
220
222
221
220
218
217
218
219
221
221
217
217
217
217
215
216
215
214
216
217
216
216
213
213
213
216
214
214
218
217
215
217
215
215
214
214
214
215
216
214
216
217
216
216
216
216
216
216
216
215
212
213
213
214
213
213
215
215
217
217
217
216
214
215
214
214
214
215
214
214
216
216
216
213
214
214
212
215
215
213
212
212
213
213
213
213
211
214
215
215
213
214
215
215
212
212
212
214
214
213
212
212
212
214
213
213
212
212
212
212
216
216
212
211
214
216
216
216
214
214
214
217
215
215
215
214
214
213
213
213
212
212
212
215
212
211
211
215
214
212
214
214
213
213
213
213
211
214
210
209
213
212
211
211
210
210
210
210
212
212
211
211
212
214
212
212
211
211
211
210
210
210
212
214
214
214
214
214
215
215
215
214
210
211
210
211
210
210
211
211
213
213
213
214
212
212
212
213
211
211
212
212
214
214
214
215
215
215
213
215
214
214
215
215
215
215
215
215
216
215
215
216
216
217
217
217
215
215
215
217
216
218
218
218
219
218
221
221
221
221
221
220
220
219
222
222
219
226
225
225
220
220
220
220
219
220
222
221
219
222
222
222
223
223
223
221
220
223
224
223
221
223
222
222
223
223
223
223
222
225
225
222
222
222
224
224
222
222
222
224
223
222
222
221
222
222
221
221
220
220
220
221
222
222
220
220
220
223
221
221
225
225
225
222
221
224
219
221
219
220
219
219
218
218
218
217
221
220
220
221
218
218
219
219
218
218
218
218
218
216
215
215
215
214
214
214
213
213
213
215
216
215
218
214
216
215
214
214
214
214
214
215
215
214
215
213
212
215
213
213
214
214
214
214
213
214
214
213
217
215
215
215
215
215
215
215
217
218
216
216
215
216
216
216
216
216
216
217
214
216
214
216
214
217
218
218
215
215
215
216
217
215
215
212
212
215
215
215
213
213
213
215
215
214
213
216
215
215
215
215
215
215
215
215
215
216
216
215
218
216
217
217
216
216
216
217
219
216
218
216
217
218
218
218
219
219
219
216
217
219
218
218
218
218
219
219
218
218
218
220
217
217
219
219
218
220
219
219
218
218
218
217
219
219
219
218
215
216
217
217
218
218
218
218
219
215
217
220
218
217
219
219
217
217
217
217
218
217
217
216
216
217
219
219
216
216
216
218
216
216
215
216
216
215
215
215
219
219
219
216
217
217
217
218
219
218
218
218
217
217
217
217
217
215
216
220
219
219
219
219
217
217
217
219
216
218
217
217
219
218
220
220
218
218
218
215
215
217
215
218
219
217
218
218
218
218
218
218
218
219
218
217
217
218
219
219
219
219
219
218
219
218
218
216
218
217
218
218
218
218
218
218
219
219
218
220
221
218
220
220
221
221
221
220
218
218
217
220
219
219
219
219
220
220
220
220
219
219
217
220
220
221
221
221
221
221
221
222
223
220
221
221
221
223
221
221
221
221
221
219
220
220
220
219
218
218
221
221
220
220
220
220
218
218
220
220
220
220
220
220
221
221
221
222
224
222
223
223
223
225
224
224
225
225
225
228
227
226
228
227
227
227
227
227
226
226
226
232
226
225
232
226
227
225
227
227
222
222
222
225
226
227
225
227
224
225
225
225
225
225
225
223
224
224
227
224
226
225
225
225
226
226
226
223
222
222
224
223
228
227
236
236
228
228
228
225
227
224
231
225
224
222
224
224
225
225
225
226
225
224
223
224
226
224
224
224
225
225
225
227
226
227
224
223
225
225
225
225
225
225
225
228
228
224
225
223
224
226
225
225
222
222
222
222
225
226
223
224
223
223
223
223
223
223
223
223
226
225
225
223
224
224
223
223
223
223
223
222
220
225
223
222
221
222
222
222
222
222
222
221
222
221
220
219
220
219
220
220
219
219
219
221
222
220
220
219
218
220
221
221
221
221
221
221
220
219
219
222
219
219
221
221
222
222
222
220
220
221
221
220
221
221
220
220
221
221
221
220
222
220
223
222
224
224
225
225
224
224
224
221
222
222
223
221
224
223
224
224
224
224
224
224
225
225
224
223
226
224
224
224
224
224
224
224
224
227
226
223
223
224
225
225
227
227
227
224
226
227
226
229
229
227
227
227
227
227
227
225
224
224
225
227
226
226
226
226
226
226
226
228
225
226
226
230
228
226
228
228
228
228
228
227
226
223
226
224
223
223
223
223
223
223
223
228
223
227
221
223
224
224
224
224
223
223
223
225
226
224
225
224
227
226
225
225
223
223
223
227
225
226
226
224
226
224
227
227
227
227
227
228
225
228
227
224
228
223
225
225
228
228
228
224
225
224
232
227
227
227
226
226
223
223
223
223
222
223
223
224
222
225
225
225
228
228
228
224
224
223
225
227
224
233
227
227
224
224
224
223
224
225
224
225
223
224
225
225
240
240
240
225
225
223
223
224
225
222
222
222
226
226
226
224
221
221
220
221
220
221
221
221
222
222
222
224
220
220
218
221
218
219
218
218
217
217
217
219
217
219
218
217
217
218
216
216
217
217
217
215
216
217
215
216
216
215
216
216
217
217
217
216
217
215
217
218
218
217
216
216
217
217
217
217
215
216
217
216
215
216
215
215
216
216
216
217
218
217
221
220
218
218
221
221
218
218
218
219
219
220
220
219
220
220
219
219
221
221
221
220
221
223
221
221
223
222
222
222
225
225
225
222
221
223
223
224
226
224
224
224
225
225
225
226
225
225
225
223
227
225
226
226
222
222
222
223
225
223
227
223
224
224
226
226
223
223
223
225
226
226
226
227
227
228
227
227
224
224
224
226
225
225
224
225
228
226
226
226
226
226
226
227
226
228
226
226
227
225
225
225
228
228
228
227
230
228
226
226
228
227
228
228
228
228
228
225
230
228
227
227
225
227
227
227
224
224
224
230
228
228
228
228
227
226
225
225
225
225
225
225
226
227
227
225
227
231
231
231
225
225
225
227
225
225
225
226
226
229
228
228
228
228
228
226
227
228
226
229
227
224
223
223
227
227
227
225
226
225
225
232
224
224
225
225
223
223
223
223
222
224
224
224
224
223
223
223
223
223
223
225
225
226
228
228
228
228
229
229
226
226
226
226
226
231
226
228
228
226
228
228
229
229
229
228
227
229
228
236
229
228
231
231
230
230
230
229
229
230
229
233
232
230
229
229
236
236
236
247
237
232
235
233
231
231
241
241
233
233
233
235
237
232
236
230
229
230
227
227
227
227
227
229
235
227
228
231
228
225
226
226
232
232
232
229
228
226
225
225
223
221
222
222
223
223
223
222
222
223
221
222
222
224
223
223
222
222
222
224
224
224
222
223
223
224
225
225
222
222
222
223
225
224
223
221
223
222
222
222
221
221
221
222
222
219
220
220
222
222
222
222
219
219
219
222
220
222
221
222
220
218
217
217
219
219
219
222
221
222
221
220
223
222
223
223
223
223
223
224
224
224
225
222
222
223
222
222
224
224
224
224
223
222
220
222
220
221
223
223
221
221
221
223
222
220
221
223
220
220
220
220
222
222
222
220
218
221
221
219
220
219
220
220
219
219
219
221
218
219
218
219
220
220
219
219
220
220
220
218
219
220
219
219
218
219
218
218
219
219
219
220
218
220
220
218
218
219
218
218
219
219
219
219
217
216
216
216
218
218
218
218
221
221
221
218
216
216
216
216
217
218
217
217
219
219
219
216
218
217
218
219
219
219
219
219
218
218
218
219
218
219
221
222
220
222
221
221
221
221
221
222
222
222
223
224
222
225
225
225
227
227
227
227
228
226
225
226
226
229
228
228
229
229
229
230
228
228
229
229
229
233
232
232
231
231
231
232
232
229
230
236
230
228
228
228
229
229
229
227
227
227
228
226
225
224
224
224
225
225
225
225
225
224
223
222
224
223
222
222
223
223
223
222
221
219
220
219
219
218
220
220
219
219
219
220
219
217
219
219
221
219
219
219
220
220
220
219
220
219
219
219
220
220
220
220
221
221
221
221
220
220
220
222
222
221
221
221
221
221
221
221
219
219
219
219
219
218
219
219
219
219
219
219
220
221
220
220
219
219
220
220
218
218
218
218
219
217
216
216
216
214
215
215
214
214
214
215
213
213
213
212
211
211
211
211
209
209
209
209
209
208
210
210
207
208
207
207
210
210
210
208
208
207
208
210
207
206
207
207
207
207
207
209
208
210
208
211
211
212
211
211
209
209
209
210
212
213
212
213
213
214
213
213
215
215
215
216
216
217
217
215
216
218
217
217
218
218
218
219
218
218
218
217
217
217
218
218
217
217
217
216
216
219
217
217
218
217
217
217
219
219
219
218
216
217
217
216
215
217
216
216
217
217
217
215
214
215
214
213
213
212
213
213
211
211
211
214
214
211
211
210
209
208
208
208
208
208
208
210
210
207
209
207
209
209
208
208
210
210
210
209
209
211
210
209
209
207
209
209
210
210
210
210
209
210
212
210
212
212
212
212
212
212
212
212
213
213
212
214
213
215
216
216
213
213
213
214
215
216
215
217
216
218
218
218
218
218
218
220
219
218
218
220
220
219
220
220
222
222
222
221
220
220
220
219
221
220
219
219
219
219
219
221
221
220
220
222
220
221
219
219
219
219
219
219
219
220
221
219
220
219
219
219
220
220
220
219
219
219
218
219
223
221
221
221
221
221
221
220
218
218
218
220
218
217
217
217
217
217
217
219
217
220
218
219
217
217
217
217
217
217
217
216
217
218
220
217
217
219
218
218
218
218
218
218
217
217
220
219
218
218
218
218
218
218
218
220
220
221
221
221
219
221
220
220
220
220
220
221
219
221
222
221
222
221
220
220
224
224
224
221
220
221
221
222
220
220
221
221
220
220
220
219
220
219
219
220
219
218
221
221
220
220
220
220
220
220
218
220
218
220
219
219
219
219
219
221
220
222
222
222
221
220
219
219
219
219
219
222
220
221
221
221
220
220
221
221
223
223
223
219
219
221
219
220
221
221
222
222
221
221
221
222
222
219
222
220
218
219
217
217
220
220
220
217
217
216
214
215
214
213
212
212
213
213
213
213
210
211
209
208
208
210
209
209
210
210
210
210
209
207
208
207
208
206
206
206
209
209
209
208
207
207
206
207
207
208
209
209
205
205
205
207
204
205
206
207
206
207
206
206
205
205
205
206
206
208
207
209
208
210
209
209
210
210
210
210
209
210
210
210
211
211
213
213
211
211
211
212
212
212
212
213
213
214
213
213
216
216
216
216
216
215
215
216
217
217
218
218
218
218
218
218
219
220
220
220
219
219
220
220
221
221
221
220
219
224
220
220
221
222
221
221
223
223
223
222
223
223
224
224
223
223
224
224
225
225
225
225
227
229
229
227
227
228
230
230
229
229
229
230
231
231
229
230
230
229
230
230
232
232
232
231
234
233
239
237
235
236
235
235
236
236
236
240
247
242
235
236
238
240
237
237
234
234
234
233
242
233
231
233
230
229
229
229
227
227
227
225
226
235
226
224
225
222
221
221
221
221
221
219
220
220
220
223
222
221
221
221
218
218
218
219
218
222
220
220
222
220
219
219
221
221
221
221
221
221
221
219
222
220
220
220
218
218
218
219
220
219
220
221
222
222
221
221
221
221
221
223
220
223
220
222
222
221
220
220
224
224
224
223
223
224
224
222
221
222
222
222
224
224
224
223
221
222
225
225
224
222
223
223
225
225
225
223
223
224
225
225
223
224
223
223
224
224
224
225
227
228
227
228
228
227
227
227
227
227
227
229
230
228
232
231
233
231
232
232
230
230
230
230
232
230
229
232
231
229
227
227
233
233
233
231
236
233
229
230
228
230
230
230
228
228
228
230
229
234
235
233
229
232
230
230
227
227
227
229
229
236
227
241
231
235
231
231
231
231
231
229
228
230
228
229
244
244
244
244
244
244
244
244
244
244
244
246
241
233
237
237
230
230
230
228
232
230
230
228
249
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
248
248
248
238
235
239
232
233
234
232
232
233
233
233
243
233
230
229
229
227
226
228
228
225
225
225
224
224
225
226
224
225
225
225
225
224
224
224
226
225
224
225
225
224
225
226
226
225
225
225
224
224
224
222
222
222
221
222
222
223
223
223
222
223
224
221
219
220
222
222
222
218
218
218
219
217
217
218
218
217
217
217
217
218
218
218
218
218
218
219
221
222
221
220
220
219
219
219
220
220
219
219
221
220
222
221
221
224
224
224
223
222
221
222
223
223
224
225
225
223
223
223
226
226
223
223
224
227
226
226
226
226
226
226
226
227
227
226
225
225
223
226
226
225
225
225
226
226
228
225
226
228
225
225
225
226
226
226
227
227
228
226
226
229
228
228
228
227
227
227
226
237
230
229
228
230
227
228
228
229
229
229
228
229
228
227
227
226
229
228
228
233
233
233
228
226
227
228
228
230
232
230
230
231
231
231
229
232
232
234
240
233
239
236
236
234
234
234
235
236
243
233
235
234
238
235
235
245
245
245
242
235
250
250
250
250
250
250
250