mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-01-11 10:28:29 -04:00
ACM: Small fix to Yaw Look Ahead
This commit is contained in:
parent
1d589c0b7d
commit
8c18a60766
@ -132,6 +132,7 @@ static void calc_velocity_and_position(){
|
|||||||
|
|
||||||
static void calc_ground_bearing(){
|
static void calc_ground_bearing(){
|
||||||
ground_bearing = atan2( lat_speed , lon_speed ) * DEGX100;
|
ground_bearing = atan2( lat_speed , lon_speed ) * DEGX100;
|
||||||
|
ground_bearing = wrap_360(ground_bearing); // atan2 returns a value of -pi to +pi, so we need to wrap this.
|
||||||
}
|
}
|
||||||
|
|
||||||
//****************************************************************
|
//****************************************************************
|
||||||
|
Loading…
Reference in New Issue
Block a user