|
|
|
@ -789,7 +789,7 @@ bool Sub::verify_yaw()
@@ -789,7 +789,7 @@ bool Sub::verify_yaw()
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
// check if we are within 2 degrees of the target heading
|
|
|
|
|
return (labsf(wrap_180_cd(ahrs.yaw_sensor-yaw_look_at_heading)) <= 200); |
|
|
|
|
return (fabsf(wrap_180_cd(ahrs.yaw_sensor-yaw_look_at_heading)) <= 200); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/********************************************************************************/ |
|
|
|
|