halt.txt

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

90
90
90
90
89
90
90
90
90
90
90
90
90
91
90
90
90
91
90
90
91
91
91
91
91
91
90
90
91
91
92
92
91
91
91
90
91
91
91
90
90
91
92
92
92
92
92
92
91
91
91
91
92
91
91
91
91
91
91
92
91
92
92
93
92
93
93
93
93
93
93
92
92
93
93
93
93
93
93
93
93
93
93
93
94
94
94
95
95
95
96
96
94
94
94
96
96
97
96
96
97
97
96
96
95
95
95
95
97
97
97
98
99
98
99
99
98
98
98
99
99
99
99
99
99
99
100
100
100
100
100
100
100
101
101
102
101
102
102
102
102
102
102
103
103
104
104
104
105
106
105
105
105
105
105
105
106
106
106
107
107
107
108
108
108
108
108
108
108
109
109
109
110
109
110
110
110
110
110
110
111
111
111
112
112
112
113
113
113
113
113
114
113
112
112
113
114
114
114
114
114
114
114
115
114
114
114
115
115
115
114
114
115
115
115
115
115
115
116
115
115
115
115
115
116
116
116
116
115
114
114
114
114
115
115
115
116
116
116
115
116
116
116
115
117
116
116
116
115
115
115
116
116
116
118
117
117
118
117
117
118
118
118
117
118
118
118
118
118
118
119
119
119
119
119
119
120
119
119
120
120
120
120
120
119
119
119
121
121
121
122
123
123
122
122
122
123
123
123
123
123
123
125
124
124
125
125
125
124
124
124
125
125
125
126
126
127
127
127
127
127
127
127
127
128
128
129
129
128
130
130
130
130
130
130
131
130
130
131
131
130
129
129
129
131
131
131
132
134
134
134
133
134
135
135
135
136
136
136
135
135
135
135
134
134
134
134
134
136
136
136
136
137
136
136
136
136
136
135
135
136
136
136
136
137
137
138
139
138
138
137
137
139
139
139
138
140
140
138
139
139
139
138
138
139
139
139
141
140
141
141
142
142
143
143
143
144
144
144
143
144
144
145
146
145
145
145
145
145
145
145
146
147
147
147
148
146
149
148
148
150
150
150
150
149
148
148
149
149
149
149
149
150
150
150
150
151
151
151
152
152
152
153
153
153
153
153
152
152
152
153
153
153
153
153
153
154
154
154
155
155
156
157
156
160
157
157
157
157
157
157
158
158
159
161
160
158
158
158
158
158
158
158
159
158
161
160
162
159
161
161
161
159
159
159
160
160
159
162
162
160
161
160
160
160
160
160
164
163
164
163
163
165
162
163
163
162
162
162
163
164
164
165
165
166
165
164
164
165
165
165
167
166
165
165
166
167
169
167
167
171
171
171
168
168
170
169
168
168
169
171
171
170
170
170
169
170
168
167
167
168
170
170
170
172
172
172
172
172
172
172
171
171
173
173
173
172
172
172
173
173
171
174
173
175
172
172
172
173
173
173
174
174
174
175
174
176
174
173
173
173
173
173
175
175
174
174
174
174
174
174
174
175
175
175
176
174
175
174
176
177
176
176
176
175
175
175
175
177
179
176
174
173
176
174
174
177
177
177
178
176
176
175
176
177
177
174
174
175
175
175
175
175
175
175
177
175
176
176
176
178
178
178
176
177
177
176
176
176
176
176
176
177
177
177
176
177
176
175
177
176
177
176
176
176
176
176
175
175
173
174
174
171
170
170
170
168
168
168
169
168
170
168
170
170
171
170
170
168
168
168
168
169
168
170
169
167
168
170
170
166
166
166
164
165
168
167
167
167
166
165
165
167
167
167
166
168
167
166
166
167
166
168
168
168
168
168
166
165
165
164
164
165
164
163
163
164
164
164
164
164
165
164
164
163
164
164
164
165
165
165
164
165
165
167
165
167
166
166
166
169
169
169
168
169
168
171
171
172
170
170
170
172
172
172
173
170
173
173
174
176
176
178
178
178
178
178
177
177
180
181
181
180
182
182
182
181
181
181
182
183
182
186
184
185
187
189
189
187
187
187
188
186
188
189
189
188
188
189
189
189
189
189
188
187
189
190
188
188
187
188
188
187
187
187
187
189
189
190
188
189
189
189
189
188
188
188
189
188
187
192
187
188
189
189
189
188
188
188
188
187
187
189
187
187
188
189
189
188
188
188
187
189
188
189
187
188
187
186
186
189
189
189
187
188
188
191
188
190
187
189
189
187
187
187
188
188
190
190
189
189
189
189
189
188
188
188
188
190
190
188
187
189
189
189
189
189
189
189
186
187
189
189
188
188
188
187
187
188
188
188
188
190
189
190
190
189
188
188
188
191
191
191
191
188
191
190
191
190
188
189
189
191
191
191
190
189
191
193
192
190
190
191
191
189
189
189
190
191
189
189
188
187
189
190
190
187
187
187
188
185
183
184
182
185
184
182
182
184
184
184
185
182
183
182
182
183
182
182
182
183
183
183
184
180
181
182
180
181
180
182
182
182
182
182
186
185
182
182
184
186
185
186
186
187
187
187
189
189
189
191
191
194
194
194
194
195
195
195
196
195
195
196
196
198
197
197
197
200
200
200
198
196
199
199
197
198
199
197
197
196
196
196
198
197
197
198
198
198
198
197
197
198
198
198
197
198
196
194
195
194
195
193
193
195
195
195
198
194
194
192
193
193
191
193
193
191
191
191
190
191
190
191
190
188
190
189
189
189
189
189
189
187
188
188
187
188
186
186
186
186
186
186
185
187
188
188
186
187
187
186
186
187
187
187
189
189
190
191
189
193
194
194
194
194
194
194
195
197
195
198
198
199
199
200
200
202
202
202
201
202
201
200
200
201
199
201
201
202
202
202
204
202
201
200
200
199
199
198
198
201
201
201
202
199
199
199
198
199
197
197
197
198
198
198
202
199
197
196
202
197
195
196
196
196
196
196
197
194
195
193
195
196
195
195
195
197
197
197
195
195
193
195
194
198
195
196
196
197
197
197
198
197
198
198
198
197
199
197
197
197
197
197
200
198
197
197
194
196
196
197
197
194
194
194
193
194
192
193
190
193
190
192
192
188
188
188
190
189
188
188
188
187
184
183
183
185
185
185
187
184
183
184
183
186
185
185
185
187
187
187
183
183
184
184
183
184
181
181
181
179
179
179
180
180
180
178
176
176
179
177
177
174
174
174
174
173
177
174
174
174
174
173
173
173
173
173
173
172
172
172
170
169
171
169
169
170
170
170
170
171
169
169
169
170
169
168
168
166
166
166
167
167
165
166
166
166
165
166
166
166
166
166
164
166
168
168
167
168
168
168
168
169
169
169
170
169
170
167
169
171
171
171
171
169
169
169
172
173
171
171
174
173
173
173
173
173
173
173
173
174
174
175
175
174
174
175
175
173
173
173
175
175
177
176
176
176
177
175
175
175
175
175
176
175
177
176
175
175
175
175
175
175
175
175
179
175
177
175
175
177
175
177
177
174
174
174
176
176
175
177
175
175
177
176
176
175
175
175
175
173
173
172
172
173
173
173
173
172
172
172
173
174
174
173
173
175
176
176
176
176
176
176
176
176
175
176
176
176
176
177
177
177
177
177
179
178
178
180
178
179
180
179
179
179
179
179
178
181
183
183
181
183
182
181
181
181
181
181
183
182
184
183
182
182
183
184
184
184
184
184
186
185
186
185
186
187
186
186
186
185
185
185
187
188
187
188
189
188
189
188
188
188
188
188
188
189
189
191
190
190
191
190
190
191
191
191
191
191
190
192
190
191
190
190
190
192
192
192
192
191
190
190
191
191
191
191
191
192
192
192
193
194
192
192
190
193
189
189
189
191
191
191
191
190
190
188
187
185
191
187
187
186
186
186
188
188
187
186
187
186
186
186
186
186
186
186
187
188
187
185
187
186
186
187
187
186
186
186
187
186
184
185
185
184
186
185
185
184
184
184
185
183
186
185
183
184
185
184
184
184
184
184
184
183
182
182
183
183
182
182
182
181
181
181
182
181
182
181
181
182
181
181
181
182
182
182
183
181
183
181
181
183
182
182
182
183
183
183
185
182
182
183
183
183
184
183
183
183
183
183
183
183
185
183
183
182
183
181
181
183
183
183
184
185
181
182
182
185
186
186
186
183
183
183
185
183
184
185
186
186
184
185
185
186
186
186
185
186
186
187
188
189
191
190
190
188
188
188
190
190
190
193
191
193
191
192
192
191
191
191
192
191
193
193
192
191
191
192
192
192
192
192
192
192
192
193
194
194
195
193
193
193
193
193
193
196
197
197
197
194
194
195
195
195
195
195
195
194
195
196
195
195
194
195
195
196
196
196
195
192
193
193
192
192
191
191
191
191
191
191
192
192
189
191
191
189
189
188
188
189
189
189
187
187
188
187
189
186
187
186
186
186
186
186
186
185
186
185
187
186
186
186
186
186
186
186
184
185
186
184
184
185
184
185
185
185
185
185
183
183
182
183
181
182
181
182
182
179
179
179
182
183
182
180
181
182
180
182
182
181
181
181
182
182
184
184
183
183
182
182
182
182
182
182
182
183
183
182
182
182
181
183
183
181
181
181
181
185
187
181
181
181
180
180
180
182
182
182
180
182
181
181
181
182
181
180
180
182
182
182
182
184
181
182
182
180
182
183
183
182
182
182
181
184
183
180
183
182
182
182
182
184
184
184
182
184
186
185
188
185
185
185
185
185
185
185
186
188
188
189
190
189
189
191
191
190
190
190
190
191
192
192
192
193
195
195
195
193
193
193
197
196
196
199
199
196
199
201
201
201
201
201
199
200
196
202
200
201
198
200
200
199
199
199
200
203
202
202
202
203
205
204
204
204
204
204
204
205
204
205
202
203
203
203
203
204
204
204
202
204
201
203
199
200
196
201
201
197
197
197
197
197
197
198
197
201
198
202
202
197
197
197
198
197
198
200
198
196
196
198
198
197
197
197
199
200
198
198
199
199
198
200
200
200
200
200
200
200
202
199
205
202
203
204
204
202
202
202
203
202
201
205
203
202
200
200
200
203
203
203
201
203
200
200
202
203
201
200
200
200
200
200
201
203
200
200
199
200
201
201
201
200
200
200
200
199
201
200
200
199
199
199
199
201
201
201
200
199
199
199
201
198
200
201
201
199
199
199
201
202
201
202
201
202
202
202
202
199
199
199
201
200
199
201
203
201
201
202
202
201
201
201
200
203
203
202
202
204
202
204
204
203
203
203
203
205
203
205
205
205
205
205
205
206
206
206
206
209
207
207
208
206
206
208
208
208
208
208
208
210
209
208
209
209
210
209
209
209
209
209
209
209
210
210
210
208
209
207
207
208
208
208
207
209
208
209
207
206
206
207
207
205
205
205
207
207
207
204
208
207
207
207
207
208
208
208
206
207
206
205
206
207
207
207
207
205
205
205
207
205
206
207
208
206
205
205
205
206
206
206
206
203
205
204
206
206
204
205
205
205
205
205
204
205
205
204
206
206
206
207
207
206
206
206
207
206
206
205
207
205
204
204
204
206
206
206
205
209
206
208
207
208
206
208
208
208
208
208
210
209
208
208
207
206
206
206
206
206
206
206
209
209
209
209
209
207
207
208
208
207
207
207
209
209
209
208
211
210
210
210
210
211
211
211
212
211
211
212
210
209
209
210
210
210
210
210
213
210
210
211
211
212
211
211
211
210
210
210
209
210
211
210
209
212
210
210
210
210
210
210
209
208
209
208
208
209
209
212
212
208
208
208
209
209
209
211
212
211
210
210
210
209
209
209
213
208
209
208
210
208
209
210
210
209
209
209
210
209
208
209
210
208
208
208
208
209
209
209
211
210
213
212
210
210
210
208
208
211
211
211
209
210
210
210
213
213
212
211
211
210
210
210
209
211
211
210
214
210
211
210
210
207
207
207
211
209
210
211
211
211
211
212
212
212
212
212
212
212
211
212
211
210
209
212
212
211
211
211
213
211
211
209
211
213
211
211
211
211
211
211
210
209
209
208
208
208
208
208
208
209
209
209
210
210
210
209
211
210
211
210
210
212
212
212
213
213
212
212
216
215
216
216
216
216
216
216
217
216
216
216
218
219
220
218
218
219
219
219
218
218
218
220
218
217
220
218
218
220
220
220
219
220
218
220
221
221
220
221
221
219
219
219
219
224
223
223
222
220
221
219
219
219
219
219
217
218
217
219
219
219
220
221
221
220
220
220
218
218
218
221
217
216
218
216
216
216
216
216
216
215
217
214
215
215
215
214
214
215
215
215
216
216
215
216
215
215
214
214
214
212
212
212
211
213
214
215
216
213
216
214
214
215
215
215
214
213
215
214
213
213
213
211
211
212
212
212
210
212
210
211
211
211
210
211
211
213
213
213
213
212
214
216
215
215
214
213
213
212
212
212
212
212
215
214
215
213
212
212
212
213
213
213
213
213
210
213
213
213
213
213
213
214
214
214
213
213
214
214
213
213
212
214
214
217
217
217
214
214
215
216
212
215
211
212
212
214
214
214
214
213
212
213
212
212
211
212
212
211
211
211
211
210
209
211
212
213
212
211
211
210
210
210
211
209
213
212
213
211
211
210
210
212
212
212
211
213
212
211
213
212
209
213
213
212
212
212
212
211
214
212
213
210
212
211
211
211
211
211
211
210
211
210
213
211
213
214
214
209
209
209
210
211
211
210
212
212
212
212
212
211
211
211
213
213
212
211
216
213
214
214
214
215
215
215
212
213
212
212
213
213
214
216
216
214
214
214
215
213
215
213
214
215
214
216
216
216
216
216
214
212
215
212
214
215
214
214
214
212
212
212
213
212
215
215
215
215
216
215
215
215
215
215
216
214
214
213
217
214
215
215
215
216
216
216
216
216
218
219
217
218
217
219
219
215
215
215
216
217
216
215
218
215
218
216
216
216
216
216
217
218
220
217
217
216
218
221
221
218
218
218
217
215
218
223
219
219
219
219
219
219
219
219
219
221
221
217
219
222
217
217
217
219
219
219
221
220
218
221
217
219
224
224
224
221
221
221
218
223
220
221
224
221
221
220
220
221
221
221
220
220
220
220
221
218
221
222
222
222
222
222
221
219
222
219
218
218
219
218
218
218
218
218
218
218
220
219
223
220
217
217
217
215
215
215
219
216
216
217
215
215
217
217
217
217
217
217
219
219
219
219
219
220
219
220
220
219
219
219
220
220
221
221
220
219
217
217
217
220
220
220
218
218
220
218
221
221
223
221
221
219
219