blob: 1c375af5dfd7fd517fb92b2c106e26fe00f524ca (
plain) (
blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
|
/* Kalman matrix for both
* step = 0.01
* σ_m = 2
* σ_h = 6
* σ_a = 2
*/
#define AO_BOTH_K00_100 to_fix32(0.0081313788)
#define AO_BOTH_K01_100 to_fix32(0.0000026340)
#define AO_BOTH_K10_100 to_fix32(0.0531117402)
#define AO_BOTH_K11_100 to_fix32(0.0038194319)
#define AO_BOTH_K20_100 to_fix32(0.0000749238)
#define AO_BOTH_K21_100 to_fix32(0.6180339885)
/* Kalman matrix for both
* step = 0.1
* σ_m = 2
* σ_h = 6
* σ_a = 2
*/
#define AO_BOTH_K00_10 to_fix32(0.0783434385)
#define AO_BOTH_K01_10 to_fix32(0.0002339223)
#define AO_BOTH_K10_10 to_fix32(0.5113498998)
#define AO_BOTH_K11_10 to_fix32(0.0379865308)
#define AO_BOTH_K20_10 to_fix32(0.0066537889)
#define AO_BOTH_K21_10 to_fix32(0.6180320115)
/* Kalman matrix for accel
* step = 0.01
* σ_m = 2
* σ_a = 4
*/
#define AO_ACCEL_K0_100 to_fix32(0.0000078547)
#define AO_ACCEL_K1_100 to_fix32(0.0060961179)
#define AO_ACCEL_K2_100 to_fix32(0.3903882032)
/* Kalman matrix for accel
* step = 0.1
* σ_m = 2
* σ_a = 4
*/
#define AO_ACCEL_K0_10 to_fix32(0.0007854668)
#define AO_ACCEL_K1_10 to_fix32(0.0609611795)
#define AO_ACCEL_K2_10 to_fix32(0.3903882032)
/* Kalman matrix for baro
* step = 0.01
* σ_m = 2
* σ_h = 6
*/
#define AO_BARO_K0_100 to_fix32(0.0623382088)
#define AO_BARO_K1_100 to_fix32(3.2096898314)
#define AO_BARO_K2_100 to_fix32(5.1644233483)
/* Kalman matrix for baro
* step = 0.1
* σ_m = 2
* σ_h = 6
*/
#define AO_BARO_K0_10 to_fix32(0.2582626767)
#define AO_BARO_K1_10 to_fix32(6.1612340969)
#define AO_BARO_K2_10 to_fix32(4.5932892444)
|
