Subversion Repositories NaviCtrl

Rev

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

Rev 487 Rev 489
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_ERR_CALIBARTION  1
7
#define SPEAK_ERR_CALIBARTION  1
8
#define SPEAK_ERR_RECEICER       2
8
#define SPEAK_ERR_RECEICER       2
9
#define SPEAK_ERR_DATABUS        3
9
#define SPEAK_ERR_DATABUS        3
10
#define SPEAK_ERR_NAVI           4
10
#define SPEAK_ERR_NAVI           4
11
#define SPEAK_ERROR                      5
11
#define SPEAK_ERROR                      5
12
#define SPEAK_ERR_COMPASS        6
12
#define SPEAK_ERR_COMPASS        6
13
#define SPEAK_ERR_SENSOR         7
13
#define SPEAK_ERR_SENSOR         7
14
#define SPEAK_ERR_GPS            8
14
#define SPEAK_ERR_GPS            8
15
#define SPEAK_ERR_MOTOR          9
15
#define SPEAK_ERR_MOTOR          9
16
#define SPEAK_MAX_TEMPERAT  10
16
#define SPEAK_MAX_TEMPERAT  10
17
#define SPEAK_ALTI_REACHED  11
17
#define SPEAK_ALTI_REACHED  11
18
#define SPEAK_WP_REACHED    12
18
#define SPEAK_WP_REACHED    12
19
#define SPEAK_NEXT_WP       13
19
#define SPEAK_NEXT_WP       13
20
#define SPEAK_LANDING       14
20
#define SPEAK_LANDING       14
21
#define SPEAK_GPS_FIX       15
21
#define SPEAK_GPS_FIX       15
22
#define SPEAK_UNDERVOLTAGE  16
22
#define SPEAK_UNDERVOLTAGE  16
23
#define SPEAK_GPS_HOLD      17
23
#define SPEAK_GPS_HOLD      17
24
#define SPEAK_GPS_HOME      18
24
#define SPEAK_GPS_HOME      18
25
#define SPEAK_GPS_OFF       19
25
#define SPEAK_GPS_OFF       19
26
#define SPEAK_BEEP          20
26
#define SPEAK_BEEP          20
27
#define SPEAK_MIKROKOPTER   21
27
#define SPEAK_MIKROKOPTER   21
28
#define SPEAK_CAPACITY      22
28
#define SPEAK_CAPACITY      22
29
#define SPEAK_CF_OFF        23
29
#define SPEAK_CF_OFF        23
30
#define SPEAK_CALIBRATE     24
30
#define SPEAK_CALIBRATE     24
31
#define SPEAK_MAX_RANGE     25
31
#define SPEAK_MAX_RANGE     25
32
#define SPEAK_MAX_ALTITUD   26
32
#define SPEAK_MAX_ALTITUD   26
33
 
33
 
34
#define SPEAK_MK_OFF            38
34
#define SPEAK_MK_OFF            38
35
#define SPEAK_ALTITUDE_ON       39
35
#define SPEAK_ALTITUDE_ON       39
36
#define SPEAK_ALTITUDE_OFF      40
36
#define SPEAK_ALTITUDE_OFF      40
37
#define SPEAK_CF_ON             46
37
#define SPEAK_CF_ON             46
38
#define SPEAK_SINKING           47
38
#define SPEAK_SINKING           47
39
#define SPEAK_RISING            48
39
#define SPEAK_RISING            48
40
#define SPEAK_HOLDING           49
40
#define SPEAK_HOLDING           49
41
#define SPEAK_GPS_ON            50
41
#define SPEAK_GPS_ON            50
42
#define SPEAK_FOLLWING          51
42
#define SPEAK_FOLLWING          51
43
#define SPEAK_STARTING      52
43
#define SPEAK_STARTING      52
44
 
44
 
45
 
45
 
46
#define SS_PIN GPIO_ReadBit(GPIO2, GPIO_Pin_7)
46
#define SS_PIN GPIO_ReadBit(GPIO2, GPIO_Pin_7)
47
 
47
 
