| 979,7 → 979,11 |
|---|
| HoverGas = FromFlightCtrl.Param.Byte[1]; |
| if(!(SimulationFlags & SIMULATION_ACTIVE)) NaviData.Variometer = (NaviData.Variometer + 4 * (FromFlightCtrl.Param.sInt[1] - FC.Altimeter_dm)) / 2; |
| FC.Altimeter_dm = FromFlightCtrl.Param.sInt[1]; // in 10cm |
| if(!(SimulationFlags & SIMULATION_ACTIVE)) NaviData.SetpointAltitude_5cm = FromFlightCtrl.Param.sInt[2]; // in 5cm |
| if(!(SimulationFlags & SIMULATION_ACTIVE)) |
| { |
| NaviData.SetpointAltitude_5cm = FromFlightCtrl.Param.sInt[2] * 2; // in 5cm |
| FC.SetpointAltimeter_dm = FromFlightCtrl.Param.sInt[2]; // in dm |
| } |
| FC.Error[0] |= FromFlightCtrl.Param.Byte[6]; |
| FC.Error[1] |= FromFlightCtrl.Param.Byte[7]; |
| DebugOut.StatusGreen |= AMPEL_FC; // status of FC Present |