aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

AP_AHRS: correct sanity checks on update_trig

Browse Source
This commit is contained in:
Randy Mackay 2015-04-23 09:45:43 +09:00
parent 6a6ccb4f32
commit 6e30093924
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
libraries/AP_AHRS/AP_AHRS.cpp
View File

@ -261,8 +261,8 @@ void AP_AHRS::update_trig(void)
if (yaw_vector.is_inf() || yaw_vector.is_nan()) {
yaw_vector.x = 0.0f;
yaw_vector.y = 0.0f;
_sin_yaw = 1.0f;
_cos_yaw = 0.0f;
_sin_yaw = 0.0f;
_cos_yaw = 1.0f;
}
if (isinf(_cos_roll) || isnan(_cos_roll)) {