Why are the candidate trajectories processed like this?

The reason is that the recent blocks are filtered incorrectly, as shown in the figure below. The upper left image is the nearest block to the vehicle, the upper right image is the Bezier curve generated from the vehicle position to the nearest block, the lower left image is the filtered paths , and the lower right image is the final Scene visualization.

Why are the candidate trajectories processed like this?

The reason is that the recent blocks are filtered incorrectly, as shown in the figure below. The upper left image is the nearest block to the vehicle, the upper right image is the Bezier curve generated from the vehicle position to the nearest block, the lower left image is the filtered paths , and the lower right image is the final Scene visualization.
