|
|
|
@ -294,8 +294,8 @@ void NavEKF2_core::setAidingMode()
@@ -294,8 +294,8 @@ void NavEKF2_core::setAidingMode()
|
|
|
|
|
// We have commenced aiding and range beacon usage is allowed
|
|
|
|
|
if (canUseRangeBeacon) { |
|
|
|
|
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_INFO, "EKF2 IMU%u is using range beacons",(unsigned)imu_index); |
|
|
|
|
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_INFO, "EKF2 IMU%u initial pos NE = %3.1f,%3.1f (m)",(unsigned)imu_index,receiverPos.x,receiverPos.y); |
|
|
|
|
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_INFO, "EKF2 IMU%u initial beacon pos D offset = %3.1f (m)",(unsigned)imu_index,bcnPosOffset); |
|
|
|
|
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_INFO, "EKF2 IMU%u initial pos NE = %3.1f,%3.1f (m)",(unsigned)imu_index,(double)receiverPos.x,(double)receiverPos.y); |
|
|
|
|
GCS_MAVLINK::send_statustext_all(MAV_SEVERITY_INFO, "EKF2 IMU%u initial beacon pos D offset = %3.1f (m)",(unsigned)imu_index,(double)bcnPosOffset); |
|
|
|
|
} |
|
|
|
|
// reset the last fusion accepted times to prevent unwanted activation of timeout logic
|
|
|
|
|
lastPosPassTime_ms = imuSampleTime_ms; |
|
|
|
|