48
#define SPI_FCCMD_USER                  10
48
#define SPI_FCCMD_USER                  10
49
#define SPI_FCCMD_STICK                 11
49
#define SPI_FCCMD_STICK                 11
50
#define SPI_FCCMD_MISC                  12
50
#define SPI_FCCMD_MISC                  12
51
#define SPI_FCCMD_PARAMETER1    13
51
#define SPI_FCCMD_PARAMETER1    13
52
#define SPI_FCCMD_VERSION               14
52
#define SPI_FCCMD_VERSION               14
53
#define SPI_FCCMD_SERVOS                15
53
#define SPI_FCCMD_SERVOS                15
54
#define SPI_FCCMD_BL_ACCU               16
54
#define SPI_FCCMD_BL_ACCU               16
55
#define SPI_FCCMD_PARAMETER2    17
55
#define SPI_FCCMD_PARAMETER2    17
56
 
56
 
57
#define CHK_POTI(b,a) { if(a < 248) b = a; else b = FC.Poti[255 - a]; }
57
#define CHK_POTI(b,a) { if(a < 248) b = a; else b = FC.Poti[255 - a]; }
58
#define CHK_POTI_MM(b,a,min,max) {CHK_POTI(b,a); LIMIT_MIN_MAX(b, min, max); }
58
#define CHK_POTI_MM(b,a,min,max) {CHK_POTI(b,a); LIMIT_MIN_MAX(b, min, max); }
59
 
59
 
60
extern s32 Kalman_K;
60
extern s32 Kalman_K;
61
extern s32 Kalman_Kompass ;
61
extern s32 Kalman_Kompass ;
62
extern s32 Kalman_MaxDrift;
62
extern s32 Kalman_MaxDrift;
63
extern s32 Kalman_MaxFusion;
63
extern s32 Kalman_MaxFusion;
64
extern s32 ToFcGpsZ;
64
extern s32 ToFcGpsZ;
65
extern s32 ToFC_Rotate_C, ToFC_Rotate_S;
65
extern s32 ToFC_Rotate_C, ToFC_Rotate_S;
66
extern s32 HeadFreeStartAngle;
66
extern s32 HeadFreeStartAngle;
67
extern s16 FC_WP_EventChannel,LogFC_WP_EventChannel;
67
extern s16 FC_WP_EventChannel,LogFC_WP_EventChannel;
68
extern u32 ToFC_AltitudeRate;
68
extern u32 ToFC_AltitudeRate;
69
extern s32 ToFC_AltitudeSetpoint;
69
extern s32 ToFC_AltitudeSetpoint;
70
extern u8 NC_GPS_ModeCharacter;
70
extern u8 NC_GPS_ModeCharacter;
71
extern u8 FC_is_Calibrated;
71
extern u8 FC_is_Calibrated;
72
extern u8 FCCalibActive;
72
extern u8 FCCalibActive;
73
extern u8 SpeakHoTT;
73
extern u8 SpeakHoTT;
74
extern u8 NC_Wait_for_LED;
74
extern u8 NC_Wait_for_LED;
75
extern s16 GyroCompassCorrected;
75
extern s16 GyroCompassCorrected;
76
 
-
 
77
/*extern u8 MotorCurrent[12];
-
 
78
extern u8 MotorTemperature[12];
-
 
79
extern u8 MotorState[12];
-
 
80
extern u8 MotorMaxPwm[12];
76
 
81
*/
77
 
