apollo
apollo copied to clipboard
Planned parking trajectory does not satisfy the curvature constraint
Hello, I use Hybrid A* algorithm to search the trajectory from initial position to a parking slot and record the result in a csv file. I set up the min_turn_radius to 5.6 in vehicle_param.pb.txt. The curvature should be less than 1/5.6 to make self-ego satisfy the motion constraint. But the maximum kappa in csv file is around 0.3 which is too much larger than 1/5.6. Hybrid A* considers the min_turn_radius when searching the path, and the trajectory smoother(iterative_anchoring_smoother) also has curvature constraint.
I want to know the reason why the curvature of the trajectory doesn't satisfy the curvature constraint and how to slove this problem to make the curvature satisfy the motion constraint?