Subversion Repositories NaviCtrl

Rev

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

Rev 421 Rev 426
1
#ifndef _SPI_SLAVE_H
1
#ifndef _SPI_SLAVE_H
2
#define _SPI_SLAVE_H
2
#define _SPI_SLAVE_H
3
 
3
 
4
#include "fifo.h"
4
#include "fifo.h"
5
#include "gps.h"
5
#include "gps.h"
6
 
6
 
7
#define SPEAK_CF_OFF            23
7
#define SPEAK_CF_OFF            23
8
#define SPEAK_CALIBRATE     24
8
#define SPEAK_CALIBRATE     24
9
#define SPEAK_MIKROKOPTER   21
9
#define SPEAK_MIKROKOPTER   21
10
#define SPEAK_STARTING      52
10
#define SPEAK_STARTING      52
11
#define SPEAK_CF_ON             46
11
#define SPEAK_CF_ON             46
12
#define SPEAK_ERR_CALIBARTION  1
12
#define SPEAK_ERR_CALIBARTION  1
13
#define SPEAK_GPS_ON            50
13
#define SPEAK_GPS_ON            50
14
#define SPEAK_GPS_OFF           19
14
#define SPEAK_GPS_OFF           19
15
#define SPEAK_GPS_HOLD          17
15
#define SPEAK_GPS_HOLD          17
16
#define SPEAK_GPS_HOME          18
16
#define SPEAK_GPS_HOME          18
17
#define SPEAK_WP_REACHED        12
17
#define SPEAK_WP_REACHED        12
18
#define SPEAK_NEXT_WP           13
18
#define SPEAK_NEXT_WP           13
19
 
19
 
20
 
20
 
21
#define SS_PIN GPIO_ReadBit(GPIO2, GPIO_Pin_7)
21
#define SS_PIN GPIO_ReadBit(GPIO2, GPIO_Pin_7)
22
 
22
 
23
#define SPI_FCCMD_USER                  10
23
#define SPI_FCCMD_USER                  10
24
#define SPI_FCCMD_STICK                 11
24
#define SPI_FCCMD_STICK                 11
25
#define SPI_FCCMD_MISC                  12
25
#define SPI_FCCMD_MISC                  12
26
#define SPI_FCCMD_PARAMETER1    13
26
#define SPI_FCCMD_PARAMETER1    13
27
#define SPI_FCCMD_VERSION               14
27
#define SPI_FCCMD_VERSION               14
28
#define SPI_FCCMD_SERVOS                15
28
#define SPI_FCCMD_SERVOS                15
29
#define SPI_FCCMD_ACCU                  16
29
#define SPI_FCCMD_ACCU                  16
30
#define SPI_FCCMD_PARAMETER2    17
30
#define SPI_FCCMD_PARAMETER2    17
-
 
31
 
-
 
32
#define CHK_POTI(b,a) { if(a < 248) b = a; else b = FC.Poti[255 - a]; }
-
 
33
#define CHK_POTI_MM(b,a,min,max) {CHK_POTI(b,a); LIMIT_MIN_MAX(b, min, max); }
31
 
34
 
