Skip to content

Commit b3a5fda

Browse files
clean up
Signed-off-by: Yuki Takagi <yuki.takagi@tier4.jp>
1 parent c56db76 commit b3a5fda

File tree

2 files changed

+12
-12
lines changed
  • planning/behavior_path_dynamic_avoidance_module

2 files changed

+12
-12
lines changed

planning/behavior_path_dynamic_avoidance_module/include/behavior_path_dynamic_avoidance_module/scene.hpp

+1-1
Original file line numberDiff line numberDiff line change
@@ -354,7 +354,7 @@ class DynamicAvoidanceModule : public SceneModuleInterface
354354

355355
bool canTransitFailureState() override { return false; }
356356

357-
ObjectBehaviorType isLabelTargetObstacle(const uint8_t label) const;
357+
ObjectBehaviorType getLabelAsTargetObstacle(const uint8_t label) const;
358358
void registerLaneDriveObjects(const std::vector<DynamicAvoidanceObject> & prev_objects);
359359
void registerFreeRunObjects(const std::vector<DynamicAvoidanceObject> & prev_objects);
360360
void determineWheterToAvoidAgainstLaneDriveObjects(

planning/behavior_path_dynamic_avoidance_module/src/scene.cpp

+11-11
Original file line numberDiff line numberDiff line change
@@ -425,7 +425,7 @@ BehaviorModuleOutput DynamicAvoidanceModule::planWaitingApproval()
425425
return out;
426426
}
427427

428-
ObjectBehaviorType DynamicAvoidanceModule::isLabelTargetObstacle(const uint8_t label) const
428+
ObjectBehaviorType DynamicAvoidanceModule::getLabelAsTargetObstacle(const uint8_t label) const
429429
{
430430
using autoware_auto_perception_msgs::msg::ObjectClassification;
431431

@@ -480,7 +480,7 @@ void DynamicAvoidanceModule::registerLaneDriveObjects(
480480

481481
// 1.a. check label
482482
if (
483-
isLabelTargetObstacle(predicted_object.classification.front().label) !=
483+
getLabelAsTargetObstacle(predicted_object.classification.front().label) !=
484484
ObjectBehaviorType::LaneDriveObject) {
485485
continue;
486486
}
@@ -571,7 +571,7 @@ void DynamicAvoidanceModule::registerFreeRunObjects(
571571

572572
// 1.a. check label
573573
if (
574-
isLabelTargetObstacle(predicted_object.classification.front().label) !=
574+
getLabelAsTargetObstacle(predicted_object.classification.front().label) !=
575575
ObjectBehaviorType::FreeRunObject) {
576576
continue;
577577
}
@@ -591,8 +591,8 @@ void DynamicAvoidanceModule::registerFreeRunObjects(
591591
RCLCPP_INFO_EXPRESSION(
592592
getLogger(), parameters_->enable_debug_info,
593593
"[DynamicAvoidance] Ignore obstacle (%s) since it crosses the ego's path with its normal "
594-
"vel (%s) m/s.",
595-
obj_uuid.c_str(), std::to_string(obj_normal_vel).c_str());
594+
"vel (%5.2f) m/s.",
595+
obj_uuid.c_str(), obj_normal_vel);
596596
continue;
597597
}
598598

@@ -608,8 +608,8 @@ void DynamicAvoidanceModule::registerFreeRunObjects(
608608
if (space_between_obj_and_ego > parameters_->max_obj_lat_offset_to_ego_path) {
609609
RCLCPP_INFO_EXPRESSION(
610610
getLogger(), parameters_->enable_debug_info,
611-
"[DynamicAvoidance] Ignore obstacle (%s) since lateral offset (%s) is large.",
612-
obj_uuid.c_str(), std::to_string(estimated_dist_obj_center_to_path).c_str());
611+
"[DynamicAvoidance] Ignore obstacle (%s) since lateral offset (%7.3f) is large.",
612+
obj_uuid.c_str(), estimated_dist_obj_center_to_path);
613613
continue;
614614
}
615615

@@ -646,7 +646,7 @@ void DynamicAvoidanceModule::determineWheterToAvoidAgainstLaneDriveObjects(
646646
const auto & input_path = getPreviousModuleOutput().path;
647647

648648
for (const auto & object : target_objects_manager_.getValidObjects()) {
649-
if (isLabelTargetObstacle(object.label) != ObjectBehaviorType::LaneDriveObject) {
649+
if (getLabelAsTargetObstacle(object.label) != ObjectBehaviorType::LaneDriveObject) {
650650
continue;
651651
}
652652

@@ -805,7 +805,7 @@ void DynamicAvoidanceModule::determineWheterToAvoidAgainstFreeRunObjects(
805805
const auto & input_path = getPreviousModuleOutput().path;
806806

807807
for (const auto & object : target_objects_manager_.getValidObjects()) {
808-
if (isLabelTargetObstacle(object.label) != ObjectBehaviorType::FreeRunObject) {
808+
if (getLabelAsTargetObstacle(object.label) != ObjectBehaviorType::FreeRunObject) {
809809
continue;
810810
}
811811

@@ -1075,10 +1075,10 @@ bool DynamicAvoidanceModule::isObjectFarFromPath(
10751075
const PredictedObject & predicted_object, const double obj_dist_to_path) const
10761076
{
10771077
const double obj_max_length = calcObstacleMaxLength(predicted_object.shape);
1078-
const double space_between_obj_and_ego = std::max(
1078+
const double min_obj_dist_to_path = std::max(
10791079
0.0, obj_dist_to_path - planner_data_->parameters.vehicle_width / 2.0 - obj_max_length);
10801080

1081-
return parameters_->max_obj_lat_offset_to_ego_path < space_between_obj_and_ego;
1081+
return parameters_->max_obj_lat_offset_to_ego_path < min_obj_dist_to_path;
10821082
}
10831083

10841084
bool DynamicAvoidanceModule::willObjectCutIn(

0 commit comments

Comments
 (0)