Parking assistance device and parking assistance method
In a parking assistance device, a target parking position calculation unit calculates a target parking position of a subject vehicle based on a position of a corner point of a parking space. A constraint condition setting unit sets a constraint condition regarding a target parking route for guiding the subject vehicle to the target parking position based on a position and a posture angle of the subject vehicle, peripheral information of the subject vehicle, and the position of the corner point of the parking space. The constraint condition includes a condition that a curvature change rate of the target parking route is continuous. A target parking route calculation unit calculates the target parking route based on the position and the posture angle of the subject vehicle, the position of the corner point of the parking space, the target parking position, and the constraint condition.
1. A parking assistance device comprising:
a processor to execute a program; and
a memory to store the program which, when executed by the processor, performs processes of:
calculating a position and a posture angle of a vehicle;
acquiring peripheral information of the vehicle;
detecting a parking space based on the peripheral information of the vehicle;
calculating a target parking position of the vehicle based on a position of a corner point of the parking space;
setting a constraint condition regarding a target parking route for guiding the vehicle to the target parking position based on a position and a posture angle of the vehicle, the peripheral information, and the position of the corner point of the parking space;
calculating the target parking route based on the position and the posture angle of the vehicle, the position of the corner point of the parking space, the target parking position, and the constraint condition; and
parking the vehicle at the target parking position by making the vehicle travel following the target parking route, wherein
the processor sets a condition that a curvature change rate of the target parking route is continuous as the constraint condition.
2. The parking assistance device according to claim 1 , wherein
the processor divides a route from the position of the vehicle to the target parking position into a plurality of sections based on the position and posture angle of the vehicle, the position of the corner point of the parking space, and the target parking position, and represents each of the plurality of sections as a fourth or higher degree polynomial,
the processor determines a polynomial of each section of the target parking route by finding a solution in which the polynomial representing the plurality of sections satisfies the constraint condition, and
the processor calculates a curvature of each point on the target parking route based on the polynomial of each section of the target parking route.
3. The parking assistance device according to claim 2 , wherein
the processor determines the polynomial of each section of the target parking route by finding a solution in which the polynomial representing the plurality of sections satisfies the constraint condition, and the target parking route is as short as possible.
4. The parking assistance device according to claim 3 , wherein
the processor further sets a movable range of the vehicle as the constraint condition.
5. The parking assistance device according to claim 4 , wherein
the processor further sets an upper limit value of the curvature or the curvature change rate of the target parking route as the constraint condition.
6. The parking assistance device according to claim 3 , wherein
the processor further sets an upper limit value of the curvature or the curvature change rate of the target parking route as the constraint condition.
7. The parking assistance device according to claim 2 , wherein
when the processor does not find a solution in which the polynomial representing the plurality of sections satisfies the constraint condition, parking assistance of the vehicle ends.
8. The parking assistance device according to claim 7 , wherein
the processor further sets a movable range of the vehicle as the constraint condition.
9. The parking assistance device according to claim 8 , wherein
the processor further sets an upper limit value of the curvature or the curvature change rate of the target parking route as the constraint condition.
10. The parking assistance device according to claim 7 , wherein
the processor further sets an upper limit value of the curvature or the curvature change rate of the target parking route as the constraint condition.
11. The parking assistance device according to claim 2 , wherein
the processor further sets a movable range of the vehicle as the constraint condition.
12. The parking assistance device according to claim 11 , wherein
the processor further sets an upper limit value of the curvature or the curvature change rate of the target parking route as the constraint condition.
13. The parking assistance device according to claim 2 , wherein
the processor further sets an upper limit value of the curvature or the curvature change rate of the target parking route as the constraint condition.
14. The parking assistance device according to claim 1 , wherein
the processor further sets a movable range of the vehicle as the constraint condition.
15. The parking assistance device according to claim 14 , wherein
the processor further sets an upper limit value of the curvature or the curvature change rate of the target parking route as the constraint condition.
16. The parking assistance device according to claim 1 , wherein
the processor further sets an upper limit value of the curvature or the curvature change rate of the target parking route as the constraint condition.
17. A parking assistance method comprising:
calculating a position and a posture angle of a vehicle;
acquiring peripheral information of the vehicle;
detecting a parking space based on the peripheral information of the vehicle;
calculating a target parking position of the vehicle based on a position of a corner point of the parking space;
setting a constraint condition regarding a target parking route for guiding the vehicle to the target parking position based on a position and a posture angle of the vehicle, the peripheral information, and the position of the corner point of the parking space;
calculating the target parking route based on the position and the posture angle of the vehicle, the position of the corner point of the parking space, the target parking position, and the constraint condition; and
parking the vehicle at the target parking position by making the vehicle travel following the target parking route, wherein
a condition that a curvature change rate of the target parking route is continuous as the constraint condition is set.