Subversion Repositories FlightCtrl

Rev

Rev 2025 | Go to most recent revision | Details | Last modification | View Log | RSS feed

Rev Author Line No. Line
1910 - 1 
#include "ADXRS610_FC2.0.h"
2 
#include "configuration.h"
3 
 
4 
const uint8_t GYRO_QUADRANT = 3;
5 
//const uint8_t ACC_QUADRANT = 0;
6 
const uint8_t YAW_REVERSED = 0;
7 
const uint8_t GYROS_REVERSED = 0;
8 
 
9 
const uint8_t Z_ACC_REVERSED = 0;
10 
 
11 
void gyro_calibrate(void) {
12 
}
13 
 
14 
void gyro_setDefaults(void) {
15 
        staticParams.DriftComp = 0;
16 
        staticParams.GyroAccFactor = 1;
17 
        staticParams.GyroAccTrim = 0;
18 
}
19 
 
20 
/*
21 
 
22 
normal  1rev  2rev
23 
 
24 
1 0    -1 0    1  0
25 
 
26 
 
27 
45
28 
1 -1   -1 -1   1  1
29 
1  1   -1  1   1 -1
30 
 
31 
90
32 
 
33 
1  0   -1  0   1  0
34 
 
35 
135
36 
-1 -1   1 -1  -1  1
37 
1  -1  -1 -1   1  1
38 
 
39 
180
40 
-1 0    1  0   -1 0
41 
 
42 
 
43 
225
44 
-1 1    1  1   -1 -1
45 
-1 -1   1 -1   -1  1
46 
 
47 
270
48 
 
49 
-1 0    1  0   -1 0
50 
 
51 
315
52 
 1 1   -1  1   1 -1
53 
-1 1    1  1  -1 -1
54 
 
55 
 
56 
0,0: 1,1,0,-1,-1,-1,0,1 paddp = tab[n]
57 
0,1: 0,-1,-1,-1,0,1,1,1 paddr = tab[n+2]
58 
1,0: 0,1,1,1,0,-1,-1,-1 raddp = tab[n+6]
59 
1,1: 1,1,0,-1,-1,-1,0,1 raddr = tab[n]
60 
 
61 
reverse:
62 
0,0: -1,-1,0,1,1,1,0,-1 paddp = tab[n+4]
63 
0,1: 0,-1,-1,-1,0,1,1,1 (same)= tab[n+2]
64 
1,0: 0,-1,-1,-1,0,1,1,1 raddp = tab[n+2]
65 
1,1: 1,1,0,-1,-1,-1,0,1 (same)= tab[n]
66 
 
67 
               = 1rev[n-4] = 1rev[n+4]
68 
*/