Subversion Repositories NaviCtrl

Rev

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

Rev 636 Rev 690
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
#include "main.h"
6
#include "main.h"
7
 
7
 
8
#define SPEAK_ERR_CALIBARTION  1
8
#define SPEAK_ERR_CALIBARTION  1
9
#define SPEAK_ERR_RECEICER       2
9
#define SPEAK_ERR_RECEICER       2
10
#define SPEAK_ERR_DATABUS        3
10
#define SPEAK_ERR_DATABUS        3
11
#define SPEAK_ERR_NAVI           4
11
#define SPEAK_ERR_NAVI           4
12
#define SPEAK_ERROR                      5
12
#define SPEAK_ERROR                      5
13
#define SPEAK_ERR_COMPASS        6
13
#define SPEAK_ERR_COMPASS        6
14
#define SPEAK_ERR_SENSOR         7
14
#define SPEAK_ERR_SENSOR         7
15
#define SPEAK_ERR_GPS            8
15
#define SPEAK_ERR_GPS            8
16
#define SPEAK_ERR_MOTOR          9
16
#define SPEAK_ERR_MOTOR          9
17
#define SPEAK_MAX_TEMPERAT  10
17
#define SPEAK_MAX_TEMPERAT  10
18
#define SPEAK_ALTI_REACHED  11
18
#define SPEAK_ALTI_REACHED  11
19
#define SPEAK_WP_REACHED    12
19
#define SPEAK_WP_REACHED    12
20
#define SPEAK_NEXT_WP       13
20
#define SPEAK_NEXT_WP       13
21
#define SPEAK_LANDING       14
21
#define SPEAK_LANDING       14
22
#define SPEAK_GPS_FIX       15
22
#define SPEAK_GPS_FIX       15
23
#define SPEAK_UNDERVOLTAGE  16
23
#define SPEAK_UNDERVOLTAGE  16
24
#define SPEAK_GPS_HOLD      17
24
#define SPEAK_GPS_HOLD      17
25
#define SPEAK_GPS_HOME      18
25
#define SPEAK_GPS_HOME      18
26
#define SPEAK_GPS_OFF       19
26
#define SPEAK_GPS_OFF       19
27
#define SPEAK_BEEP          20
27
#define SPEAK_BEEP          20
28
#define SPEAK_MIKROKOPTER   21
28
#define SPEAK_MIKROKOPTER   21
29
#define SPEAK_CAPACITY      22
29
#define SPEAK_CAPACITY      22
30
#define SPEAK_CF_OFF        23
30
#define SPEAK_CF_OFF        23
31
#define SPEAK_CALIBRATE     24
31
#define SPEAK_CALIBRATE     24
32
#define SPEAK_MAX_RANGE     25
32
#define SPEAK_MAX_RANGE     25
33
#define SPEAK_MAX_ALTITUD   26
33
#define SPEAK_MAX_ALTITUD   26
34
 
34
 
35
#define SPEAK_20M                       37   // ?
35
#define SPEAK_20M                       37   // ?
36
#define SPEAK_MK_OFF            38
36
#define SPEAK_MK_OFF            38
37
#define SPEAK_ALTITUDE_ON       39
37
#define SPEAK_ALTITUDE_ON       39
38
#define SPEAK_ALTITUDE_OFF      40
38
#define SPEAK_ALTITUDE_OFF      40
39
#define SPEAK_100M                      41   // ?
39
#define SPEAK_100M                      41   // ?
40
#define SPEAK_CONNECTED         42
40
#define SPEAK_CONNECTED         42
41
#define SPEAK_CF_ON             46
41
#define SPEAK_CF_ON             46
42
#define SPEAK_SINKING           47   // ?
42
#define SPEAK_SINKING           47   // ?
43
#define SPEAK_RISING            48
43
#define SPEAK_RISING            48
44
#define SPEAK_HOLDING           49   // ?
44
#define SPEAK_HOLDING           49   // ?
45
#define SPEAK_GPS_ON            50       // ?
45
#define SPEAK_GPS_ON            50       // ?
46
#define SPEAK_FOLLWING          51   // ?
46
#define SPEAK_FOLLWING          51   // ?
47
#define SPEAK_STARTING      52
47
#define SPEAK_STARTING      52
48
 
