436,6 → 436,7 |
NaviData_Out1Trigger.Latitude = NaviData.CurrentPosition.Latitude; |
} |
FC_WP_EventChannel_Processed = 1; |
//DebugOut.Analog[] = FC_WP_EventChannel; |
// ++++++++++++++++++++++++++++++++++ |
// Waypoint event +++++++++++++++++++ |
// ++++++++++++++++++++++++++++++++++ |
673,7 → 674,7 |
if((!(LastTransmittedFCStatusFlags2 & FC_STATUS2_OUT2_ACTIVE)) && (FC.StatusFlags2 & FC_STATUS2_OUT2_ACTIVE)) NaviData.FCStatusFlags2 |= FC_STATUS2_OUT2_ACTIVE; |
else |
if(((LastTransmittedFCStatusFlags2 & FC_STATUS2_OUT2_ACTIVE)) && !(FC.StatusFlags2 & FC_STATUS2_OUT2_ACTIVE)) NaviData.FCStatusFlags2 &= ~FC_STATUS2_OUT2_ACTIVE; |
|
//DebugOut.Analog[] = (NaviData.FCStatusFlags2 & FC_STATUS2_OUT1_ACTIVE); |
Logging_FCStatusFlags1 |= FC.StatusFlags; |
Logging_FCStatusFlags2 |= FC.StatusFlags2; |
FC.BAT_Voltage = FromFlightCtrl.Param.Int[5]; // 10 & 11 |
735,7 → 736,11 |
break; |
case SPI_FCCMD_PARAMETER2: |
CHK_POTI_MM(FC.AutoPhotoDistance,FromFlightCtrl.Param.Byte[0],0,255); |
if(FromFlightCtrl.Param.Byte[1]) FC.FromFC_SpeakHoTT = FromFlightCtrl.Param.Byte[1]; // will be cleared in the SD-Logging |
if(FromFlightCtrl.Param.Byte[1]) |
{ |
FC.FromFC_SpeakHoTT = FromFlightCtrl.Param.Byte[1]; // will be cleared in the SD-Logging |
NaviData_Flags.SpeakHoTT = FromFlightCtrl.Param.Byte[1]; // will be cleared after the Uart-Trasmitting |
} |
FC.BAT_UsedCapacity = FromFlightCtrl.Param.Int[1]; // 2 & 3 |
Parameter.FromFC_LowVoltageHomeActive = FromFlightCtrl.Param.Byte[4]; |
if(FromFlightCtrl.Param.Byte[5]) FromFC_LoadWP_List = FromFlightCtrl.Param.Byte[5]; |
786,6 → 791,7 |
FC.RC_Quality = FromFlightCtrl.Param.Byte[9]; |
if(FC.RC_Quality > 160) NaviData.RC_Quality = 200; else NaviData.RC_Quality = FC.RC_Quality; |
NC_Wait_for_LED = FromFlightCtrl.Param.Byte[10]; |
//DebugOut.Analog[] = NC_Wait_for_LED; |
NaviData.Gas = (FC.BAT_Voltage * (u32) FromFlightCtrl.Param.Byte[11]) / (u32) Parameter.LowVoltageWarning; |
if(LoggingGasCnt == 0) LoggingGasFilter = 0; |
LoggingGasFilter += (u32) FromFlightCtrl.Param.Byte[11]; |