mirror of
https://github.com/betaflight/betaflight.git
synced 2025-07-15 20:35:33 +03:00
Merge pull request #6166 from etracer65/gps_rescue_heading_fix
Fix gps rescue heading edge case
This commit is contained in:
commit
713e72321b
1 changed files with 3 additions and 2 deletions
|
@ -394,10 +394,11 @@ void setBearing(int16_t deg)
|
|||
{
|
||||
int16_t dif = DECIDEGREES_TO_DEGREES(attitude.values.yaw) - deg;
|
||||
|
||||
if (dif <= -180)
|
||||
if (dif <= -180) {
|
||||
dif += 360;
|
||||
if (dif >= +180)
|
||||
} else if (dif > 180) {
|
||||
dif -= 360;
|
||||
}
|
||||
|
||||
dif *= -GET_DIRECTION(rcControlsConfig()->yaw_control_reversed);
|
||||
|
||||
|
|
Loading…
Add table
Add a link
Reference in a new issue