CPC B60W 30/06 (2013.01) [B60W 60/0011 (2020.02); G05D 1/0274 (2013.01); G06V 20/58 (2022.01); G06V 20/586 (2022.01); G08G 1/141 (2013.01)] | 21 Claims |
1. A computer-implemented method for operating an autonomous driving vehicle (ADV), the method comprising:
in response to a request to park the ADV in a parking lot, obtaining a set of parking-trajectories associated with a set of predetermined locations in proximity to one or more parking spots within the parking lot based on a predetermined threshold distance to the one or more parking spots, wherein, for each parking spot of the one or more parking spots, one or more of the set of predetermined locations in proximity to a parking spot are determined based on the predetermined threshold distance to the parking spot and a resolution of a grid of a digital map, wherein the set of parking-trajectories was previously generated based on prior planning and control data of the parking lot by using a hybrid A* search algorithm, each of the parking-trajectories corresponding to one of the one or more parking spots within the parking lot;
comparing a current location of the ADV with the set of predetermined locations associated with the set of parking-trajectories corresponding to the one or more parking spots within the parking lot;
determining that the current location of the ADV does not include one of the set of predetermined locations associated with the set of parking-trajectories corresponding to the one or more parking spots;
generating a trajectory from the current location to a predetermined location of the set of predetermined locations nearest to the current location without using a previously generated parking-trajectory of the set of previously generated parking-trajectories;
selecting a previously generated parking-trajectory from the set of previously generated parking-trajectories based on the predetermined location nearest to the current location of the ADV; and
controlling the ADV to drive from the current location to the predetermined location nearest to the current location according to the generated trajectory and park in a corresponding parking spot according to the selected previously generated parking-trajectory.
|