EKF: Add fusion of external yaw data

This commit is contained in:
Paul Riseborough
2016-05-14 21:17:29 +10:00
parent 37a09c61bc
commit e917d6c7f2
4 changed files with 60 additions and 10 deletions
+4
View File
@@ -310,6 +310,10 @@ bool Ekf::update()
_fuse_pos = true;
_fuse_height = true;
}
// use external vision yaw observation
if (_control_status.flags.ev_yaw) {
fuseHeading();
}
}
// If we are using optical flow aiding and data has fallen behind the fusion time horizon, then fuse it