Path planning for autonomous parking
A method is provided for determining a vehicle path for autonomously parallel parking a vehicle in a space between a first object and a second object. A distance is remotely sensed between the first object and the second object. A determination is made whether the distance is sufficient to parallel park the vehicle between. A first position to initiate a parallel parking maneuver is determined. A second position within the available parking space corresponding to an end position of the vehicle path is determined. A first arc shaped trajectory of travel is determined between the first position and an intermediate position, and a second arc shaped trajectory of travel is determined between the second position and the intermediate position. The first arc shaped trajectory is complementary to the second arc shaped trajectory for forming a clothoid which provides a smoothed rearward steering maneuver between the first position to the second position.
1. A method of determining a vehicle path for autonomously parallel parking a vehicle in a space between a first object and a second object in response to an available parking distance between the first object and second object, the method comprising the steps of:
remotely sensing a distance between the first object and the second object;
determining whether the distance is sufficient to parallel park the vehicle between the first object and the second object based on a threshold;
determining a first position to initiate a parallel parking maneuver;
determining a second position within the available parking space corresponding to an end position of the vehicle path;
determining a first arc shaped trajectory of travel between the first position and an intermediate position, and a second arc shaped trajectory of travel between the second position and the intermediate position, wherein the first arc shaped trajectory is complementary to the second arc shaped trajectory for forming a clothoid which provides a smoothed rearward steering maneuver between the first position to the second position; and
controlling a steering actuator to follow the determined vehicle path;
wherein the first arc shaped trajectory includes a first segment based on a circle arc having a first center point, and wherein the second arc shaped trajectory includes a first segment based on a circle arc having a second center point, wherein the first arc shaped trajectory further includes a second segment extending from the first segment of the first arc shaped trajectory to the intermediate position, wherein the second arc shaped trajectory further includes a second segment extending from the first segment of the second arc shaped trajectory to the intermediate position, and wherein the second segment of the first arc shaped trajectory and the second segment of the second arc shaped trajectory are clothoids.
2. The method of claim 1 wherein the first arc shaped trajectory further includes an initial segment extending from the first position to the first segment of the first arc shaped trajectory, the initial segment forming a clothoid.
3. The method of claim 1 wherein the second arc shaped trajectory further includes an ending segment extending from the second position to the first segment of the second arc shaped trajectory, the ending segment forming a clothoid.
4. The method of claim 1 wherein the second position is a final parking position within the parking space.
5. The method of claim 1 wherein the second position is an interim stopping position, wherein the vehicle transitions from a rearward steering maneuver to a forward steering maneuver at the interim stopping position, the forward steering maneuver uses a steering wheel angle of substantially zero to park the vehicle at a final parking position.
6. The method of claim 1 wherein the second position is an interim stopping position for completing a first cycle of a two cycle parallel parking maneuver, the method further comprising the step of performing a forward steering maneuver having a steering wheel angle not equal to zero for parking the vehicle at a final parking position.
7. The method of claim 6 wherein the rearward steering maneuver includes a plurality of steering cycles in a clockwise direction and a plurality of steering cycles in a counterclockwise direction.
8. The method of claim 1 wherein the steering wheel angle at the first position is initially equal to zero.
9. The method of claim 1 wherein the steering wheel angle at the intermediate position is equal to zero.
10. The method of claim 1 wherein the vehicle at the intermediate position is determined when a right front corner of the vehicle is at a minimal distance from a left rear corner of the second object.
11. The method of claim 6 wherein the forward steering maneuver of the two cycle parallel parking maneuver further includes determining a third arc shaped trajectory of travel between the second position and the final parking position.
12. The method of claim 6 wherein the forward steering maneuver is based on a constant steer angle resulting in a path of curvature having a constant radius between the second position and final parking position.
13. The method of claim 6 wherein the final parking position of the vehicle is between the first object and the second object.
14. An autonomous parking system for parallel parking a vehicle between a first object and a second object, the system comprising:
a sensing device for detecting objects proximate to the driven vehicle, the sensing device providing signals configured for determining a space between the first object and the second object; and
a controller receiving the signals identifying the space between the first object and the second object, the controller autonomously controlling steering of the vehicle for parallel parking the driven vehicle;
wherein the controller determines a first arc shaped trajectory of travel between a first position and an intermediate position, the first arc shaped trajectory cooperatively formed from at least one clothoid and an arc circle, and wherein the controller determines a second arc shaped trajectory of travel between a second position and the intermediate position, the second arc shaped trajectory is cooperatively formed from at least one clothoid and an arc circle, wherein a clothoid of the first arc shaped trajectory cooperatively joins a clothoid of the second arc shaped trajectory at the intermediate position, wherein the first arc shaped trajectory is complementary to the second arc shaped trajectory at the intermediate position for forming a smoothed transition rearward steering maneuver from the first position to the second position, and wherein the controller utilizes the smoothed transition rearward steering maneuver for autonomously parallel parking the vehicle driven vehicle.
15. The autonomous parking system of claim 14 wherein the sensing device includes an ultrasonic-based sensing device.
16. The autonomous parking system of claim 14 wherein the sensing device includes a radar-based sensing device.
17. The autonomous parking system of claim 14 wherein the sensing device includes an image based sensing device.
18. The autonomous parking system of claim 14 further comprising an electric power steering device for autonomously generating steering torque to the steerable drivers.