Method for trajectory planning of an assistance system
View Patent ↗The disclosure relates to a method for trajectory planning of a driver assistance system, particularly an assistance system for longitudinal and/or transverse control, in which a trajectory having a total duration which can be set is determined and the trajectory is divided into segments, wherein each segment has a variable segment duration and the total of the segment durations corresponds to the set total duration of the trajectory.
1. A method for trajectory planning of an assistance system for longitudinal and/or transverse control of a vehicle, comprising:
determining a trajectory having a total duration which can be set; and
dividing the trajectory into segments, wherein each segment has a variable segment duration and a total of the segment durations corresponds to the total duration of the trajectory,
wherein dividing the trajectory into segments comprises dividing the trajectory into a first segment, followed by a second segment, followed by a third segment, and wherein a duration of the first segment is determined using a quadratic equation as a function of a duration of the third segment or vice versa.
2. The method as set forth in claim 1 wherein dividing the trajectory into segments comprises dividing the trajectory into segments as a function of at least one of acceleration or speed.
3. The method as set forth in claim 1 wherein dividing the trajectory into segments comprises dividing the trajectory into a segment for building the acceleration, a segment for at least one of holding or altering the acceleration, and a segment for reducing the acceleration.
4. The method as set forth in claim 3 wherein the segment for building the acceleration and the segment for reducing the acceleration are described by a polynomial having an order of at least three.
5. The method as set forth in claim 1 further comprising setting the duration of each segment based on a quality measure.
6. The method as set forth in claim 1 wherein dividing the trajectory into segments comprises dividing the trajectory into a first segment, followed by a second segment, followed by a third segment, and in response to the vehicle following another vehicle, the first and second segments substantially correspond to traveling on a clear section of road while the third segment is described by a fifth-order polynomial so that the trajectory is converted into a desired final condition for acceleration, speed, and path.
7. The method as set forth in claim 1 further comprising choosing a segment duration of one of the segments in such a way that a quality measure of the trajectory becomes minimal.
8. The method as set forth in claim 1 further comprising providing a subordinate optimization for selecting the segment duration of at least one of the segments.
9. The method as set forth in claim 1 wherein determining the trajectory comprises varying the total duration of the trajectory.
10. The method as set forth in claim 1 further comprising providing an adaptive search space having raster points for predefining trajectory target conditions, and determining the trajectory is based on a displacement of the raster points such that the raster points are displaced towards the trajectory to be determined.
11. The method as set forth in claim 10 wherein the raster points are adapted iteratively over multiple time steps.
12. The method as set forth in claim 1 further comprising providing a spring-damper system for generating target driving conditions of the vehicle for following another vehicle.
13. The method as set forth in claim 12 wherein the spring-damper system is arranged as a virtual bumper between the vehicle and another vehicle driving ahead in order to regulate a distance, and a clearance is settable between at least one of the vehicle and the another vehicle, the speed, or spring travel of the spring-damper system are utilized.
14. The method as set forth in claim 1 comprising providing at least one of an acceleration or a speed plateau for compensating for control deviations.
15. The method as set forth in claim 1 further comprising providing a trajectory planner for determining the trajectory, wherein the trajectory planner comprises multiple modules and/or levels.
16. The method as set forth in claim 15 wherein the trajectory planner comprises a coordination layer for situation-specific and function-specific adjustment of a target condition and a planning layer for determining a trajectory based on the target condition, the coordination layer and the planning layer each comprising software executable on a vehicle controller.
17. A trajectory planner for an assistance system for longitudinal and/or transverse control of a vehicle, comprising:
a coordination layer for predefining a target condition;
a planning layer for determining a trajectory based on the target condition; and
a trajectory selection module for selecting the respective trajectory, wherein
the coordination layer, planning layer and trajectory selection module comprising software executable by a vehicle controller, and
the trajectory planner is configured in such a way that the trajectory planning is performed by determining a trajectory having a total duration which can be set and dividing the trajectory into segments, wherein each segment has a variable segment duration and a total of the segment durations corresponds to the set total duration of the trajectory, and
wherein dividing the trajectory into segments comprises dividing the trajectory into a first segment, followed by a second segment, followed by a third segment, and wherein a duration of the first segment is determined using a quadratic equation as a function of a duration of the third segment or vice versa.
18. The trajectory planner as set forth in claim 17 , wherein the variable segment duration of each segment is changeable, but the total duration of the trajectory remains unchanged.
19. The method as set forth in claim 1 , wherein the variable segment duration of each segment is changeable, but the total duration of the trajectory remains unchanged.