Rev 559 | Rev 577 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 559 | Rev 573 | ||
---|---|---|---|
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 | #define SPI_FCCMD_NEUTRAL 18 |
|
- | 57 | #define SPI_FCCMD_SLOW 19 // kommt nicht vor |
|
56 | 58 | ||
57 | #define CHK_POTI(b,a) { if(a < 248) b = a; else b = FC.Poti[255 - a]; } |
59 | #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); } |
60 | #define CHK_POTI_MM(b,a,min,max) {CHK_POTI(b,a); LIMIT_MIN_MAX(b, min, max); } |
59 | 61 | ||
60 | // devides only the Poti-value |
62 | // devides only the Poti-value |
61 | #define CHK_POTI_DIV(b,a,div) { if(a < 248) b = a; else b = FC.Poti[255 - a] / div; } |
63 | #define CHK_POTI_DIV(b,a,div) { if(a < 248) b = a; else b = FC.Poti[255 - a] / div; } |
62 | #define CHK_POTI_MM_DIV(b,a,min,max,div) {CHK_POTI_DIV(b,a,div); LIMIT_MIN_MAX(b, min, max); } |
64 | #define CHK_POTI_MM_DIV(b,a,min,max,div) {CHK_POTI_DIV(b,a,div); LIMIT_MIN_MAX(b, min, max); } |
63 | 65 | ||
64 | extern s32 Kalman_K; |
66 | extern s32 Kalman_K; |
65 | extern s32 Kalman_Kompass ; |
67 | extern s32 Kalman_Kompass ; |
66 | extern s32 Kalman_MaxDrift; |
68 | extern s32 Kalman_MaxDrift; |
67 | extern s32 Kalman_MaxFusion; |
69 | extern s32 Kalman_MaxFusion; |
68 | extern s32 ToFcGpsZ; |
70 | extern s32 ToFcGpsZ; |
69 | extern s32 ToFC_Rotate_C, ToFC_Rotate_S; |
71 | extern s32 ToFC_Rotate_C, ToFC_Rotate_S; |
70 | extern s32 HeadFreeStartAngle; |
72 | extern s32 HeadFreeStartAngle; |
71 | extern s16 FC_WP_EventChannel,LogFC_WP_EventChannel; |
73 | extern s16 FC_WP_EventChannel,LogFC_WP_EventChannel; |
72 | extern u32 ToFC_AltitudeRate; |
74 | extern u32 ToFC_AltitudeRate; |
73 | extern s32 ToFC_AltitudeSetpoint; |
75 | extern s32 ToFC_AltitudeSetpoint; |
74 | extern u8 NC_GPS_ModeCharacter; |
76 | extern u8 NC_GPS_ModeCharacter; |
75 | extern u8 FC_is_Calibrated; |
77 | extern u8 FC_is_Calibrated; |
76 | extern u8 FCCalibActive; |
78 | extern u8 FCCalibActive; |
77 | extern u8 SpeakHoTT; |
79 | extern u8 SpeakHoTT; |
78 | extern u8 NC_Wait_for_LED; |
80 | extern u8 NC_Wait_for_LED; |
79 | extern s16 GyroCompassCorrected; |
81 | extern s16 GyroCompassCorrected; |
80 | extern s16 CompassSetpointCorrected; // The compass setpoint that the FC tries to keep - corrected with the magnetic declination |
82 | extern s16 CompassSetpointCorrected; // The compass setpoint that the FC tries to keep - corrected with the magnetic declination |
81 | extern s16 CompassSetpoint; |
83 | extern s16 CompassSetpoint; |
82 | extern u8 AmountOfMotors; |
84 | extern u8 AmountOfMotors; |
83 | extern s16 SimulatedDirection; // simulated compass direction |
85 | extern s16 SimulatedDirection; // simulated compass direction |
84 | 86 | ||
85 | extern u8 BL_MinOfMaxPWM; // indication if all BL-controllers run on full power |
87 | extern u8 BL_MinOfMaxPWM; // indication if all BL-controllers run on full power |
86 | extern u8 Logging_BL_MinOfMaxPWM; |
88 | extern u8 Logging_BL_MinOfMaxPWM; |
87 | extern u8 ErrorCheck_BL_MinOfMaxPWM; |
89 | extern u8 ErrorCheck_BL_MinOfMaxPWM; |
88 | extern u32 FC_I2C_ErrorConter; |
90 | extern u32 FC_I2C_ErrorConter; |
89 | extern u8 FromFC_VarioCharacter; |
91 | extern u8 FromFC_VarioCharacter; |
90 | extern u8 Logging_FCStatusFlags1,Logging_FCStatusFlags2; |
92 | extern u8 Logging_FCStatusFlags1,Logging_FCStatusFlags2; |
91 | extern s16 POI_KameraNick; |
93 | extern s16 POI_KameraNick; |
92 | extern u8 NC_To_FC_Flags, NC_To_FC_Autostart; |
94 | extern u8 NC_To_FC_Flags, NC_To_FC_Autostart; |
93 | extern u16 FlugMinutenGesamt; |
95 | extern u16 FlugMinutenGesamt; |
94 | 96 | ||
95 | typedef struct |
97 | typedef struct |
96 | { |
98 | { |
97 | u8 Command; |
99 | u8 Command; |
98 | s16 AngleNick; // NickAngle in 0.1 deg |
100 | s16 AngleNick; // NickAngle in 0.1 deg |
99 | s16 AngleRoll; // RollAngle in 0.1 deg |
101 | s16 AngleRoll; // RollAngle in 0.1 deg |
100 | s16 AccNick; |
102 | s16 AccNick; |
101 | s16 AccRoll; |
103 | s16 AccRoll; |
102 | s16 GyroHeading; // Heading in 0.1 deg |
104 | s16 GyroHeading; // Heading in 0.1 deg |
103 | s16 GyroNick; |
105 | s16 GyroNick; |
104 | s16 GyroRoll; |
106 | s16 GyroRoll; |
105 | s16 GyroYaw; |
107 | s16 GyroYaw; |
106 | u16 FCStatus; |
108 | u16 FCStatus; |
107 | union |
109 | union |
108 | { |
110 | { |
109 | u8 Byte[12]; |
111 | u8 Byte[12]; |
110 | s8 sByte[12]; |
112 | s8 sByte[12]; |
111 | u16 Int[6]; |
113 | u16 Int[6]; |
112 | s16 sInt[6]; |
114 | s16 sInt[6]; |
113 | u32 Long[3]; |
115 | u32 Long[3]; |
114 | s32 sLong[3]; |
116 | s32 sLong[3]; |
115 | float Float[3]; |
117 | float Float[3]; |
116 | } Param; |
118 | } Param; |
117 | u8 Chksum; |
119 | u8 Chksum; |
118 | } __attribute__((packed)) FromFlightCtrl_t; |
120 | } __attribute__((packed)) FromFlightCtrl_t; |
119 | 121 | ||
120 | //NC_To_FC_Flags |
122 | //NC_To_FC_Flags |
121 | #define NC_TO_FC_FLYING_RANGE 0x01 |
123 | #define NC_TO_FC_FLYING_RANGE 0x01 |
122 | #define NC_TO_FC_EMERGENCY_LANDING 0x02 |
124 | #define NC_TO_FC_EMERGENCY_LANDING 0x02 |
123 | #define NC_TO_FC_AUTOSTART 0x04 |
125 | #define NC_TO_FC_AUTOSTART 0x04 |
124 | #define NC_TO_FC_AUTOLANDING 0x08 // not used |
126 | #define NC_TO_FC_AUTOLANDING 0x08 // not used |
125 | #define NC_TO_FC_SIMULATION_ACTIVE 0x10 // don't start motors if simulation ist active |
127 | #define NC_TO_FC_SIMULATION_ACTIVE 0x10 // don't start motors if simulation ist active |
126 | 128 | ||
127 | #define SPI_NCCMD_OSD_DATA 100 |
129 | #define SPI_NCCMD_OSD_DATA 100 |
128 | #define SPI_NCCMD_GPS_POS 101 |
130 | #define SPI_NCCMD_GPS_POS 101 |
129 | #define SPI_NCCMD_GPS_TARGET 102 |
131 | #define SPI_NCCMD_GPS_TARGET 102 |
130 | #define SPI_NCCMD_KALMAN 103 |
132 | #define SPI_NCCMD_KALMAN 103 |
131 | #define SPI_NCCMD_VERSION 104 |
133 | #define SPI_NCCMD_VERSION 104 |
132 | #define SPI_NCCMD_GPSINFO 105 |
134 | #define SPI_NCCMD_GPSINFO 105 |
133 | #define SPI_NCCMD_HOTT_INFO 106 |
135 | #define SPI_NCCMD_HOTT_INFO 106 |
134 | #define SPI_MISC 107 |
136 | #define SPI_MISC 107 |
135 | 137 | ||
136 | #define HOTT_VARIO_PACKET_ID 0x89 |
138 | #define HOTT_VARIO_PACKET_ID 0x89 |
137 | #define HOTT_GPS_PACKET_ID 0x8A |
139 | #define HOTT_GPS_PACKET_ID 0x8A |
138 | #define HOTT_ELECTRIC_AIR_PACKET_ID 0x8E |
140 | #define HOTT_ELECTRIC_AIR_PACKET_ID 0x8E |
139 | #define HOTT_GENERAL_PACKET_ID 0x8D |
141 | #define HOTT_GENERAL_PACKET_ID 0x8D |
140 | #define JETI_GPS_PACKET_ID1 0x01 |
142 | #define JETI_GPS_PACKET_ID1 0x01 |
141 | #define JETI_GPS_PACKET_ID2 0x02 |
143 | #define JETI_GPS_PACKET_ID2 0x02 |
142 | #define HOTT_WPL_NAME 0x03 |
144 | #define HOTT_WPL_NAME 0x03 |
143 | 145 | ||
144 | typedef struct |
146 | typedef struct |
145 | { |
147 | { |
146 | u8 Command; |
148 | u8 Command; |
147 | GPS_Stick_t GPSStick; |
149 | GPS_Stick_t GPSStick; |
148 | s16 MagVecX; |
150 | s16 MagVecX; |
149 | s16 CompassHeading; |
151 | s16 CompassHeading; |
150 | s16 AccErrorN; |
152 | s16 AccErrorN; |
151 | s16 AccErrorR; |
153 | s16 AccErrorR; |
152 | s16 MagVecY; |
154 | s16 MagVecY; |
153 | s16 MagVecZ; |
155 | s16 MagVecZ; |
154 | u16 BeepTime; |
156 | u16 BeepTime; |
155 | union |
157 | union |
156 | { |
158 | { |
157 | u8 Byte[12]; |
159 | u8 Byte[12]; |
158 | s8 sByte[12]; |
160 | s8 sByte[12]; |
159 | u16 Int[6]; |
161 | u16 Int[6]; |
160 | s16 sInt[6]; |
162 | s16 sInt[6]; |
161 | u32 Long[3]; |
163 | u32 Long[3]; |
162 | s32 sLong[3]; |
164 | s32 sLong[3]; |
163 | float Float[3]; |
165 | float Float[3]; |
164 | }Param; |
166 | }Param; |
165 | u8 Chksum; |
167 | u8 Chksum; |
166 | } __attribute__((packed)) ToFlightCtrl_t; |
168 | } __attribute__((packed)) ToFlightCtrl_t; |
167 | 169 | ||
168 | typedef struct |
170 | typedef struct |
169 | { |
171 | { |
170 | u8 Current; |
172 | u8 Current; |
171 | u8 Temperature; |
173 | u8 Temperature; |
172 | u8 MaxPWM; |
174 | u8 MaxPWM; |
173 | u8 State; |
175 | u8 State; |
174 | u8 NotReadyCnt; |
176 | u8 NotReadyCnt; |
175 | } __attribute__((packed)) Motor_t; |
177 | } __attribute__((packed)) Motor_t; |
176 | 178 | ||
177 | extern Motor_t Motor[12]; |
179 | extern Motor_t Motor[12]; |
178 | 180 | ||
179 | #define MOTOR_STATE_NEW_PROTOCOL_MASK 0x01 |
181 | #define MOTOR_STATE_NEW_PROTOCOL_MASK 0x01 |
180 | #define MOTOR_STATE_FAST_MODE 0x02 |
182 | #define MOTOR_STATE_FAST_MODE 0x02 |
181 | #define MOTOR_STATE_BL30 0x04 // extended Current measurement -> 200 = 20A 201 = 21A 255 = 75A (20+55) |
183 | #define MOTOR_STATE_BL30 0x04 // extended Current measurement -> 200 = 20A 201 = 21A 255 = 75A (20+55) |
182 | extern u8 Motor_Version[12]; // das kann nicht in die struct, weil der PC die Struktur bekommt |
184 | extern u8 Motor_Version[12]; // das kann nicht in die struct, weil der PC die Struktur bekommt |
183 | 185 | ||
184 | 186 | ||
185 | 187 | ||
186 | typedef struct |
188 | typedef struct |
187 | { |
189 | { |
188 | u8 Major; |
190 | u8 Major; |
189 | u8 Minor; |
191 | u8 Minor; |
190 | u8 Patch; |
192 | u8 Patch; |
191 | u8 Compatible; |
193 | u8 Compatible; |
192 | u8 Hardware; |
194 | u8 Hardware; |
193 | } __attribute__((packed)) SPI_Version_t; |
195 | } __attribute__((packed)) SPI_Version_t; |
194 | 196 | ||
195 | extern FromFlightCtrl_t FromFlightCtrl; |
197 | extern FromFlightCtrl_t FromFlightCtrl; |
196 | extern ToFlightCtrl_t ToFlightCtrl; |
198 | extern ToFlightCtrl_t ToFlightCtrl; |
197 | extern volatile u32 SPI0_Timeout; |
199 | extern volatile u32 SPI0_Timeout; |
198 | extern SPI_Version_t FC_Version; |
200 | extern SPI_Version_t FC_Version; |
199 | extern s16 GPS_Aid_StickMultiplikator; |
201 | extern s16 GPS_Aid_StickMultiplikator; |
200 | extern u8 CompassCalState; |
202 | extern u8 CompassCalState; |
201 | 203 | ||
202 | void SPI0_Init(void); |
204 | void SPI0_Init(void); |
203 | void SPI0_GetFlightCtrlVersion(void); |
205 | void SPI0_GetFlightCtrlVersion(void); |
204 | void SPI0_UpdateBuffer(void); |
206 | void SPI0_UpdateBuffer(void); |
205 | u16 BL3_Current(u8 who); // in 0.1A |
207 | u16 BL3_Current(u8 who); // in 0.1A |
206 | 208 | ||
207 | #endif //_SPI_SLAVE_H |
209 | #endif //_SPI_SLAVE_H |
208 | 210 |