| 83,6 → 83,8 |
|---|
| u8 Logging_FCStatusFlags1 = 0,Logging_FCStatusFlags2 = 0; |
| u8 SpeakHoTT = 0; |
| u32 LoggingGasFilter = 0, LoggingGasCnt = 0; |
| u8 Out1TriggerUpdateBlocked = 0; |
| u8 Out1TriggerUpdateNewData = 0; |
| |
| // tx packet buffer |
| #define SPI_TXBUFFER_LEN (2 + sizeof(ToFlightCtrl)) // 2 bytes at start are for synchronization |
| 429,6 → 431,9 |
|---|
| { |
| LogFC_WP_EventChannel = FC_WP_EventChannel; // to make sure that it will be logged |
| NaviData_WP.WP_Eventchannel = FC_WP_EventChannel; // to make sure that it will be logged |
| Out1TriggerUpdateBlocked = 3; // makes sure that the right trigger-pos is sent in command 18 |
| NaviData_Out1Trigger.Longitude = NaviData.CurrentPosition.Longitude; |
| NaviData_Out1Trigger.Latitude = NaviData.CurrentPosition.Latitude; |
| } |
| FC_WP_EventChannel_Processed = 1; |
| // ++++++++++++++++++++++++++++++++++ |
| 690,10 → 695,15 |
|---|
| //0x10 |
| if(FromFlightCtrl.Param.Byte[2] & 0x80) // this Flag marks a changed Out1 |
| { |
| Out1TriggerUpdateNewData = 1; |
| if(!Out1TriggerUpdateBlocked) |
| { |
| NaviData_Out1Trigger.Longitude = NaviData.CurrentPosition.Longitude; |
| NaviData_Out1Trigger.Latitude = NaviData.CurrentPosition.Latitude; |
| NaviData_Out1Trigger.Altimeter = NaviData.Altimeter; |
| } |
| Out1TriggerUpdateBlocked = 0; |
| } |
| if(Out1TriggerUpdateBlocked) Out1TriggerUpdateBlocked--; |
| index = FromFlightCtrl.Param.Byte[2] & 0x0f; //MAX_MOTORS |
| Motor[index].NotReadyCnt = FromFlightCtrl.Param.Byte[6]; |
| Motor_Version[index] = FromFlightCtrl.Param.Byte[7]; |