Backward trajectory is generated when the ego vehicle invades a drivable area

[Kim-mins]

Checklist

• I've read the contribution guidelines.
• I've searched other issues and no duplicate issues were found.
• I'm convinced that this is not my fault but a bug.

Description

Hi team,

I'm currently running Autoware with Carla, and I found a situation that a backward trajectory is generated when the ego vehicle invades a drivable area.

Here's the video of the situation: [rviz]
In the video, the ego vehicle initially stepping a drivable area, and the generated trajectory is for driving backward.
At 0:29, the NPC vehicle drives to behind the ego and the ego starts to turn left (I cannot sure the NPC has an impact on this issue), which makes the ego vehicle invades the center line.

I tried to reproduce the situation with the planning simulation, and I think the issue occurs when the ego vehicle invades the drivable area at the initial point.
Here's the video for more details: [planning simulation]
The video shows two cases:

1. (The ego does not invade the drivable area) At 0:06, the ego vehicle is initialized and drives to the destination well.
2. (The ego invades the drivable area): However, At 0:29, Autoware generates backward trajectory, and the ego vehicle reaches the destination only after following the trajectory.

Actually, I cannot point out the reason why the ego vehicle drives forward in the first video, even though backward trajectory is generated. (I don't know why the gear does not changed)
But I thought that the situation in the planning simulation is similar to that of the first video.

Here are more details of the situation:

• Starting/Goal pose (from launch.log file)

initial pose - x: 0.726764, y: 190.627121, z: 0.068133
initial orientation - qx: -0.000201, qy: 0.000178, qz: -0.715753, qw: 0.698354
goal pose - x: 209.993347, y: -9.808371, z: 0.275307
goal orientation - qx: 0.000000, qy: 0.000000, qz: -0.007468, qw: 0.999972

• Map: Town03
• ros2bag file: [ros2bag]
• launch.log file: [launch.log]

Expected behavior

I hope the ego vehicle drives following the center of the lane.

Actual behavior

However, the ego vehicle invades the center line.

Steps to reproduce

1. Pull image from https://github.com/autowarefoundation/autoware/pkgs/container/autoware/334254906?tag=universe-devel-cuda-0.40.0-amd64, and run Autoware.
2. Run ros2bag file above.

In the planning simulation, I could utilize the initial/goal pose above.

Versions

• OS: Ubuntu 22.04 (Docker), Ubuntu 20.04 (host)
• Autoware: 0.40.0
• Carla: 0.9.15
• autoware_carla_interface: link

Possible causes

No response

Additional context

No response