48
 
49
 
49
 
50
#define SS_PIN GPIO_ReadBit(GPIO2, GPIO_Pin_7)
50
#define SS_PIN GPIO_ReadBit(GPIO2, GPIO_Pin_7)
51
 
51
 
52
#define SPI_FCCMD_USER                  10
52
#define SPI_FCCMD_USER                  10
53
#define SPI_FCCMD_STICK                 11
53
#define SPI_FCCMD_STICK                 11
54
#define SPI_FCCMD_MISC                  12
54
#define SPI_FCCMD_MISC                  12
55
#define SPI_FCCMD_PARAMETER1    13
55
#define SPI_FCCMD_PARAMETER1    13
56
#define SPI_FCCMD_VERSION               14
56
#define SPI_FCCMD_VERSION               14
57
#define SPI_FCCMD_SLOW3                 15
57
#define SPI_FCCMD_SLOW3                 15
58
#define SPI_FCCMD_BL_ACCU               16
58
#define SPI_FCCMD_BL_ACCU               16
59
#define SPI_FCCMD_PARAMETER2    17
59
#define SPI_FCCMD_PARAMETER2    17
60
#define SPI_FCCMD_NEUTRAL               18
60
#define SPI_FCCMD_NEUTRAL               18
61
#define SPI_FCCMD_SLOW                  19 //  kommt nicht vor
61
#define SPI_FCCMD_SLOW                  19 //  kommt nicht vor
62
#define SPI_FCCMD_SLOW2                 20
62
#define SPI_FCCMD_SLOW2                 20
-
 
63
#define SPI_FCCMD_STICK2                21
63
 
64
 
64
#define CHK_POTI(b,a) { if(a < 248) b = a; else b = FC.Poti[255 - a]; }
65
#define CHK_POTI(b,a) { if(a < 248) b = a; else b = FC.Poti[255 - a]; }
65
#define CHK_POTI_MM(b,a,min,max) {CHK_POTI(b,a); LIMIT_MIN_MAX(b, min, max); }
66
#define CHK_POTI_MM(b,a,min,max) {CHK_POTI(b,a); LIMIT_MIN_MAX(b, min, max); }
66
 
67
 
67
// devides only the Poti-value
68
// devides only the Poti-value
68
#define CHK_POTI_DIV(b,a,div) { if(a < 248) b = a; else b = FC.Poti[255 - a] / div; }
69
#define CHK_POTI_DIV(b,a,div) { if(a < 248) b = a; else b = FC.Poti[255 - a] / div; }
69
#define CHK_POTI_MM_DIV(b,a,min,max,div) {CHK_POTI_DIV(b,a,div); LIMIT_MIN_MAX(b, min, max); }
70
#define CHK_POTI_MM_DIV(b,a,min,max,div) {CHK_POTI_DIV(b,a,div); LIMIT_MIN_MAX(b, min, max); }
70
 
71
 
