WebSVN - NaviCtrl - Diff - Rev 510 and 514


#ifndef _SPI_SLAVE_H
#define _SPI_SLAVE_H
 
#include "fifo.h"
#include "gps.h"
 
#define SPEAK_ERR_CALIBARTION  1
#define SPEAK_ERR_RECEICER       2
#define SPEAK_ERR_DATABUS        3
#define SPEAK_ERR_NAVI           4
#define SPEAK_ERROR                      5
#define SPEAK_ERR_COMPASS        6
#define SPEAK_ERR_SENSOR         7
#define SPEAK_ERR_GPS            8
#define SPEAK_ERR_MOTOR          9
#define SPEAK_MAX_TEMPERAT  10
#define SPEAK_ALTI_REACHED  11
#define SPEAK_WP_REACHED    12
#define SPEAK_NEXT_WP       13
#define SPEAK_LANDING       14
#define SPEAK_GPS_FIX       15
#define SPEAK_UNDERVOLTAGE  16
#define SPEAK_GPS_HOLD      17
#define SPEAK_GPS_HOME      18
#define SPEAK_GPS_OFF       19
#define SPEAK_BEEP          20
#define SPEAK_MIKROKOPTER   21
#define SPEAK_CAPACITY      22
#define SPEAK_CF_OFF        23
#define SPEAK_CALIBRATE     24
#define SPEAK_MAX_RANGE     25
#define SPEAK_MAX_ALTITUD   26
 
#define SPEAK_MK_OFF            38
#define SPEAK_ALTITUDE_ON       39
#define SPEAK_ALTITUDE_OFF      40
#define SPEAK_CF_ON             46
#define SPEAK_SINKING           47
#define SPEAK_RISING            48
#define SPEAK_HOLDING           49
#define SPEAK_GPS_ON            50
#define SPEAK_FOLLWING          51
#define SPEAK_STARTING      52
 
 
#define SS_PIN GPIO_ReadBit(GPIO2, GPIO_Pin_7)
 
#define SPI_FCCMD_USER                  10
#define SPI_FCCMD_STICK                 11
#define SPI_FCCMD_MISC                  12
#define SPI_FCCMD_PARAMETER1    13
#define SPI_FCCMD_VERSION               14
#define SPI_FCCMD_SERVOS                15
#define SPI_FCCMD_BL_ACCU               16
#define SPI_FCCMD_PARAMETER2    17
 
#define CHK_POTI(b,a) { if(a < 248) b = a; else b = FC.Poti[255 - a]; }
#define CHK_POTI_MM(b,a,min,max) {CHK_POTI(b,a); LIMIT_MIN_MAX(b, min, max); }
 
extern s32 Kalman_K;
extern s32 Kalman_Kompass ;
extern s32 Kalman_MaxDrift;
extern s32 Kalman_MaxFusion;
extern s32 ToFcGpsZ;
extern s32 ToFC_Rotate_C, ToFC_Rotate_S;
extern s32 HeadFreeStartAngle;
extern s16 FC_WP_EventChannel,LogFC_WP_EventChannel;
extern u32 ToFC_AltitudeRate;
extern s32 ToFC_AltitudeSetpoint;
extern u8 NC_GPS_ModeCharacter;
extern u8 FC_is_Calibrated;
extern u8 FCCalibActive;
extern u8 SpeakHoTT;
extern u8 NC_Wait_for_LED;
extern s16 GyroCompassCorrected;
extern s16 CompassSetpointCorrected; // The compass setpoint that the FC tries to keep - corrected with the magnetic declination
extern s16 CompassSetpoint;
           
extern u8 BL_MinOfMaxPWM;  // indication if all BL-controllers run on full power
extern u32 FC_I2C_ErrorConter;
extern u8 FromFC_VarioCharacter;
extern u8 Logging_FCStatusFlags1,Logging_FCStatusFlags2;
extern s16 POI_KameraNick;
extern u8 NC_To_FC_Flags, NC_To_FC_Autostart;
typedef struct
{
        u8   Command;
        s16  AngleNick;  // NickAngle in 0.1 deg
        s16  AngleRoll;  // RollAngle in 0.1 deg
        s16  AccNick;
        s16  AccRoll;
        s16  GyroHeading; // Heading in 0.1 deg
        s16  GyroNick;
        s16  GyroRoll;
        s16  GyroYaw;
        u16  FCStatus;
        union
        {
                u8    Byte[12];
                s8        sByte[12];
                u16   Int[6];
                s16   sInt[6];
                u32   Long[3];
                s32   sLong[3];
                float Float[3];
        } Param;
        u8 Chksum;
 } __attribute__((packed)) FromFlightCtrl_t;
 
