hdgps.txt

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

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