71
extern s32 Kalman_K;
72
extern s32 Kalman_K;
72
extern s32 Kalman_Kompass ;
73
extern s32 Kalman_Kompass ;
73
extern s32 Kalman_MaxDrift;
74
extern s32 Kalman_MaxDrift;
74
extern s32 Kalman_MaxFusion;
75
extern s32 Kalman_MaxFusion;
75
extern s32 ToFcGpsZ;
76
extern s32 ToFcGpsZ;
76
extern s32 ToFC_Rotate_C, ToFC_Rotate_S;
77
extern s32 ToFC_Rotate_C, ToFC_Rotate_S;
77
extern s32 HeadFreeStartAngle,CompassDirectionAtMotorStart;
78
extern s32 HeadFreeStartAngle,CompassDirectionAtMotorStart;
78
extern s16 FC_WP_EventChannel,LogFC_WP_EventChannel,FC_WP_EventChannel_Processed;
79
extern s16 FC_WP_EventChannel,LogFC_WP_EventChannel,FC_WP_EventChannel_Processed;
79
extern u32 ToFC_AltitudeRate;
80
extern u32 ToFC_AltitudeRate;
80
extern s32 ToFC_AltitudeSetpoint;
81
extern s32 ToFC_AltitudeSetpoint;
81
extern u8 NC_GPS_ModeCharacter;
82
extern u8 NC_GPS_ModeCharacter;
82
extern u8 FC_is_Calibrated;
83
extern u8 FC_is_Calibrated;
83
extern u8 FCCalibActive;
84
extern u8 FCCalibActive;
84
extern u8 SpeakHoTT;
85
extern u8 SpeakHoTT;
85
extern u8 NC_Wait_for_LED;
86
extern u8 NC_Wait_for_LED;
86
extern s16 GyroCompassCorrected;
87
extern s16 GyroCompassCorrected;
87
extern s16 CompassSetpointCorrected; // The compass setpoint that the FC tries to keep - corrected with the magnetic declination
88
extern s16 CompassSetpointCorrected; // The compass setpoint that the FC tries to keep - corrected with the magnetic declination
88
extern s16 CompassSetpoint;
89
extern s16 CompassSetpoint;
89
extern u8 AmountOfMotors;
90
extern u8 AmountOfMotors;
90
extern s16 SimulatedDirection;    // simulated compass direction
91
extern s16 SimulatedDirection;    // simulated compass direction
-
 
92
 
-
 
93
#define MAX_RC_IN  16+12+3+4 // 16ch + 12ser + 3stages + 4 reserved
-
 
94
extern s8 PPM_In[MAX_RC_IN];
91
           
95
           
92
extern u8 BL_MinOfMaxPWM;  // indication if all BL-controllers run on full power
96
extern u8 BL_MinOfMaxPWM;  // indication if all BL-controllers run on full power
93
extern u8 Logging_BL_MinOfMaxPWM;
97
extern u8 Logging_BL_MinOfMaxPWM;
94
extern u8 ErrorCheck_BL_MinOfMaxPWM;
98
extern u8 ErrorCheck_BL_MinOfMaxPWM;
95
extern u32 FC_I2C_ErrorConter;
99
extern u32 FC_I2C_ErrorConter;
96
extern u8 FromFC_VarioCharacter;
100
extern u8 FromFC_VarioCharacter;
97
extern u8 Logging_FCStatusFlags1,Logging_FCStatusFlags2;
101
extern u8 Logging_FCStatusFlags1,Logging_FCStatusFlags2;
98
extern s16 POI_KameraNick;
102
extern s16 POI_KameraNick;
99
extern u8 NC_To_FC_Flags, NC_To_FC_Autostart;
103
extern u8 NC_To_FC_Flags, NC_To_FC_Autostart;
100
extern u16 FlugMinutenGesamt;
104
extern u16 FlugMinutenGesamt;
101
extern u32 LoggingGasFilter, LoggingGasCnt;
105
extern u32 LoggingGasFilter, LoggingGasCnt;
102
extern u8 HoverGas;
106
extern u8 HoverGas;
-
 
107
extern s16 FromFlightCtrl_AccNick,FromFlightCtrl_AccRoll,FromFlightCtrl_GyroNick,FromFlightCtrl_GyroRoll;
103
 
108
 
104
typedef struct
109
typedef struct
105
{
110
{
106
        u8   Command;
111
        u8   Command;
107
        s16  AngleNick;  // NickAngle in 0.1 deg
112
        s16  AngleNick;  // NickAngle in 0.1 deg
108
        s16  AngleRoll;  // RollAngle in 0.1 deg
113
        s16  AngleRoll;  // RollAngle in 0.1 deg
109
        s16  AccNick;
-
 
110
        s16  AccRoll;
-
 
111
        s16  GyroHeading; // Heading in 0.1 deg
114
        s16  GyroHeading; // Heading in 0.1 deg
112
        s16  GyroNick;
-
 
113
        s16  GyroRoll;
-
 
114
        s16  GyroYaw;
115
        s16  GyroYaw;
115
        u16  FCStatus;
116
        u16  FCStatus;
116
        union
117
        union
117
        {
118
        {
118
                u8    Byte[12];
119
                u8    Byte[20];
119
                s8        sByte[12];
120
                s8        sByte[20];
120
                u16   Int[6];
121
                u16   Int[10];
121
                s16   sInt[6];
122
                s16   sInt[10];
122
                u32   Long[3];
123
                u32   Long[5];
123
                s32   sLong[3];
124
                s32   sLong[5];
124
                float Float[3];
125
                float Float[5];
125
        } Param;
126
        } __attribute__((packed)) Param;
126
        u8 Chksum;
127
        u8 Chksum;
127
 } __attribute__((packed)) FromFlightCtrl_t;
128
 } __attribute__((packed)) FromFlightCtrl_t;
