106,6 → 106,7 |
u32 ToFC_AltitudeRate = 0; |
s32 ToFC_AltitudeSetpoint = 0; |
u8 FromFC_VarioCharacter = ' '; |
u8 DisableFC_Sticks = 0; |
|
SPI_Version_t FC_Version; |
|
292,7 → 293,7 |
ToFlightCtrl.Command = SPI_CommandSequence[SPI_CommandCounter++]; |
// restart command cycle at the end |
if (SPI_CommandCounter >= sizeof(SPI_CommandSequence)) SPI_CommandCounter = 0; |
|
#define FLAG_GPS_AID 0x01 |
switch (ToFlightCtrl.Command) |
{ |
case SPI_NCCMD_KALMAN: |
304,7 → 305,7 |
ToFlightCtrl.Param.sByte[4] = (s8) ToFcGpsZ; |
ToFlightCtrl.Param.Byte[5] = (s8) ToFC_Rotate_C; |
ToFlightCtrl.Param.Byte[6] = (s8) ToFC_Rotate_S; |
//ToFlightCtrl.Param.Byte[7] = |
if(DisableFC_Sticks) ToFlightCtrl.Param.Byte[7] = FLAG_GPS_AID; else ToFlightCtrl.Param.Byte[7] = 0x00; |
if(CAM_Orientation.UpdateMask & CAM_UPDATE_AZIMUTH) |
{ |
ToFlightCtrl.Param.sInt[4] = CAM_Orientation.Azimuth; |