Planning : fix the trajectory update in open space planner in multi-threads

modules/planning/planner/open_space/open_space_planner.cc

@@ -126,7 +126,9 @@ apollo::common::Status OpenSpacePlanner::Plan(
 
     if (IsCollisionFreeTrajectory(current_trajectory_)) {
       // Convet current trajectory to publishable_trajectory
-      //  frame->mutable_trajectory()->CopyFrom(current_trajectory_);
+      publishable_trajectory_.Clear();
+      publishable_trajectory_.MergeFrom(current_trajectory_);
+      frame->mutable_trajectory()->CopyFrom(publishable_trajectory_);
       return Status::OK();
     } else {
       // If collision happens, return wrong planning status and estop