diff --git a/include/mrs_uav_state_estimators/processors/proc_tf_to_world.h b/include/mrs_uav_state_estimators/processors/proc_tf_to_world.h index 1ee4572..581d0aa 100644 --- a/include/mrs_uav_state_estimators/processors/proc_tf_to_world.h +++ b/include/mrs_uav_state_estimators/processors/proc_tf_to_world.h @@ -120,11 +120,11 @@ std::tuple ProcTfToWorld::process(measurement_t& mea gnss_x_ = (gnss_x_ - measurement(0)) - Processor::ch_->world_origin.x; gnss_y_ = (gnss_y_ - measurement(1)) - Processor::ch_->world_origin.y; is_gnss_offset_calculated_ = true; + ROS_INFO_THROTTLE(1.0, "[%s]: GNSS offset calculated as: [%.2f %.2f]", Processor::getPrintName().c_str(), gnss_x_, gnss_y_); } measurement(0) += gnss_x_; measurement(1) += gnss_y_; - ROS_INFO_THROTTLE(1.0, "[%s]: GNSS offset calculated at: [%.2f %.2f]", Processor::getPrintName().c_str(), gnss_x_, gnss_y_); return {true, true}; } /*//}*/