SEGMENTING A PARKING TRAJECTORY TO CONTROL AN AUTONOMOUS DRIVING VEHICLE TO PARK

In one embodiment, a computer-implemented method of autonomously parking an autonomous driving vehicle, includes generating environment descriptor data describing a driving environment surrounding the autonomous driving vehicle (ADV), including identifying a parking space and one or more obstacles within a predetermined proximity of the ADV, generating a parking trajectory of the ADV based on the environment descriptor data to autonomously park the ADV into the parking space, including optimizing the parking trajectory in view of the one or more obstacles, segmenting the parking trajectory into one or more trajectory segments based on a vehicle state of the ADV, and controlling the ADV according to the one or more trajectory segments of the parking trajectory to autonomously park the ADV into the parking space without collision with the one or more obstacles.