82
extern u8 BL_MinOfMaxPWM;  // indication if all BL-controllers run on full power
78
extern u8 BL_MinOfMaxPWM;  // indication if all BL-controllers run on full power
83
extern u32 FC_I2C_ErrorConter;
79
extern u32 FC_I2C_ErrorConter;
84
extern u8 FromFC_VarioCharacter;
80
extern u8 FromFC_VarioCharacter;
85
extern u8 Logging_FCStatusFlags1,Logging_FCStatusFlags2;
81
extern u8 Logging_FCStatusFlags1,Logging_FCStatusFlags2;
86
extern s16 POI_KameraNick;
82
extern s16 POI_KameraNick;
87
extern u8 NC_To_FC_Flags, NC_To_FC_Autostart;
83
extern u8 NC_To_FC_Flags, NC_To_FC_Autostart;
88
typedef struct
84
typedef struct
89
{
85
{
90
        u8   Command;
86
        u8   Command;
91
        s16  AngleNick;  // NickAngle in 0.1 deg
87
        s16  AngleNick;  // NickAngle in 0.1 deg
92
        s16  AngleRoll;  // RollAngle in 0.1 deg
88
        s16  AngleRoll;  // RollAngle in 0.1 deg
93
        s16  AccNick;
89
        s16  AccNick;
94
        s16  AccRoll;
90
        s16  AccRoll;
95
        s16  GyroHeading; // Heading in 0.1 deg
91
        s16  GyroHeading; // Heading in 0.1 deg
96
        s16  GyroNick;
92
        s16  GyroNick;
97
        s16  GyroRoll;
93
        s16  GyroRoll;
98
        s16  GyroYaw;
94
        s16  GyroYaw;
99
        u16  FCStatus;
95
        u16  FCStatus;
100
        union
96
        union
101
        {
97
        {
102
                u8    Byte[12];
98
                u8    Byte[12];
103
                s8        sByte[12];
99
                s8        sByte[12];
104
                u16   Int[6];
100
                u16   Int[6];
105
                s16   sInt[6];
101
                s16   sInt[6];
106
                u32   Long[3];
102
                u32   Long[3];
107
                s32   sLong[3];
103
                s32   sLong[3];
108
                float Float[3];
104
                float Float[3];
109
        } Param;
105
        } Param;
110
        u8 Chksum;
106
        u8 Chksum;
111
 } __attribute__((packed)) FromFlightCtrl_t;
107
 } __attribute__((packed)) FromFlightCtrl_t;
112
 
108
 
113
//NC_To_FC_Flags
109
//NC_To_FC_Flags
114
#define NC_TO_FC_FLYING_RANGE           0x01
110
#define NC_TO_FC_FLYING_RANGE           0x01
115
#define NC_TO_FC_EMERGENCY_LANDING      0x02
111
#define NC_TO_FC_EMERGENCY_LANDING      0x02
116
#define NC_TO_FC_AUTOSTART                      0x04
112
#define NC_TO_FC_AUTOSTART                      0x04
117
#define NC_TO_FC_AUTOLANDING            0x08 // not used 
113
#define NC_TO_FC_AUTOLANDING            0x08 // not used
118
 
114
 
119
#define SPI_NCCMD_OSD_DATA              100
115
#define SPI_NCCMD_OSD_DATA              100
120
#define SPI_NCCMD_GPS_POS               101
116
#define SPI_NCCMD_GPS_POS               101
121
#define SPI_NCCMD_GPS_TARGET    102
117
#define SPI_NCCMD_GPS_TARGET    102
122
#define SPI_NCCMD_KALMAN                103
118
#define SPI_NCCMD_KALMAN                103
123
#define SPI_NCCMD_VERSION               104
119
#define SPI_NCCMD_VERSION               104
124
#define SPI_NCCMD_GPSINFO               105
120
#define SPI_NCCMD_GPSINFO               105
125
#define SPI_NCCMD_HOTT_INFO             106
121
#define SPI_NCCMD_HOTT_INFO             106
126
#define SPI_MISC                                107
122
#define SPI_MISC                                107
127
 
123
 
128
#define HOTT_VARIO_PACKET_ID            0x89
124
#define HOTT_VARIO_PACKET_ID            0x89
129
#define HOTT_GPS_PACKET_ID                      0x8A
125
#define HOTT_GPS_PACKET_ID                      0x8A
130
#define HOTT_ELECTRIC_AIR_PACKET_ID     0x8E
126
#define HOTT_ELECTRIC_AIR_PACKET_ID     0x8E
131
#define HOTT_GENERAL_PACKET_ID          0x8D
127
#define HOTT_GENERAL_PACKET_ID          0x8D
132
#define JETI_GPS_PACKET_ID1                     0x01
128
#define JETI_GPS_PACKET_ID1                     0x01
133
#define JETI_GPS_PACKET_ID2                     0x02
129
#define JETI_GPS_PACKET_ID2                     0x02
134
 
130
 
