Fix avoiding TF_REPEATED in publishing setpoint frame

This commit is contained in:
Oleg Kalachev
2022-12-22 22:53:18 +03:00
parent d73b627579
commit 90620d148f

View File

@@ -525,7 +525,7 @@ void publish(const ros::Time stamp)
// publish setpoint frame
if (!setpoint.child_frame_id.empty()) {
if (setpoint.header.stamp == position_msg.header.stamp) {
if (setpoint.header.stamp >= position_msg.header.stamp) {
return; // avoid TF_REPEATED_DATA warnings
}