Subversion Repositories FlightCtrl

Rev

Rev 373 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 373 Rev 378
1
 
1
 
2
 
2
 
3
struct MM3_working_struct
3
struct MM3_working_struct
4
{
4
{
5
        uint8_t STATE;
5
        uint8_t STATE;
6
        unsigned int DRDY;
6
        unsigned int DRDY;
7
        uint8_t AXIS;
7
        uint8_t AXIS;
8
        signed int x_axis;
8
        signed int x_axis;
9
        signed int x_axis_old;
9
        signed int x_axis_old;
10
        signed int y_axis;
10
        signed int y_axis;
11
        signed int y_axis_old;
11
        signed int y_axis_old;
12
        signed int z_axis;
12
        signed int z_axis;
13
        signed int z_axis_old;
13
        signed int z_axis_old;
14
        signed int NickGrad;
14
        signed int NickGrad;
15
        signed int RollGrad;
15
        signed int RollGrad;
16
};
16
};
17
 
17
 
18
 
18
 
19
struct MM3_calib_struct
19
struct MM3_calib_struct
20
{
20
{
21
        int8_t X_off;
21
        int8_t X_off;
22
        int8_t Y_off;
22
        int8_t Y_off;
23
        int8_t Z_off;
23
        int8_t Z_off;
-
 
24
        uint16_t X_range;
-
 
25
        uint16_t Y_range;
-
 
26
        uint16_t Z_range;
24
};
27
};
25
 
28
 
26
extern struct MM3_working_struct MM3;
29
extern struct MM3_working_struct MM3;
27
extern struct MM3_calib_struct MM3_calib;
30
extern struct MM3_calib_struct MM3_calib;
28
 
31
 
29
void init_MM3(void);
32
void init_MM3(void);
30
void timer0_MM3(void);
33
void timer0_MM3(void);
31
void calib_MM3(void);
34
void calib_MM3(void);
32
signed int heading_MM3(void);
35
signed int heading_MM3(void);
33
 
36
 
34
#define Max_Axis_Value          500
37
#define Max_Axis_Value          500
35
 
38
 
36
// Die Werte der Statemachine
39
// Die Werte der Statemachine
37
#define MM3_RESET                       0
40
#define MM3_RESET                       0
38
#define MM3_START_TRANSFER      1
41
#define MM3_START_TRANSFER      1
39
#define MM3_WAIT_DRDY           2
42
#define MM3_WAIT_DRDY           2
40
#define MM3_DRDY                        4
43
#define MM3_DRDY                        3
41
#define MM3_BYTE2                       8
44
#define MM3_BYTE2                       4
42
#define MM3_X                           16
45
#define MM3_X                           5
43
#define MM3_Y                           32
46
#define MM3_Y                           6
44
#define MM3_Z                           64
47
#define MM3_Z                           7
45
#define MM3_TILT                        128
48
#define MM3_TILT                        8
-
 
49
#define MM3_IDLE                        9
46
 
50