414,12 → 414,13 |
{ |
if(!(FC.StatusFlags2 & FC_STATUS2_CAREFREE)) // CF ist jetzt ausgeschaltet -> neue Richtung lernen |
{ |
if(NaviData.HomePositionDeviation.Distance > 200) // nur bei ausreichender Distance -> 20m |
if(NaviData.HomePositionDeviation.Distance > 100) // nur bei ausreichender distance |
{ |
HeadFreeStartAngle = (10 * NaviData.HomePositionDeviation.Bearing + 1800 + 3600 - Parameter.OrientationAngle * 150) % 3600; // in 0.1° |
HeadFreeStartAngle = (10 * NaviData.HomePositionDeviation.Bearing + 1800) % 3600; // in 0.1° |
} |
else // Ansonsten die aktuelle Richtung übernehmen |
HeadFreeStartAngle = (3600 + FromFlightCtrl.GyroHeading /*+ Parameter.OrientationAngle * 150*/) % 3600; // in 0.1° |
HeadFreeStartAngle = FromFlightCtrl.GyroHeading; // in 0.1° |
|
} |
} |
|