fix(planning): del redundant add for cost (#15317)

ApolloAuto · Mar 1, 2024 · e373b20 · e373b20
1 parent 43922a0
commit e373b20
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/modules/planning/planning_base/open_space/coarse_trajectory_generator/reeds_shepp_path.cc b/modules/planning/planning_base/open_space/coarse_trajectory_generator/reeds_shepp_path.cc
@@ -121,10 +121,10 @@ bool ReedShepp::ShortestRSP(const std::shared_ptr<Node3d> start_node,
       }
 
       if (j > 0 && path.segs_lengths[j] * path.segs_lengths[j - 1] < 0) {
-        cost += cost + traj_gear_switch_penalty_;
+        cost += traj_gear_switch_penalty_;
       }
       if (j == 0 && start_dire * path.segs_lengths[j] < 0) {
-        cost += cost + traj_gear_switch_penalty_;
+        cost += traj_gear_switch_penalty_;
       }
     }
     if (cost < min_cost) {