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