@@ -77,15 +77,17 @@ class AvoidanceModule : public SceneModuleInterface
77
77
{
78
78
if (candidate.lateral_shift > 0.0 ) {
79
79
rtc_interface_ptr_map_.at (" left" )->updateCooperateStatus (
80
- uuid_map_.at (" left" ), isExecutionReady (), candidate.start_distance_to_path_change ,
81
- candidate.finish_distance_to_path_change , clock_->now ());
80
+ uuid_map_.at (" left" ), isExecutionReady (), State::WAITING_FOR_EXECUTION,
81
+ candidate.start_distance_to_path_change , candidate.finish_distance_to_path_change ,
82
+ clock_->now ());
82
83
candidate_uuid_ = uuid_map_.at (" left" );
83
84
return ;
84
85
}
85
86
if (candidate.lateral_shift < 0.0 ) {
86
87
rtc_interface_ptr_map_.at (" right" )->updateCooperateStatus (
87
- uuid_map_.at (" right" ), isExecutionReady (), candidate.start_distance_to_path_change ,
88
- candidate.finish_distance_to_path_change , clock_->now ());
88
+ uuid_map_.at (" right" ), isExecutionReady (), State::WAITING_FOR_EXECUTION,
89
+ candidate.start_distance_to_path_change , candidate.finish_distance_to_path_change ,
90
+ clock_->now ());
89
91
candidate_uuid_ = uuid_map_.at (" right" );
90
92
return ;
91
93
}
@@ -108,7 +110,7 @@ class AvoidanceModule : public SceneModuleInterface
108
110
motion_utils::calcSignedArcLength (path.points , ego_idx, left_shift.start_pose .position );
109
111
const double finish_distance = start_distance + left_shift.relative_longitudinal ;
110
112
rtc_interface_ptr_map_.at (" left" )->updateCooperateStatus (
111
- left_shift.uuid , true , start_distance, finish_distance, clock_->now ());
113
+ left_shift.uuid , true , State::RUNNING, start_distance, finish_distance, clock_->now ());
112
114
if (finish_distance > -1.0e-03 ) {
113
115
steering_factor_interface_ptr_->updateSteeringFactor (
114
116
{left_shift.start_pose , left_shift.finish_pose }, {start_distance, finish_distance},
@@ -121,7 +123,7 @@ class AvoidanceModule : public SceneModuleInterface
121
123
motion_utils::calcSignedArcLength (path.points , ego_idx, right_shift.start_pose .position );
122
124
const double finish_distance = start_distance + right_shift.relative_longitudinal ;
123
125
rtc_interface_ptr_map_.at (" right" )->updateCooperateStatus (
124
- right_shift.uuid , true , start_distance, finish_distance, clock_->now ());
126
+ right_shift.uuid , true , State::RUNNING, start_distance, finish_distance, clock_->now ());
125
127
if (finish_distance > -1.0e-03 ) {
126
128
steering_factor_interface_ptr_->updateSteeringFactor (
127
129
{right_shift.start_pose , right_shift.finish_pose }, {start_distance, finish_distance},
0 commit comments