//NC_To_FC_Flags
#define NC_TO_FC_FLYING_RANGE           0x01
#define NC_TO_FC_EMERGENCY_LANDING      0x02
#define NC_TO_FC_AUTOSTART                      0x04
#define NC_TO_FC_AUTOLANDING            0x08 // not used
 
#define SPI_NCCMD_OSD_DATA              100
#define SPI_NCCMD_GPS_POS               101
#define SPI_NCCMD_GPS_TARGET    102
#define SPI_NCCMD_KALMAN                103
#define SPI_NCCMD_VERSION               104
#define SPI_NCCMD_GPSINFO               105
#define SPI_NCCMD_HOTT_INFO             106
#define SPI_MISC                                107
 
#define HOTT_VARIO_PACKET_ID            0x89
#define HOTT_GPS_PACKET_ID                      0x8A
#define HOTT_ELECTRIC_AIR_PACKET_ID     0x8E
#define HOTT_GENERAL_PACKET_ID          0x8D
#define JETI_GPS_PACKET_ID1                     0x01
#define JETI_GPS_PACKET_ID2                     0x02
#define HOTT_WPL_NAME                           0x03
 
typedef struct
{
        u8 Command;
        GPS_Stick_t GPSStick;
        s16 MagVecX;
        s16 CompassHeading;
        s16 AccErrorN;
        s16 AccErrorR;
        s16 MagVecY;
        s16 MagVecZ;
        u16 BeepTime;
        union
        {
                u8    Byte[12];
                s8    sByte[12];
                u16       Int[6];
                s16   sInt[6];
                u32   Long[3];
                s32   sLong[3];
                float Float[3];
        }Param;
        u8 Chksum;
 } __attribute__((packed)) ToFlightCtrl_t;
 
typedef struct
{
 u8 Current;
 u8 Temperature;
 u8 MaxPWM;
 u8 State;
} __attribute__((packed)) Motor_t;
 
extern Motor_t Motor[12];
 
#define MOTOR_STATE_NEW_PROTOCOL_MASK   0x01
#define MOTOR_STATE_FAST_MODE           0x02
#define MOTOR_STATE_BL30                0x04   // extended Current measurement -> 200 = 20A    201 = 21A    255 = 75A (20+55)
extern u8 Motor_Version[12]; // das kann nicht in die struct, weil der PC die Struktur bekommt
 
 
 
typedef struct
{
   u8 Major;
   u8 Minor;
   u8 Patch;
   u8 Compatible;
   u8 Hardware;
} __attribute__((packed)) SPI_Version_t;
 
extern FromFlightCtrl_t   FromFlightCtrl;
extern ToFlightCtrl_t     ToFlightCtrl;
extern volatile u32 SPI0_Timeout;
extern SPI_Version_t FC_Version;
extern s16 GPS_Aid_StickMultiplikator;
extern u8 CompassCalState;
 
void SPI0_Init(void);
void SPI0_GetFlightCtrlVersion(void);
void SPI0_UpdateBuffer(void);
u16 BL3_Current(u8 who); // in 0.1A
 
#endif //_SPI_SLAVE_H
 

