We read every piece of feedback, and take your input very seriously.
To see all available qualifiers, see our documentation.
1 parent 09d7b81 commit ecf4c0fCopy full SHA for ecf4c0f
planning/planning_validator/src/planning_validator.cpp
@@ -193,8 +193,10 @@ void PlanningValidator::publishTrajectory()
193
{
194
// Validation check is all green. Publish the trajectory.
195
if (isAllValid(validation_status_)) {
196
- pub_traj_->publish(*current_trajectory_);
197
- previous_published_trajectory_ = current_trajectory_;
+ auto msg_sent = *current_trajectory_;
+ msg_sent.header.stamp = this->now();
198
+ pub_traj_->publish(msg_sent);
199
+ previous_published_trajectory_ = std::make_shared<Trajectory>(msg_sent);
200
return;
201
}
202
0 commit comments