94,6 → 94,7 |
u8 Out1TriggerUpdateBlocked = 0; |
u8 Out1TriggerUpdateNewData = 0; |
u8 CntSpiErrorPerSecond = 0; |
s32 BaroAltimeter_dm = 0; |
|
// tx packet buffer |
volatile u8 SPI_TxBuffer[sizeof(HugeBlockFromFC) + 10]; |
976,8 → 977,8 |
// else CompassCalState = 0; |
} |
HoverGas = FromFlightCtrl.Param.Byte[1]; |
NaviData.Variometer = (NaviData.Variometer + 2 * (FromFlightCtrl.Param.sInt[1] - NaviData.Altimeter_5cm)) / 2; // provisorisch |
FC.Altimeter_5cm = FromFlightCtrl.Param.sInt[1]; // in 5cm |
NaviData.Variometer = (NaviData.Variometer + 2 * (FromFlightCtrl.Param.sInt[1] - BaroAltimeter_dm)); // provisorisch |
FC.Altimeter_dm = FromFlightCtrl.Param.sInt[1]; // in 10cm |
if(!(SimulationFlags & SIMULATION_ACTIVE)) NaviData.SetpointAltitude = FromFlightCtrl.Param.sInt[2]; // in 5cm |
FC.Error[0] |= FromFlightCtrl.Param.Byte[6]; |
FC.Error[1] |= FromFlightCtrl.Param.Byte[7]; |