135
typedef struct
131
typedef struct
136
{
132
{
137
        u8 Command;
133
        u8 Command;
138
        GPS_Stick_t GPSStick;
134
        GPS_Stick_t GPSStick;
139
        s16 MagVecX;
135
        s16 MagVecX;
140
        s16 CompassHeading;
136
        s16 CompassHeading;
141
        s16 AccErrorN;
137
        s16 AccErrorN;
142
        s16 AccErrorR;
138
        s16 AccErrorR;
143
        s16 MagVecY;
139
        s16 MagVecY;
144
        s16 MagVecZ;  
140
        s16 MagVecZ;
145
        u16 BeepTime;
141
        u16 BeepTime;
146
        union
142
        union
147
        {
143
        {
148
                u8    Byte[12];
144
                u8    Byte[12];
149
                s8    sByte[12];
145
                s8    sByte[12];
150
                u16       Int[6];
146
                u16       Int[6];
151
                s16   sInt[6];
147
                s16   sInt[6];
152
                u32   Long[3];
148
                u32   Long[3];
153
                s32   sLong[3];
149
                s32   sLong[3];
154
                float Float[3];
150
                float Float[3];
155
        }Param;
151
        }Param;
156
        u8 Chksum;
152
        u8 Chksum;
157
 } __attribute__((packed)) ToFlightCtrl_t;
153
 } __attribute__((packed)) ToFlightCtrl_t;
158
 
154
 
159
typedef struct
155
typedef struct
160
{
156
{
161
 u8 Current;
157
 u8 Current;
162
 u8 Temperature;
158
 u8 Temperature;
163
 u8 MaxPWM;
159
 u8 MaxPWM;
164
 u8 State;
160
 u8 State;
165
} __attribute__((packed)) Motor_t;
161
} __attribute__((packed)) Motor_t;
166
 
162
 
167
extern Motor_t Motor[12];
163
extern Motor_t Motor[12];
168
 
-
 
169
 
-
 
170
//Motor_Version[12]
164
 
171
#define MOTOR_STATE_NEW_PROTOCOL_MASK   0x01
165
#define MOTOR_STATE_NEW_PROTOCOL_MASK   0x01
172
#define MOTOR_STATE_FAST_MODE           0x02
166
#define MOTOR_STATE_FAST_MODE           0x02
173
#define MOTOR_STATE_BL30                0x04   // extended Current measurement -> 200 = 20A    201 = 21A    255 = 75A (20+55)
167
#define MOTOR_STATE_BL30                0x04   // extended Current measurement -> 200 = 20A    201 = 21A    255 = 75A (20+55)
174
extern unsigned char Motor_Version[12]; // das kann nicht in die struct, weil der PC die Struktur bekommt
168
extern u8 Motor_Version[12]; // das kann nicht in die struct, weil der PC die Struktur bekommt
-
 
169
 
175
 
170
 
176
 
171
 
177
typedef struct
172
typedef struct
178
{
173
{
179
   u8 Major;
174
   u8 Major;
180
   u8 Minor;
175
   u8 Minor;
181
   u8 Patch;
176
   u8 Patch;
182
   u8 Compatible;
177
   u8 Compatible;
183
   u8 Hardware;
178
   u8 Hardware;
184
} __attribute__((packed)) SPI_Version_t;
179
} __attribute__((packed)) SPI_Version_t;
185
 
180
 
186
extern FromFlightCtrl_t   FromFlightCtrl;
181
extern FromFlightCtrl_t   FromFlightCtrl;
187
extern ToFlightCtrl_t     ToFlightCtrl;
182
extern ToFlightCtrl_t     ToFlightCtrl;
188
extern volatile u32 SPI0_Timeout;
183
extern volatile u32 SPI0_Timeout;
189
extern SPI_Version_t FC_Version;
184
extern SPI_Version_t FC_Version;
190
extern u8 GPS_Aid_StickMultiplikator;
185
extern u8 GPS_Aid_StickMultiplikator;
191
extern u8 CompassCalState;
186
extern u8 CompassCalState;
192
extern u8 FromFC_LowVoltageHomeActive;
-
 
193
 
187
 
194
void SPI0_Init(void);
188
void SPI0_Init(void);
195
void SPI0_GetFlightCtrlVersion(void);
189
void SPI0_GetFlightCtrlVersion(void);
196
void SPI0_UpdateBuffer(void);
190
void SPI0_UpdateBuffer(void);
-
 
191
u16 BL3_Current(u8 who); // in 0.1A
197
 
192
 
198
#endif //_SPI_SLAVE_H
193
#endif //_SPI_SLAVE_H
199
 
194