Merge remote-tracking branch 'upstream/master'

This commit is contained in:
mcsauder
2016-02-25 22:51:58 -07:00
15 changed files with 237 additions and 163 deletions
+1 -1
View File
@@ -272,7 +272,7 @@ bool Ekf::initialiseFilter(void)
if (_delVel_sum.norm() > 0.001f) {
_delVel_sum.normalize();
pitch = asinf(_delVel_sum(0));
roll = -asinf(_delVel_sum(1) / cosf(pitch));
roll = atan2f(-_delVel_sum(1), -_delVel_sum(2));
} else {
return false;