128
 
129
 
129
#define SPI_NCCMD_OSD_DATA              100
130
#define SPI_NCCMD_OSD_DATA              100
130
#define SPI_NCCMD_GPS_POS               101
131
#define SPI_NCCMD_GPS_POS               101
131
#define SPI_NCCMD_GPS_TARGET    102
132
#define SPI_NCCMD_GPS_TARGET    102
132
#define SPI_NCCMD_KALMAN                103
133
#define SPI_NCCMD_KALMAN                103
133
#define SPI_NCCMD_VERSION               104
134
#define SPI_NCCMD_VERSION               104
134
#define SPI_NCCMD_GPSINFO               105
135
#define SPI_NCCMD_GPSINFO               105
135
#define SPI_NCCMD_HOTT_INFO             106
136
#define SPI_NCCMD_HOTT_INFO             106
136
#define SPI_MISC                                107
137
#define SPI_MISC                                107
-
 
138
#define SPI_SERIAL_CH                   108
137
 
139
 
138
#define HOTT_VARIO_PACKET_ID            0x89
140
#define HOTT_VARIO_PACKET_ID            0x89
139
#define HOTT_GPS_PACKET_ID                      0x8A
141
#define HOTT_GPS_PACKET_ID                      0x8A
140
#define HOTT_ELECTRIC_AIR_PACKET_ID     0x8E
142
#define HOTT_ELECTRIC_AIR_PACKET_ID     0x8E
141
#define HOTT_GENERAL_PACKET_ID          0x8D
143
#define HOTT_GENERAL_PACKET_ID          0x8D
142
#define JETI_GPS_PACKET_ID1                     0x01
144
#define JETI_GPS_PACKET_ID1                     0x01
143
#define JETI_GPS_PACKET_ID2                     0x02
145
#define JETI_GPS_PACKET_ID2                     0x02
144
#define HOTT_WPL_NAME                           0x03
146
#define HOTT_WPL_NAME                           0x03
145
 
147
 
146
typedef struct
148
typedef struct
147
{
149
{
148
        u8 Command;
150
        u8 Command;
149
        GPS_Stick_t GPSStick;
151
        GPS_Stick_t GPSStick;
150
        s16 MagVecX;
-
 
151
        s16 CompassHeading;
152
        s16 CompassHeading;
152
        s16 AccErrorN;
153
        s16 AccErrorN;
153
        s16 AccErrorR;
154
        s16 AccErrorR;
154
        s16 MagVecY;
-
 
155
        s16 MagVecZ;
-
 
156
        u16 BeepTime;
-
 
157
        union
155
        union
158
        {
156
        {
159
                u8    Byte[12];
157
                u8    Byte[20];
160
                s8    sByte[12];
158
                s8    sByte[20];
161
                u16       Int[6];
159
                u16       Int[10];
162
                s16   sInt[6];
160
                s16   sInt[10];
163
                u32   Long[3];
161
                u32   Long[5];
164
                s32   sLong[3];
162
                s32   sLong[5];
165
                float Float[3];
163
                float Float[5];
166
        }Param;
164
        } __attribute__((packed)) Param;
167
        u8 Chksum;
165
        u8 Chksum;
168
 } __attribute__((packed)) ToFlightCtrl_t;
166
 } __attribute__((packed)) ToFlightCtrl_t;
-
 
167
 
-
 
168
typedef struct
-
 
