hadc.txt

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

203
203
203
203
203
203
204
204
204
204
204
205
205
205
205
205
205
205
205
205
205
204
204
205
205
205
207
207
207
207
207
206
206
206
205
204
204
204
204
204
204
202
202
202
202
201
201
201
201
201
201
201
201
201
201
200
200
200
199
200
199
199
198
198
198
198
199
199
198
197
198
197
197
197
198
198
198
198
197
197
198
198
198
198
198
198
197
197
197
198
197
196
196
197
198
196
196
196
196
196
196
196
196
195
196
197
198
198
198
198
198
198
198
198
199
198
197
198
198
200
200
200
200
200
200
200
200
200
200
199
198
199
199
199
199
199
199
200
199
199
199
199
199
200
200
200
200
200
200
200
199
199
200
199
199
198
198
198
197
197
197
197
197
198
197
197
197
196
197
197
196
196
196
197
196
196
197
196
196
196
196
196
196
196
196
197
197
196
197
198
198
198
198
198
198
198
198
198
198
197
196
197
195
197
195
195
196
196
196
196
195
195
196
195
195
196
196
196
195
195
195
196
196
195
195
197
196
195
195
195
195
195
195
196
197
197
197
196
196
196
197
197
196
196
196
196
197
198
197
198
199
198
197
197
198
198
198
197
197
197
197
197
198
198
199
199
199
199
199
200
200
199
198
198
198
198
197
197
197
197
197
198
198
198
198
198
197
198
198
198
197
197
197
199
198
198
199
199
199
198
198
198
198
198
198
199
199
199
198
199
197
198
198
198
198
198
198
199
200
199
200
200
200
199
199
199
200
200
200
200
201
201
202
201
201
202
202
202
202
202
202
202
202
202
201
202
203
203
203
203
202
202
202
203
203
203
204
204
203
202
201
201
202
202
202
202
201
201
202
202
202
202
202
202
203
203
203
203
203
204
204
204
203
204
204
204
204
204
204
203
204
203
204
205
205
206
206
206
205
205
205
204
205
206
205
206
206
205
205
205
206
206
206
205
205
204
203
202
202
202
202
202
203
203
203
202
203
203
205
205
205
205
204
204
203
203
203
203
203
202
202
201
201
201
201
201
201
201
201
202
201
202
201
201
202
202
203
203
202
202
202
202
202
201
202
202
201
201
200
200
202
202
202
202
203
203
203
203
203
204
204
204
203
203
203
203
204
202
203
204
204
204
203
203
204
204
204
203
203
203
203
204
204
203
204
204
203
203
203
203
204
204
206
206
206
205
205
205
205
205
205
206
206
206
205
204
205
206
206
206
207
207
207
209
210
210
209
207
206
205
205
205
205
205
205
205
205
205
206
206
205
205
205
205
205
205
205
205
205
205
205
204
205
205
205
205
204
204
204
205
205
206
204
205
204
205
205
205
205
205
205
204
203
204
203
203
202
201
200
200
201
201
201
201
200
200
200
199
199
199
198
198
199
199
199
199
198
199
200
200
200
200
200
200
200
200
200
201
201
201
200
200
201
201
202
202
201
201
201
202
202
202
204
205
205
205
205
205
205
205
205
204
203
202
202
203
202
202
202
202
202
202
202
203
202
202
201
201
202
201
201
201
201
201
201
202
201
201
202
201
201
200
201
201
201
201
201
201
201
202
203
202
202
202
202
202
202
202
202
202
202
202
202
202
202
203
203
203
204
204
204
204
204
203
203
202
203
202
202
202
202
202
202
201
201
201
201
201
201
202
202
202
202
202
202
202
201
200
200
199
198
198
198
198
198
198
198
199
197
197
198
198
197
197
197
197
196
196
196
196
197
197
196
196
195
195
194
194
195
195
195
196
195
196
197
197
198
197
197
197
198
198
198
197
196
197
196
195
197
197
197
197
196
196
196
196
196
196
197
197
196
195
196
196
194
194
194
194
195
196
196
196
197
196
195
195
195
195
195
196
196
196
196
196
195
196
196
196
196
196
196
196
196
196
196
197
198
198
199
199
199
199
199
200
199
200
201
201
201
202
202
202
200
200
200
200
199
198
199
200
199
198
199
199
198
198
198
196
196
195
195
195
195
195
195
195
195
195
195
195
195
194
194
194
194
193
193
193
194
194
194
193
193
193
193
193
194
194
194
194
194
194
194
194
194
194
195
195
195
194
195
195
195
195
195
195
195
195
195
195
194
195
195
195
196
196
196
196
196
197
196
197
197
197
197
197
197
197
197
198
197
198
199
199
199
199
198
198
199
199
199
200
202
203
203
203
203
202
202
202
202
202
202
202
201
202
202
201
202
201
201
201
201
201
201
200
201
201
202
202
202
202
202
202
203
203
203
203
203
203
203
203
204
204
204
204
204
204
204
204
204
204
204
204
203
204
204
204
204
204
204
205
205
204
205
204
204
205
205
205
206
206
206
206
206
206
206
206
205
206
206
206
205
205
205
205
204
204
203
203
202
202
202
202
201
201
201
202
202
202
203
203
202
201
201
201
200
200
200
200
200
200
199
199
199
198
198
198
198
198
198
198
197
198
197
198
198
197
198
198
197
197
197
197
197
197
197
197
197
197
197
197
197
197
197
197
197
197
197
197
197
197
197
197
197
197
197
197
196
196
195
196
197
197
197
197
196
196
196
196
197
196
195
196
196
196
196
196
197
197
197
196
197
197
196
197
197
197
197
197
197
197
197
197
197
196
197
197
197
197
197
197
197
197
197
198
199
197
197
197
199
199
198
198
198
198
198
198
199
199
199
198
199
199
199
199
199
199
199
199
199
199
199
199
199
199
199
199
200
200
200
199
199
200
200
200
201
201
200
200
200
200
200
199
199
198
198
198
198
198
198
198
197
197
197
197
197
197
197
197
197
197
197
197
197
197
197
197
197
196
196
197
197
196
196
196
197
197
197
197
197
197
196
197
195
195
195
195
196
196
196
196
197
196
198
197
198
198
198
198
198
198
198
197
197
199
198
200
200
198
198
198
198
198
198
197
197
196
197
196
197
197
196
196
197
197
197
197
196
196
196
196
196
196
197
197
198
198
198
196
197
196
197
198
198
198
197
197
198
198
198
199
199
199
199
199
198
199
199
199
199
199
199
198
199
200
199
198
199
198
198
198
198
198
198
197
197
197
197
198
199
198
197
197
198
198
198
197
197
198
199
198
198
198
199
199
198
198
198
198
198
198
199
201
199
198
198
198
200
200
200
198
198
197
197
198
198
198
198
198
198
198
198
198
198
199
199
200
200
200
199
199
199
199
199
200
200
199
200
200
201
201
201
201
202
202
202
202
203
203
204
204
203
204
204
204
204
204
204
204
203
203
204
204
203
204
204
204
203
203
203
203
202
203
202
202
201
201
201
201
200
200
200
201
201
201
201
202
201
201
201
201
201
201
201
202
200
200
200
200
200
201
201
201
200
200
200
200
200
201
201
201
202
204
204
204
204
204
204
203
204
204
204
203
204
204
205
205
206
206
206
206
204
202
201
201
202
202
203
203
202
202
202
202
201
201
201
201
200
201
201
201
202
202
202
202
202
202
201
201
201
202
202
202
202
202
202
201
201
201
201
202
202
202
202
202
202
202
202
203
203
203
204
202
202
202
202
202
202
202
202
201
200
200
199
200
199
199
199
199
198
198
198
197
198
198
197
197
196
196
196
196
196
196
196
196
196
196
197
197
197
196
196
196
198
198
198
197
197
198
198
199
198
199
199
199
198
198
198
198
198
199
198
197
197
198
198
198
198
198
198
198
199
199
198
198
199
199
199
199
199
199
199
200
201
200
201
202
203
203
202
202
203
203
203
204
203
202
202
201
201
201
201
201
201
201
201
201
201
200
200
201
201
200
200
200
200
200
200
200
200
200
200
201
201
201
200
200
200
200
200
200
200
201
201
200
200
200
200
200
200
200
200
200
199
200
200
200
199
199
199
199
199
199
199
199
198
199
200
199
199
198
198
198
198
198
198
198
198
198
197
198
198
198
198
198
197
197
197
197
199
199
198
198
199
200
200
200
200
200
200
201
201
202
203
203
203
202
203
203
204
204
204
203
203
202
201
201
201
201
201
201
200
200
200
200
199
200
200
200
201
200
200
200
200
200
200
199
200
200
201
202
202
202
203
203
204
204
204
204
203
203
203
203
203
204
204
204
202
202
202
202
202
202
202
201
200
199
199
199
198
198
198
199
200
200
200
200
200
201
200
200
198
198
198
198
198
198
197
197
196
195
194
194
194
194
194
193
195
193
194
193
193
193
193
193
193
193
193
193
195
195
194
194
194
193
193
193
193
193
193
192
192
193
193
191
193
192
192
192
192
192
192
192
192
193
193
192
193
193
194
194
195
195
195
195
195
195
195
195
194
193
193
193
194
194
194
194
195
195
197
197
197
197
197
197
198
198
198
198
198
199
200
199
199
199
199
199
199
199
199
200
200
202
201
200
201
201
201
201
201
201
201
200
201
199
199
198
198
198
198
198
198
198
198
199
199
199
199
199
199
201
200
200
200
200
200
199
199
200
200
200
200
200
200
200
200
200
200
200
200
200
200
200
200
201
201
201
200
200
200
201
200
200
200
200
199
199
199
199
199
199
199
199
199
199
199
199
199
200
200
200
200
200
200
200
201
201
202
201
201
201
201
201
200
200
200
201
201
201
202
201
202
202
202
202
202
202
202
202
201
201
201
202
202
202
202
202
202
202
202
202
202
202
202
201
201
200
200
200
200
200
200
200
200
201
201
200
200
201
200
200
200
200
200
201
201
201
200
199
199
199
199
199
199
199
199
200
200
200
200
200
200
200
200
200
200
200
200
200
200
200
199
199
199
200
200
200
200
200
200
200
200
200
201
201
201
200
200
200
201
201
201
201
200
200
200
200
200
200
200
200
200
200
200
199
200
200
200
200
200
200
201
201
201
201
201
201
200
201
201
202
201
201
201
201
201
201
201
201
202
201
202
202
202
203
202
202
203
203
203
203
202
202
202
202
203
203
202
202
202
202
202
201
200
202
201
200
199
199
199
199
199
199
199
199
199
199
199
199
199
200
200
200
200
200
200
200
199
200
200
200
200
200
200
200
200
200
200
199
200
199
200
200
201
202
201
201
201
201
201
201
201
201
199
199
199
199
199
199
199
199
199
199
199
199
199
199
198
197
197
197
196
196
196
196
196
196
196
196
197
197
197
197
197
197
197
197
197
197
196
198
198
198
199
199
198
198
198
198
198
198
198
198
199
200
200
200
200
200
200
199
199
200
199
199
199
199
199
199
199
199
199
198
199
198
200
200
200
199
199
199
199
199
199
199
200
200
200
200
200
200
200
200
200
200
200
198
200
201
201
201
201
201
200
200
199
199
199
200
199
199
200
200
200
201
200
200
200
200
200
200
200
200
200
200
200
199
199
199
200
200
200
200
200
200
199
199
199
199
200
200
199
199
199
199
200
199
200
201
201
199
199
199
200
200
200
200
201
201
202
201
202
201
201
201
202
202
202
203
202
202
203
203
203
204
203
203
204
204
204
204
204
205
205
206
205
206
207
207
206
206
206
208
207
208
209
208
209
209
209
209
209
209
209
209
210
210
210
211
211
211
210
210
210
210
210
209
209
209
209
208
209
208
208
208
209
209
209
208
208
208
206
206
205
205
204
204
205
205
205
205
204
204
205
205
204
204
203
203
204
204
204
203
202
202
202
202
202
201
201
201
200
200
200
200
200
200
200
201
201
200
201
201
200
200
200
200
200
200
201
201
200
201
201
201
200
200
200
201
201
201
201
201
201
201
201
201
201
201
201
202
201
202
203
203
204
202
202
202
202
202
202
202
201
201
201
201
200
201
201
201
200
200
200
200
200
199
199
200
199
200
200
200
201
201
201
201
202
201
200
200
198
199
199
199
199
199
199
198
199
199
199
198
198
198
198
198
198
198
198
198
198
197
198
198
199
199
199
199
200
200
200
200
201
201
200
201
201
201
201
201
202
202
202
201
201
201
202
202
202
201
201
201
202
202
202
201
201
202
201
200
200
200
200
200
200
200
200
200
199
199
199
198
198
198
198
198
200
200
200
199
199
199
199
199
198
197
197
197
197
197
197
196
196
197
198
198
197
197
197
197
196
196
196
195
195
196
197
198
197
197
197
197
197
197
197
198
198
199
198
197
198
197
197
197
197
197
197
196
196
196
196
196
195
196
196
196
196
196
196
195
198
197
197
197
197
196
197
197
196
196
196
196
196
197
199
199
199
198
198
198
198
198
198
197
198
198
198
198
199
198
198
198
198
198
198
198
199
199
199
199
200
200
200
200
200
200
200
200
200
200
200
199
200
200
200
200
200
200
200
199
199
199
200
200
199
199
199
199
199
199
199
201
201
201
202
202
202
202
202
202
202
202
202
202
201
202
203
203
202
203
203
203
203
203
203
202
202
202
201
200
200
200
200
200
200
200
200
200
199
199
199
198
198
198
198
198
198
198
198
198
197
196
197
197
196
197
196
196
195
195
195
195
197
196
196
196
196
197
198
198
197
197
197
198
198
198
198
198
198
198
198
198
199
199
199
199
200
200
199
199
199
200
200
200
199
199
199
199
200
200
200
199
201
201
201
201
200
200
200
200
199
200
200
200
200
199
199
199
199
199
199
199
200
200
200
201
201
201
201
201
202
202
202
202
203
201
203
203
204
205
205
205
205
205
205
205
204
204