record planning init point into debug.

modules/planning/planning.cc

@@ -200,6 +200,11 @@ bool Planning::Plan(const bool is_on_auto_mode, const double publish_time,
     auto matched_info =
         ComputeStartingPointFromLastTrajectory(execution_start_time);
     TrajectoryPoint matched_point = matched_info.first;
+    if (FLAGS_enable_record_debug) {
+      trajectory_pb->mutable_debug()->mutable_planning_data()
+          ->mutable_init_point()->CopyFrom(matched_point);
+    }
+
     std::uint32_t matched_index = matched_info.second;
 
     // Compute the position deviation between current vehicle
@@ -239,10 +244,15 @@ bool Planning::Plan(const bool is_on_auto_mode, const double publish_time,
   //    2. we don't have the trajectory from last planning cycle or
   //    3. the position deviation from actual and target is too high
   // then planning from current vehicle state.
-  TrajectoryPoint vehicle_state_point =
+  TrajectoryPoint vehicle_start_point =
       ComputeStartingPointFromVehicleState(planning_cycle_time);
 
-  auto status = planner_->MakePlan(vehicle_state_point, trajectory_pb);
+  if (FLAGS_enable_record_debug) {
+    trajectory_pb->mutable_debug()->mutable_planning_data()
+        ->mutable_init_point()->CopyFrom(vehicle_start_point);
+  }
+
+  auto status = planner_->MakePlan(vehicle_start_point, trajectory_pb);
   if (!status.ok()) {
     last_trajectory_.clear();
     return false;

modules/planning/proto/planning_internal.proto

@@ -87,7 +87,7 @@ message PathDebug {
   optional apollo.common.Path path = 2;
 }
 
-// next id: 10
+// next id: 11
 message PlanningData {
   optional apollo.common.Header header = 1;
 
@@ -95,13 +95,14 @@ message PlanningData {
   optional apollo.localization.LocalizationEstimate adc_position = 7;
   optional apollo.canbus.Chassis chassis = 8;
   optional apollo.hdmap.RoutingResult routing = 9;
+  optional apollo.common.TrajectoryPoint init_point = 10;
 
-  optional apollo.localization.Pose init_status = 2;  // initial status of adc
   // processed planning_obstacles
   repeated PlanningObstacle planning_obstacle = 4;
 
   repeated PathDebug path = 6;
 
+  optional apollo.localization.Pose init_status = 2 [deprecated = true];  // initial status of adc
   optional apollo.planning.MainDecision main_decision = 3 [deprecated = true];
   optional LightSignal light_signal = 5 [deprecated = true];
 }

modules/tools/diagnostics/batch_include.py

@@ -19,7 +19,6 @@
 from modules.canbus.proto import chassis_detail_pb2
 from modules.canbus.proto import chassis_pb2
 from modules.common.monitor.proto import monitor_pb2
-from modules.common.configs.proto import config_extrinsics_pb2
 from modules.common.configs.proto import vehicle_config_pb2
 from modules.common.proto import geometry_pb2
 from modules.common.proto import header_pb2