diff --git a/EKF/control.cpp b/EKF/control.cpp index d49b2d3bdc..2a63cb6b8b 100644 --- a/EKF/control.cpp +++ b/EKF/control.cpp @@ -62,6 +62,7 @@ void Ekf::controlFusionModes() if (_time_last_imu - _time_last_ext_vision < 2 * EV_MAX_INTERVAL) { // turn on use of external vision measurements for position and height _control_status.flags.ev_pos = true; + printf("EKF switching to external vision position fusion"); // turn off other forms of height aiding _control_status.flags.baro_hgt = false; _control_status.flags.gps_hgt = false; @@ -97,6 +98,7 @@ void Ekf::controlFusionModes() // turn on fusion of external vision yaw measurements _control_status.flags.ev_yaw = true; + printf("EKF switching to external vision yaw fusion"); } }