32
extern s32 Kalman_K;
35
extern s32 Kalman_K;
33
extern s32 Kalman_Kompass ;
36
extern s32 Kalman_Kompass ;
34
extern s32 Kalman_MaxDrift;
37
extern s32 Kalman_MaxDrift;
35
extern s32 Kalman_MaxFusion;
38
extern s32 Kalman_MaxFusion;
36
extern s32 ToFcGpsZ;
39
extern s32 ToFcGpsZ;
37
extern s32 ToFC_Rotate_C, ToFC_Rotate_S;
40
extern s32 ToFC_Rotate_C, ToFC_Rotate_S;
38
extern s32 HeadFreeStartAngle;
41
extern s32 HeadFreeStartAngle;
39
extern s16 FC_WP_EventChannel,LogFC_WP_EventChannel;
42
extern s16 FC_WP_EventChannel,LogFC_WP_EventChannel;
40
extern u32 ToFC_AltitudeRate;
43
extern u32 ToFC_AltitudeRate;
41
extern s32 ToFC_AltitudeSetpoint;
44
extern s32 ToFC_AltitudeSetpoint;
42
extern u8 NC_GPS_ModeCharacter;
45
extern u8 NC_GPS_ModeCharacter;
43
extern u8 FC_is_Calibrated;
46
extern u8 FC_is_Calibrated;
44
extern u8 FCCalibActive;
47
extern u8 FCCalibActive;
45
extern u8 SpeakHoTT;
48
extern u8 SpeakHoTT;
46
/*extern u8 MotorCurrent[12];
49
/*extern u8 MotorCurrent[12];
47
extern u8 MotorTemperature[12];
50
extern u8 MotorTemperature[12];
48
extern u8 MotorState[12];
51
extern u8 MotorState[12];
49
extern u8 MotorMaxPwm[12];
52
extern u8 MotorMaxPwm[12];
50
*/
53
*/
51
extern u8 BL_MinOfMaxPWM;  // indication if all BL-controllers run on full power
54
extern u8 BL_MinOfMaxPWM;  // indication if all BL-controllers run on full power
52
extern u32 FC_I2C_ErrorConter;
55
extern u32 FC_I2C_ErrorConter;
53
extern u8 FromFC_VarioCharacter;
56
extern u8 FromFC_VarioCharacter;
54
extern u8 Logging_FCStatusFlags1,Logging_FCStatusFlags2;
57
extern u8 Logging_FCStatusFlags1,Logging_FCStatusFlags2;
55
extern s16 POI_KameraNick;
58
extern s16 POI_KameraNick;
56
extern u8 NC_To_FC_Flags;
59
extern u8 NC_To_FC_Flags;
57
typedef struct
60
typedef struct
58
{
61
{
59
        u8   Command;
62
        u8   Command;
60
        s16  AngleNick;  // NickAngle in 0.1 deg
63
        s16  AngleNick;  // NickAngle in 0.1 deg
61
        s16  AngleRoll;  // RollAngle in 0.1 deg
64
        s16  AngleRoll;  // RollAngle in 0.1 deg
62
        s16  AccNick;
65
        s16  AccNick;
63
        s16  AccRoll;
66
        s16  AccRoll;
64
        s16  GyroHeading; // Heading in 0.1 deg
67
        s16  GyroHeading; // Heading in 0.1 deg
65
        s16  GyroNick;
68
        s16  GyroNick;
66
        s16  GyroRoll;
69
        s16  GyroRoll;
67
        s16  GyroYaw;
70
        s16  GyroYaw;
68
        u16  FCStatus;
71
        u16  FCStatus;
69
        union
72
        union
70
        {
73
        {
71
                u8    Byte[12];
74
                u8    Byte[12];
72
                s8        sByte[12];
75
                s8        sByte[12];
73
                u16   Int[6];
76
                u16   Int[6];
74
                s16   sInt[6];
77
                s16   sInt[6];
75
                u32   Long[3];
78
                u32   Long[3];
76
                s32   sLong[3];
79
                s32   sLong[3];
77
                float Float[3];
80
                float Float[3];
78
        } Param;
81
        } Param;
79
        u8 Chksum;
82
        u8 Chksum;
80
 } __attribute__((packed)) FromFlightCtrl_t;
83
 } __attribute__((packed)) FromFlightCtrl_t;
81
 
84
 
82
//NC_To_FC_Flags
85
//NC_To_FC_Flags
83
#define NC_TO_FC_FLYING_RANGE           0x01
86
#define NC_TO_FC_FLYING_RANGE           0x01
84
#define NC_TO_FC_EMERGENCY_LANDING      0x02
87
#define NC_TO_FC_EMERGENCY_LANDING      0x02
85
 
88
 
86
#define SPI_NCCMD_OSD_DATA              100
89
#define SPI_NCCMD_OSD_DATA              100
87
#define SPI_NCCMD_GPS_POS               101
90
#define SPI_NCCMD_GPS_POS               101
88
#define SPI_NCCMD_GPS_TARGET    102
91
#define SPI_NCCMD_GPS_TARGET    102
89
#define SPI_NCCMD_KALMAN                103
92
#define SPI_NCCMD_KALMAN                103
90
#define SPI_NCCMD_VERSION               104
93
#define SPI_NCCMD_VERSION               104
91
#define SPI_NCCMD_GPSINFO               105
94
#define SPI_NCCMD_GPSINFO               105
92
#define SPI_NCCMD_HOTT_INFO             106
95
#define SPI_NCCMD_HOTT_INFO             106
93
#define SPI_MISC                                107
96
#define SPI_MISC                                107
94
 