169
{
-
 
170
        unsigned char Sync1,Sync2;
-
 
171
        unsigned char WhoAmI;
-
 
172
        unsigned char Data[240];
-
 
173
        unsigned char Chksum;
-
 
174
}__attribute__((packed)) str_HugeBlockFromFC;
-
 
175
extern str_HugeBlockFromFC HugeBlockFromFC;
-
 
176
 
-
 
177
typedef struct
-
 
178
{
-
 
179
        unsigned char Sync1,Sync2;
-
 
180
        unsigned char WhoAmI;
-
 
181
        unsigned char Data[240];
-
 
182
        unsigned char Chksum;
-
 
183
}__attribute__((packed)) str_HugeBlockToFC;
-
 
184
extern str_HugeBlockToFC HugeBlockToFC;
169
 
185
 
170
typedef struct
186
typedef struct
171
{
187
{
172
 u8 Current;
188
 u8 Current;
173
 u8 Temperature;
189
 u8 Temperature;
174
 u8 MaxPWM;
190
 u8 MaxPWM;
175
 u8 State;
191
 u8 State;
176
 u8 NotReadyCnt;
192
 u8 NotReadyCnt;
177
} __attribute__((packed)) Motor_t;
193
} __attribute__((packed)) Motor_t;
178
 
194
 
179
extern Motor_t Motor[MAX_MOTORS];
195
extern Motor_t Motor[MAX_MOTORS];
180
 
196
 
181
#define MOTOR_STATE_NEW_PROTOCOL_MASK   0x01
197
#define MOTOR_STATE_NEW_PROTOCOL_MASK   0x01
182
#define MOTOR_STATE_FAST_MODE           0x02
198
#define MOTOR_STATE_FAST_MODE           0x02
183
#define MOTOR_STATE_BL30                0x04   // extended Current measurement -> 200 = 20A    201 = 21A    255 = 75A (20+55)
199
#define MOTOR_STATE_BL30                0x04   // extended Current measurement -> 200 = 20A    201 = 21A    255 = 75A (20+55)
184
extern u8 Motor_Version[MAX_MOTORS]; // das kann nicht in die struct, weil der PC die Struktur bekommt
200
extern u8 Motor_Version[MAX_MOTORS]; // das kann nicht in die struct, weil der PC die Struktur bekommt
185
 
201
 
186
 
202
 
187
typedef struct
203
typedef struct
188
{
204
{
189
   u8 Major;
205
   u8 Major;
190
   u8 Minor;
206
   u8 Minor;
191
   u8 Patch;
207
   u8 Patch;
192
   u8 Compatible;
208
   u8 Compatible;
193
   u8 Hardware;
209
   u8 Hardware;
194
} __attribute__((packed)) SPI_Version_t;
210
} __attribute__((packed)) SPI_Version_t;
195
 
211
 
196
extern FromFlightCtrl_t   FromFlightCtrl;
212
extern FromFlightCtrl_t   FromFlightCtrl;
197
extern ToFlightCtrl_t     ToFlightCtrl;
213
extern ToFlightCtrl_t     ToFlightCtrl;
198
extern volatile u32 SPI0_Timeout;
214
extern volatile u32 SPI0_Timeout;
199
extern SPI_Version_t FC_Version;
215
extern SPI_Version_t FC_Version;
200
extern s16 GPS_Aid_StickMultiplikator;
216
extern s16 GPS_Aid_StickMultiplikator;
201
extern u8 CompassCalState;
217
extern u8 CompassCalState;
202
extern u8 Out1TriggerUpdateNewData;
218
extern u8 Out1TriggerUpdateNewData;
203
extern u8 LowVoltageLandingActive;
219
extern u8 LowVoltageLandingActive;
204
 
220
 
205
void SPI0_Init(void);
221
void SPI0_Init(void);
206
void SPI0_GetFlightCtrlVersion(void);
222
void SPI0_GetFlightCtrlVersion(void);
207
void SPI0_UpdateBuffer(void);
223
void SPI0_UpdateBuffer(void);
208
u16 BL3_Current(u8 who); // in 0.1A
224
u16 BL3_Current(u8 who); // in 0.1A
209
 
225
 
210
#endif //_SPI_SLAVE_H
226
#endif //_SPI_SLAVE_H
211
 
227