File tree Expand file tree Collapse file tree 1 file changed +16
-1
lines changed
simulation/traffic_simulator/src/entity Expand file tree Collapse file tree 1 file changed +16
-1
lines changed Original file line number Diff line number Diff line change @@ -393,7 +393,22 @@ auto EgoEntity::requestReplanRoute(
393
393
-> void
394
394
{
395
395
clearRoute ();
396
- plan (route, allow_goal_modification);
396
+ /*
397
+ NOTE:
398
+ This function does not support use_lane_level_specification_for_waypoints option.
399
+ The developers should consider manual override simulation to determine whether support it or not.
400
+ */
401
+ {
402
+ concealer::FieldOperatorApplication::RouteOption route_option;
403
+ route_option.allow_goal_modification = allow_goal_modification;
404
+ assert (not route.empty ());
405
+ auto goal = route.back ().pose ;
406
+ std::vector<geometry_msgs::msg::Pose> waypoints;
407
+ for (size_t i = 0 ; i < route.size () - 1 ; ++i) {
408
+ waypoints.push_back (route[i].pose );
409
+ }
410
+ plan (goal, waypoints, route_option);
411
+ }
397
412
enableAutowareControl ();
398
413
FieldOperatorApplication::engage ();
399
414
}
You can’t perform that action at this time.
0 commit comments