97
 
95
#define HOTT_VARIO_PACKET_ID            0x89
98
#define HOTT_VARIO_PACKET_ID            0x89
96
#define HOTT_GPS_PACKET_ID                      0x8A
99
#define HOTT_GPS_PACKET_ID                      0x8A
97
#define HOTT_ELECTRIC_AIR_PACKET_ID     0x8E
100
#define HOTT_ELECTRIC_AIR_PACKET_ID     0x8E
98
#define HOTT_GENERAL_PACKET_ID          0x8D
101
#define HOTT_GENERAL_PACKET_ID          0x8D
99
 
102
 
100
typedef struct
103
typedef struct
101
{
104
{
102
        u8 Command;
105
        u8 Command;
103
        GPS_Stick_t GPSStick;
106
        GPS_Stick_t GPSStick;
104
        s16 MagVecX;
107
        s16 MagVecX;
105
        s16 CompassHeading;
108
        s16 CompassHeading;
106
        s16 AccErrorN;
109
        s16 AccErrorN;
107
        s16 AccErrorR;
110
        s16 AccErrorR;
108
        s16 MagVecY;
111
        s16 MagVecY;
109
        s16 MagVecZ;  
112
        s16 MagVecZ;  
110
        u16 BeepTime;
113
        u16 BeepTime;
111
        union
114
        union
112
        {
115
        {
113
                u8    Byte[12];
116
                u8    Byte[12];
114
                s8    sByte[12];
117
                s8    sByte[12];
115
                u16       Int[6];
118
                u16       Int[6];
116
                s16   sInt[6];
119
                s16   sInt[6];
117
                u32   Long[3];
120
                u32   Long[3];
118
                s32   sLong[3];
121
                s32   sLong[3];
119
                float Float[3];
122
                float Float[3];
120
        }Param;
123
        }Param;
121
        u8 Chksum;
124
        u8 Chksum;
122
 } __attribute__((packed)) ToFlightCtrl_t;
125
 } __attribute__((packed)) ToFlightCtrl_t;
123
 
126
 
124
typedef struct
127
typedef struct
125
{
128
{
126
 u8 Current;
129
 u8 Current;
127
 u8 Temperature;
130
 u8 Temperature;
128
 u8 MaxPWM;
131
 u8 MaxPWM;
129
 u8 State;
132
 u8 State;
130
} __attribute__((packed)) Motor_t;
133
} __attribute__((packed)) Motor_t;
131
 
134
 
132
extern Motor_t Motor[12];
135
extern Motor_t Motor[12];
133
 
136
 
134
typedef struct
137
typedef struct
135
{
138
{
136
   u8 Major;
139
   u8 Major;
137
   u8 Minor;
140
   u8 Minor;
138
   u8 Patch;
141
   u8 Patch;
139
   u8 Compatible;
142
   u8 Compatible;
140
   u8 Hardware;
143
   u8 Hardware;
141
} __attribute__((packed)) SPI_Version_t;
144
} __attribute__((packed)) SPI_Version_t;
142
 
145
 
143
extern FromFlightCtrl_t   FromFlightCtrl;
146
extern FromFlightCtrl_t   FromFlightCtrl;
144
extern ToFlightCtrl_t     ToFlightCtrl;
147
extern ToFlightCtrl_t     ToFlightCtrl;
145
extern volatile u32 SPI0_Timeout;
148
extern volatile u32 SPI0_Timeout;
146
extern SPI_Version_t FC_Version;
149
extern SPI_Version_t FC_Version;
147
extern u8 GPS_Aid_StickMultiplikator;
150
extern u8 GPS_Aid_StickMultiplikator;
148
extern u8 CompassCalState;
151
extern u8 CompassCalState;
149
 
152
 
150
void SPI0_Init(void);
153
void SPI0_Init(void);
151
void SPI0_GetFlightCtrlVersion(void);
154
void SPI0_GetFlightCtrlVersion(void);
152
void SPI0_UpdateBuffer(void);
155
void SPI0_UpdateBuffer(void);
153
 
156
 
154
 
157
 
155
 
158
 
156
#endif //_SPI_SLAVE_H
159
#endif //_SPI_SLAVE_H
157
 
160