Rev 323 | Rev 326 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 323 | Rev 325 | ||
---|---|---|---|
Line 412... | Line 412... | ||
412 | 412 | ||
413 | if((Parameter.ExtraConfig & CFG_LEARNABLE_CAREFREE) && (NCFlags & NC_FLAG_GPS_OK)) |
413 | if((Parameter.ExtraConfig & CFG_LEARNABLE_CAREFREE) && (NCFlags & NC_FLAG_GPS_OK)) |
414 | { |
414 | { |
415 | if(!(FC.StatusFlags2 & FC_STATUS2_CAREFREE)) // CF ist jetzt ausgeschaltet -> neue Richtung lernen |
415 | if(!(FC.StatusFlags2 & FC_STATUS2_CAREFREE)) // CF ist jetzt ausgeschaltet -> neue Richtung lernen |
416 | { |
416 | { |
417 | if(NaviData.HomePositionDeviation.Distance > 100) // nur bei ausreichender distance |
417 | if(NaviData.HomePositionDeviation.Distance > 200) // nur bei ausreichender Distance -> 20m |
418 | { |
418 | { |
419 | HeadFreeStartAngle = (10 * NaviData.HomePositionDeviation.Bearing + 1800) % 3600; // in 0.1° |
419 | HeadFreeStartAngle = (10 * NaviData.HomePositionDeviation.Bearing + 1800 + 3600 - Parameter.OrientationAngle * 150) % 3600; // in 0.1° |
420 | } |
420 | } |
421 | else // Ansonsten die aktuelle Richtung übernehmen |
421 | else // Ansonsten die aktuelle Richtung übernehmen |
422 | HeadFreeStartAngle = FromFlightCtrl.GyroHeading; // in 0.1° |
- | |
423 | 422 | HeadFreeStartAngle = (3600 + FromFlightCtrl.GyroHeading /*+ Parameter.OrientationAngle * 150*/) % 3600; // in 0.1° |
|
424 | } |
423 | } |
Line 425... | Line 424... | ||
425 | } |
424 | } |
426 | 425 |