Rev 510	Rev 514
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	extern s16 CompassSetpointCorrected; // The compass setpoint that the FC tries to keep - corrected with the magnetic declination	76	extern s16 CompassSetpointCorrected; // The compass setpoint that the FC tries to keep - corrected with the magnetic declination
77	extern s16 CompassSetpoint;	77	extern s16 CompassSetpoint;
78		78
79	extern u8 BL_MinOfMaxPWM; // indication if all BL-controllers run on full power	79	extern u8 BL_MinOfMaxPWM; // indication if all BL-controllers run on full power
80	extern u32 FC_I2C_ErrorConter;	80	extern u32 FC_I2C_ErrorConter;
81	extern u8 FromFC_VarioCharacter;	81	extern u8 FromFC_VarioCharacter;
82	extern u8 Logging_FCStatusFlags1,Logging_FCStatusFlags2;	82	extern u8 Logging_FCStatusFlags1,Logging_FCStatusFlags2;
83	extern s16 POI_KameraNick;	83	extern s16 POI_KameraNick;
84	extern u8 NC_To_FC_Flags, NC_To_FC_Autostart;	84	extern u8 NC_To_FC_Flags, NC_To_FC_Autostart;
85	typedef struct	85	typedef struct
86	{	86	{
87	u8 Command;	87	u8 Command;
88	s16 AngleNick; // NickAngle in 0.1 deg	88	s16 AngleNick; // NickAngle in 0.1 deg
89	s16 AngleRoll; // RollAngle in 0.1 deg	89	s16 AngleRoll; // RollAngle in 0.1 deg
90	s16 AccNick;	90	s16 AccNick;
91	s16 AccRoll;	91	s16 AccRoll;
92	s16 GyroHeading; // Heading in 0.1 deg	92	s16 GyroHeading; // Heading in 0.1 deg
93	s16 GyroNick;	93	s16 GyroNick;
94	s16 GyroRoll;	94	s16 GyroRoll;
95	s16 GyroYaw;	95	s16 GyroYaw;
96	u16 FCStatus;	96	u16 FCStatus;
97	union	97	union
98	{	98	{
99	u8 Byte[12];	99	u8 Byte[12];
100	s8 sByte[12];	100	s8 sByte[12];
101	u16 Int[6];	101	u16 Int[6];
102	s16 sInt[6];	102	s16 sInt[6];
103	u32 Long[3];	103	u32 Long[3];
104	s32 sLong[3];	104	s32 sLong[3];
105	float Float[3];	105	float Float[3];
106	} Param;	106	} Param;
107	u8 Chksum;	107	u8 Chksum;
108	} __attribute__((packed)) FromFlightCtrl_t;	108	} __attribute__((packed)) FromFlightCtrl_t;
109		109
110	//NC_To_FC_Flags	110	//NC_To_FC_Flags
111	#define NC_TO_FC_FLYING_RANGE 0x01	111	#define NC_TO_FC_FLYING_RANGE 0x01
112	#define NC_TO_FC_EMERGENCY_LANDING 0x02	112	#define NC_TO_FC_EMERGENCY_LANDING 0x02
113	#define NC_TO_FC_AUTOSTART 0x04	113	#define NC_TO_FC_AUTOSTART 0x04
114	#define NC_TO_FC_AUTOLANDING 0x08 // not used	114	#define NC_TO_FC_AUTOLANDING 0x08 // not used
115		115
116	#define SPI_NCCMD_OSD_DATA 100	116	#define SPI_NCCMD_OSD_DATA 100
117	#define SPI_NCCMD_GPS_POS 101	117	#define SPI_NCCMD_GPS_POS 101
118	#define SPI_NCCMD_GPS_TARGET 102	118	#define SPI_NCCMD_GPS_TARGET 102
119	#define SPI_NCCMD_KALMAN 103	119	#define SPI_NCCMD_KALMAN 103
120	#define SPI_NCCMD_VERSION 104	120	#define SPI_NCCMD_VERSION 104
121	#define SPI_NCCMD_GPSINFO 105	121	#define SPI_NCCMD_GPSINFO 105
122	#define SPI_NCCMD_HOTT_INFO 106	122	#define SPI_NCCMD_HOTT_INFO 106
123	#define SPI_MISC 107	123	#define SPI_MISC 107
124		124
125	#define HOTT_VARIO_PACKET_ID 0x89	125	#define HOTT_VARIO_PACKET_ID 0x89
126	#define HOTT_GPS_PACKET_ID 0x8A	126	#define HOTT_GPS_PACKET_ID 0x8A
127	#define HOTT_ELECTRIC_AIR_PACKET_ID 0x8E	127	#define HOTT_ELECTRIC_AIR_PACKET_ID 0x8E
128	#define HOTT_GENERAL_PACKET_ID 0x8D	128	#define HOTT_GENERAL_PACKET_ID 0x8D
129	#define JETI_GPS_PACKET_ID1 0x01	129	#define JETI_GPS_PACKET_ID1 0x01
130	#define JETI_GPS_PACKET_ID2 0x02	130	#define JETI_GPS_PACKET_ID2 0x02
131	#define HOTT_WPL_NAME 0x03	131	#define HOTT_WPL_NAME 0x03
132		132
133	typedef struct	133	typedef struct
134	{	134	{
135	u8 Command;	135	u8 Command;
136	GPS_Stick_t GPSStick;	136	GPS_Stick_t GPSStick;
137	s16 MagVecX;	137	s16 MagVecX;
138	s16 CompassHeading;	138	s16 CompassHeading;
139	s16 AccErrorN;	139	s16 AccErrorN;
140	s16 AccErrorR;	140	s16 AccErrorR;
141	s16 MagVecY;	141	s16 MagVecY;
142	s16 MagVecZ;	142	s16 MagVecZ;
143	u16 BeepTime;	143	u16 BeepTime;
144	union	144	union
145	{	145	{
146	u8 Byte[12];	146	u8 Byte[12];
147	s8 sByte[12];	147	s8 sByte[12];
148	u16 Int[6];	148	u16 Int[6];
149	s16 sInt[6];	149	s16 sInt[6];
150	u32 Long[3];	150	u32 Long[3];
151	s32 sLong[3];	151	s32 sLong[3];
152	float Float[3];	152	float Float[3];
153	}Param;	153	}Param;
154	u8 Chksum;	154	u8 Chksum;
155	} __attribute__((packed)) ToFlightCtrl_t;	155	} __attribute__((packed)) ToFlightCtrl_t;
156		156
157	typedef struct	157	typedef struct
158	{	158	{
159	u8 Current;	159	u8 Current;
160	u8 Temperature;	160	u8 Temperature;
161	u8 MaxPWM;	161	u8 MaxPWM;
162	u8 State;	162	u8 State;
163	} __attribute__((packed)) Motor_t;	163	} __attribute__((packed)) Motor_t;
164		164
165	extern Motor_t Motor[12];	165	extern Motor_t Motor[12];
166		166
167	#define MOTOR_STATE_NEW_PROTOCOL_MASK 0x01	167	#define MOTOR_STATE_NEW_PROTOCOL_MASK 0x01
168	#define MOTOR_STATE_FAST_MODE 0x02	168	#define MOTOR_STATE_FAST_MODE 0x02
169	#define MOTOR_STATE_BL30 0x04 // extended Current measurement -> 200 = 20A 201 = 21A 255 = 75A (20+55)	169	#define MOTOR_STATE_BL30 0x04 // extended Current measurement -> 200 = 20A 201 = 21A 255 = 75A (20+55)
170	extern u8 Motor_Version[12]; // das kann nicht in die struct, weil der PC die Struktur bekommt	170	extern u8 Motor_Version[12]; // das kann nicht in die struct, weil der PC die Struktur bekommt
171		171
172		172
173		173
174	typedef struct	174	typedef struct
175	{	175	{
176	u8 Major;	176	u8 Major;
177	u8 Minor;	177	u8 Minor;
178	u8 Patch;	178	u8 Patch;
179	u8 Compatible;	179	u8 Compatible;
180	u8 Hardware;	180	u8 Hardware;
181	} __attribute__((packed)) SPI_Version_t;	181	} __attribute__((packed)) SPI_Version_t;
182		182
183	extern FromFlightCtrl_t FromFlightCtrl;	183	extern FromFlightCtrl_t FromFlightCtrl;
184	extern ToFlightCtrl_t ToFlightCtrl;	184	extern ToFlightCtrl_t ToFlightCtrl;
185	extern volatile u32 SPI0_Timeout;	185	extern volatile u32 SPI0_Timeout;
186	extern SPI_Version_t FC_Version;	186	extern SPI_Version_t FC_Version;
187	extern u8 GPS_Aid_StickMultiplikator;	187	extern s16 GPS_Aid_StickMultiplikator;
188	extern u8 CompassCalState;	188	extern u8 CompassCalState;
189		189
190	void SPI0_Init(void);	190	void SPI0_Init(void);
191	void SPI0_GetFlightCtrlVersion(void);	191	void SPI0_GetFlightCtrlVersion(void);
192	void SPI0_UpdateBuffer(void);	192	void SPI0_UpdateBuffer(void);
193	u16 BL3_Current(u8 who); // in 0.1A	193	u16 BL3_Current(u8 who); // in 0.1A
194		194
195	#endif //_SPI_SLAVE_H	195	#endif //_SPI_SLAVE_H
196		196

Subversion Repositories NaviCtrl

(root)/tags/V2.14e/spi_slave.h @ 764 - Rev 510 → 514