fix(freespace_planner): fix parking trajectory errors and warnings when parking completed (#6696)

fix(freespace_planner): publish stop trajectory when completed to mitigate topic timeout

Signed-off-by: AhmedEbrahim <ahmed.a.d.ebrahim@gmail.com>

Author: ahmeddesokyebrahim

planning/freespace_planner/src/freespace_planner/freespace_planner_node.cpp

@@ -430,6 +430,9 @@ void FreespacePlannerNode::onTimer()
   }
 
   if (is_completed_) {
+    partial_trajectory_.header = odom_->header;
+    const auto stop_trajectory = createStopTrajectory(partial_trajectory_);
+    trajectory_pub_->publish(stop_trajectory);
     return;
   }