Skip to content

Commit 1956bb4

Browse files
chore(path_optimizer): add warn msg for exceptional behavior (autowarefoundation#9033)
Signed-off-by: Yuki Takagi <yuki.takagi@tier4.jp>
1 parent 169c736 commit 1956bb4

File tree

1 file changed

+6
-2
lines changed

1 file changed

+6
-2
lines changed

planning/autoware_path_optimizer/src/mpt_optimizer.cpp

+6-2
Original file line numberDiff line numberDiff line change
@@ -477,8 +477,13 @@ std::vector<TrajectoryPoint> MPTOptimizer::optimizeTrajectory(const PlannerData
477477

478478
const auto get_prev_optimized_traj_points = [&]() {
479479
if (prev_optimized_traj_points_ptr_) {
480+
RCLCPP_WARN(logger_, "return the previous optimized_trajectory as exceptional behavior.");
480481
return *prev_optimized_traj_points_ptr_;
481482
}
483+
RCLCPP_WARN(
484+
logger_,
485+
"Try to return the previous optimized_trajectory as exceptional behavior, "
486+
"but this failure also. Then return path_smoother output.");
482487
return traj_points;
483488
};
484489

@@ -505,8 +510,7 @@ std::vector<TrajectoryPoint> MPTOptimizer::optimizeTrajectory(const PlannerData
505510
// 6. optimize steer angles
506511
const auto optimized_variables = calcOptimizedSteerAngles(ref_points, obj_mat, const_mat);
507512
if (!optimized_variables) {
508-
RCLCPP_INFO_EXPRESSION(
509-
logger_, enable_debug_info_, "return std::nullopt since could not solve qp");
513+
RCLCPP_WARN(logger_, "return std::nullopt since could not solve qp");
510514
return get_prev_optimized_traj_points();
511515
}
512516

0 commit comments

Comments
 (0)