hadc.txt

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

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