hadc.txt

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

-2000
-2000
-2000
-50
-50
-50
-51
-51
-51
-50
-51
-50
-50
-50
-50
-50
-51
-51
-50
-50
-50
-51
-51
-51
-50
-50
-50
-50
-50
-50
-50
-50
-50
-51
-50
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-50
-50
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-51
-50
-51
-50
-50
-50
-51
-51
-51
-50
-50
-51
-50
-51
-51
-51
-50
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-50
-50
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-50
-50
-50
-51
-51
-51
-50
-50
-50
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-51
-51
-51
-50
-50
-51
-51
-51
-51
-51
-51
-50
-50
-51
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-51
-51
-51
-51
-51
-51
-51
-50
-50
-50
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-50
-50
-50
-51
-51
-51
-51
-51
-50
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-51
-50
-50
-50
-50
-50
-50
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-50
-51
-51
-51
-51
-51
-50
-50
-51
-51
-51
-51
-50
-50
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-50
-50
-50
-50
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-50
-50
-51
-51
-51
-50
-51
-51
-51
-51
-50
-50
-50
-51
-51
-51
-51
-51
-51
-51
-50
-50
-51
-51
-51
-51
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-51
-51
-50
-51
-51
-50
-50
-50
-50
-50
-51
-50
-50
-50
-51
-51
-50
-50
-50
-50
-50
-50
-51
-51
-50
-50
-50
-50
-50
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-50
-50
-51
-51
-50
-50
-50
-50
-51
-50
-51
-51
-51
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-51
-51
-51
-51
-50
-50
-50
-51
-51
-50
-51
-50
-51
-51
-51
-51
-50
-50
-50
-51
-51
-51
-51
-50
-50
-51
-50
-50
-50
-50
-50
-50
-51
-51
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-51
-51
-50
-51
-50
-50
-50
-50
-51
-51
-51
-50
-51
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-50
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-51
-51
-51
-51
-51
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-51
-50
-50
-50
-50
-50
-50
-50
-50
-51
-51
-50
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-50
-50
-51
-51
-51
-50
-50
-50
-50
-51
-50
-50
-51
-51
-51
-51
-51
-50
-50
-50
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-51
-51
-51
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-50
-50
-50
-50
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-50
-50
-50
-51
-51
-51
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-50
-50
-51
-51
-51
-51
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-50
-51
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-51
-50
-51
-51
-51
-50
-50
-50
-50
-51
-51
-51
-50
-51
-51
-50
-50
-50
-50
-50
-51
-51
-50
-50
-51
-50
-51
-51
-51
-51
-51
-51
-50
-50
-50
-50
-50
-51
-51
-51
-51
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-50
-50
-50
-50
-51
-51
-50
-50
-50
-50
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-50
-51
-50
-50
-50
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-51
-51
-51
-51
-51
-51
-50
-50
-51
-50
-51
-50
-50
-51
-51
-50
-50
-50
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-50
-51
-51
-51
-51
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-50
-50
-51
-50
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-50
-50
-50
-50
-50
-51
-50
-50
-50
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-50
-50
-51
-51
-51
-50
-50
-50
-50
-50
-51
-51
-50
-51
-51
-51
-50
-50
-50
-50
-50
-50
-51
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-51
-50
-51
-51
-50
-50
-50
-50
-50
-50
-50
-50
-50
-51
-50
-50
-51
-50
-50
-51
-51
-50
-50
-50
-50
-51
-50
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-51
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-51
-51
-50
-50
-51
-51
-51
-51
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-51
-50
-50
-51
-50
-50
-50
-50
-50
-50
-50
-50
-51
-51
-50
-51
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-51
-51
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-51
-51
-51
-51
-51
-50
-50
-50
-50
-51
-50
-50
-50
-50
-50
-51
-51
-50
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-50
-51
-51
-51
-51
-51
-51
-51
-50
-50
-50
-51
-51
-50
-50
-50
-50
-51
-51
-51
-51
-50
-50
-50
-50
-50
-51
-50
-50
-50
-50
-50
-50
-50
-50
-50
-51
-51
-50
-51
-51
-51
-51
-51
-51
-51
-51
-51
-50
-50
-51
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-51
-50
-50
-50
-51
-51
-51
-50
-50
-50
-50
-50
-50
-51
-51
-50
-50
-50
-50
-51
-51
-51
-50
-50
-51
-50
-50
-50
-50
-51
-51
-51
-51
-51
-51
-51
-50
-50
-50
-50
-51
-50
-50
-50
-50
-50
-51
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-51
-51
-50
-50
-50
-50
-50
-50
-50
-50
-50
-51
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-51
-51
-50
-50
-50
-51
-51
-50
-50
-50
-51
-51
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-51
-51
-50
-50
-50
-50
-50
-50
-51
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-51
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-51
-50
-50
-50
-50
-51
-51
-51
-51
-51
-50
-50
-51
-51
-51
-51
-50
-51
-51
-51
-51
-51
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-50
-51
-51
-51
-50
-50
-51
-50
-50
-50
-50
-51
-51
-50
-50
-50
-50
-50
-50
-50
-51
-50
-51
-51
-51
-51
-51
-51
-50
-50
-1
-1
-1
-1
-1
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
-1
0
0
0
0
0
0
0
0
0
0
0
0
-1
-1
-1
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
-1
-1
-1
0
0
0
0
0
0
0
0
0
0
0
0
-1
-1
-1
-1
-1
-1
0
0
0
-1
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
-1
-1
-1
-1
0
0
0
0
0
0
0
0
0
0
0
0
0
0
-1
0
0
0
0
0
0
0
0
0
-1
0
-1
0
-1
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
-1
0
0
0
-1
0
0
0
0
0
0
0
0
-1
-1
0
-1
-1
-1
-1
-1
-1
-1
-1
0
-1
-1
-1
0
-1
-1
-1
-1
-1
-1
-1
0
-1
0
0
-1
-1
0
0
0
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
0
-1
-1
-1
-1
-1
-1
-1
-1
0
-2
0
0
0
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-2
-2
-2
-2
-1
-1
-1
0
0
-1
-1
-1
-1
-2
0
0
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
0
-1
-1
0
-1
1
-1
-1
-1
0
0
0
-1
0
0
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
0
-1
0
-1
-1
-1
-1
-1
-1
-1
-1
0
0
0
-1
-1
-1
-1
0
0
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-2
-2
-1
0
-1
-1
-1
-1
-1
0
-1
-1
0
0
-1
0
1
1
1
1
1
0
0
-1
0
-2
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-1
-2
0
0
0
-1
-1
-1
-1
-1
-1
0
0
0
0
0
0
0
0
0
-1
-1
1
1
1
1
1
1
1
0
0
0
0
0
1
1
2
0
0
0
0
0
0
0
1
1
1
0
0
-1
1
1
1
1
1
1
1
0
0
1
1
0
0
0
0
1
1
1
0
0
0
1
0
0
0
0
0
-2
-2
-2
-2
-1
0
0
0
0
0
0
0
-1
-1
-1
-1
-1
-1
0
1
1
0
0
0
0
0
0
0
-1
-1
-1
-1
-2
0
0
0
0
0
0
-2
-1
0
0
0
1
0
0
0
1
1
1
1
2
3
3
4
4
4
4
4
5
5
5
5
4
5
5
5
5
5
5
5
5
5
5
6
6
7
6
7
7
8
8
8
8
8
8
8
9
9
9
8
9
9
9
9
10
10
10
10
10
11
10
10
10
10
11
11
10
10
10
10
11
11
11
13
13
12
12
12
12
12
12
13
13
13
13
14
14
14
14
14
15
15
15
16
16
16
15
15
15
15
15
15
17
17
17
18
18
18
18
18
18
18
18
18
18
18
18
19
19
19
19
19
19
20
20
20
20
20
20
21
21
22
21
22
22
21
22
22
22
22
22
23
23
24
23
24
24
24
24
24
25
25
25
24
25
25
25
25
27
28
28
28
28
28
28
28
27
29
29
30
29
30
31
31
31
31
31
32
33
32
33
33
34
34
34
34
35
35
35
36
36
37
38
38
39
39
39
39
40
40
40
40
39
40
41
41
42
44
43
43
45
45
45
46
45
45
46
47
49
48
48
48
49
49
49
49
49
50
49
50
51
51
51
51
51
51
51
52
53
53
55
56
54
55
54
54
54
54
54
55
55
56
57
57
58
59
59
59
60
60
60
59
59
59
60
61
61
61
62
62
62
62
62
62
61
63
63
63
63
63
63
63
64
64
64
64
64
65
65
65
65
66
66
66
68
68
68
67
66
66
67
67
67
68
68
68
68
68
68
68
70
70
70
70
69
70
70
70
70
70
70
70
71
71
71
71
71
70
70
70
70
70
70
71
71
72
72
74
74
74
74
74
74
74
74
74
74
75
75
75
75
75
75
75
76
76
76
74
75
75
75
75
76
76
77
77
77
77
77
77
78
78
79
78
78
78
78
78
78
78
78
79
80
79
79
79
79
80
79
79
80
80
80
79
81
80
81
81
81
81
82
82
82
82
82
82
82
81
82
82
82
81
82
82
82
82
82
83
83
82
83
83
83
83
83
83
82
82
82
84
82
83
83
83
84
85
84
84
84
84
84
84
84
84
84
84
84
85
85
85
85
85
85
86
86
86
86
86
86
86
86
86
87
87
87
86
87
87
87
88
88
87
87
87
87
87
87
87
89
89
89
90
90
90
90
90
90
90
90
90
90
91
90
90
91
90
91
91
91
91
91
92
91
90
91
90
92
92
92
92
92
92
92
93
93
92
93
93
94
95
95
95
94
94
94
94
95
96
96
96
97
98
98
98
98
98
98
98
98
98
99
99
100
101
101
101
101
101
101
101
103
102
102
103
103
104
104
104
105
105
105
105
105
106
105
104
105
104
105
105
107
107
107
106
107
106
107
107
106
105
105
105
105
105
105
103
103
102
102
103
101
102
101
101
99
99
99
98
97
97
98
97
96
96
96
96
95
95
95
95
95
95
95
95
96
95
95
95
96
96
96
96
96
97
95
97
96
96
96
96
96
96
96
96
96
96
96
97
97
98
98
98
101
101
101
100
100
100
101
103
104
104
104
104
104
104
104
105
104
103
104
103
103
103
102
102
102
102
102
102
104
104
104
103
103
103
103
103
103
103
103
103
104
104
105
106
106
106
106
106
106
106
106
106
106
106
107
106
106
105
105
105
106
106
106
106
106
107
107
107
106
106
106
106
107
107
107
107
107
106
106
106
106
107
107
107
106
106
106
106
106
106
106
105
105
105
104
104
104
104
104
104
104
105
106
107
107
107
107
107
107
107
107
105
105
104
104
103
103
103
103
103
103
103
103
103
103
103
102
102
102
102
102
102
102
102