Skip to content

Commit

Permalink
debug print
Browse files Browse the repository at this point in the history
  • Loading branch information
petrlmat committed Jan 25, 2024
1 parent f53beee commit a491499
Showing 1 changed file with 1 addition and 1 deletion.
Original file line number Diff line number Diff line change
Expand Up @@ -120,11 +120,11 @@ std::tuple<bool, bool> ProcTfToWorld<n_measurements>::process(measurement_t& mea
gnss_x_ = (gnss_x_ - measurement(0)) - Processor<n_measurements>::ch_->world_origin.x;
gnss_y_ = (gnss_y_ - measurement(1)) - Processor<n_measurements>::ch_->world_origin.y;
is_gnss_offset_calculated_ = true;
ROS_INFO_THROTTLE(1.0, "[%s]: GNSS offset calculated as: [%.2f %.2f]", Processor<n_measurements>::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<n_measurements>::getPrintName().c_str(), gnss_x_, gnss_y_);
return {true, true};
}
/*//}*/
Expand Down

0 comments on commit a491499

Please sign in to comment.