EP3924797A1 - Procédé de planification de trajectoire d'un système d'assistance - Google Patents

Procédé de planification de trajectoire d'un système d'assistance

Info

Publication number
EP3924797A1
EP3924797A1 EP20707559.9A EP20707559A EP3924797A1 EP 3924797 A1 EP3924797 A1 EP 3924797A1 EP 20707559 A EP20707559 A EP 20707559A EP 3924797 A1 EP3924797 A1 EP 3924797A1
Authority
EP
European Patent Office
Prior art keywords
trajectory
segment
planning
target
acceleration
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
EP20707559.9A
Other languages
German (de)
English (en)
Inventor
Fabian Becker
Radoy STANCHEV
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Continental Autonomous Mobility Germany GmbH
Original Assignee
Conti Temic Microelectronic GmbH
Continental Automotive GmbH
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Conti Temic Microelectronic GmbH, Continental Automotive GmbH filed Critical Conti Temic Microelectronic GmbH
Publication of EP3924797A1 publication Critical patent/EP3924797A1/fr
Pending legal-status Critical Current

Links

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/14—Adaptive cruise control
    • B60W30/143—Speed control
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/14—Adaptive cruise control
    • B60W30/16—Control of distance between vehicles, e.g. keeping a distance to preceding vehicle
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/14—Adaptive cruise control
    • B60W30/16—Control of distance between vehicles, e.g. keeping a distance to preceding vehicle
    • B60W30/165—Automatically following the path of a preceding lead vehicle, e.g. "electronic tow-bar"
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/14—Adaptive cruise control
    • B60W30/16—Control of distance between vehicles, e.g. keeping a distance to preceding vehicle
    • B60W30/17—Control of distance between vehicles, e.g. keeping a distance to preceding vehicle with provision for special action when the preceding vehicle comes to a halt, e.g. stop and go
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W50/06—Improving the dynamic response of the control system, e.g. improving the speed of regulation or avoiding hunting or overshoot
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2554/00—Input parameters relating to objects
    • B60W2554/80—Spatial relation or speed relative to objects
    • B60W2554/802—Longitudinal distance
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2554/00—Input parameters relating to objects
    • B60W2554/80—Spatial relation or speed relative to objects
    • B60W2554/804—Relative longitudinal speed
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2720/00—Output or target parameters relating to overall vehicle dynamics
    • B60W2720/10—Longitudinal speed
    • B60W2720/103—Speed profile
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2720/00—Output or target parameters relating to overall vehicle dynamics
    • B60W2720/10—Longitudinal speed
    • B60W2720/106—Longitudinal acceleration

Definitions

  • the present invention relates to a method for trajectory planning of an assistance system for a means of transport or a vehicle, in particular a driver assistance system for longitudinal and / or lateral control, as well as a trajectory planner for carrying out the method according to the invention and an assistance system or driver assistance system in which the trajectory planning takes place by means of the method according to the invention.
  • Modern means of transport such as B. vehicles, bicycles, motorcycles, planes, Droh NEN, watercraft, boats and the like, are increasingly equipped with assistance systems or driver assistance systems.
  • the recognition of road users or other vehicles, pedestrians and the like as well as the detection or assessment of lane markings are elementary functions in modern driver assistance systems and are z.
  • ACC adaptive cruise control
  • ADR automatic distance control
  • LKA lane keeping assistant
  • EBA emergency braking assistant
  • the trajectory to be driven or the movement path of the respective means of locomotion or vehicle can thereby be determined.
  • static targets or objects can be detected, whereby z. B. the distance to a vehicle ahead or the course of the road can be estimated.
  • z. B. radar, lidar or camera sensors can be used.
  • jerk and acceleration are disregarded and the The end time and the final state of the trajectory are assumed to be known.
  • Third to seventh order polynomials result as solutions for the trajectories.
  • the search area spanned by the end time and the final speed or end position is rasterized and a trajectory is calculated for each raster point.
  • a quality measure is calculated for each trajectory.
  • the quality measure is a criterion for evaluating the trajectories, with z. B. the course of the acceleration can be evaluated.
  • the trajectories are checked for violations of the restrictions and, if necessary, excluded from the set of valid trajectories.
  • the trajectory with the lowest quality measure from the remaining trajectories is then the result of the optimization.
  • RATHGEBER Due to the description of a trajectory by a single polynomial, as with WERLING, the acceleration limits can only be reached selectively.
  • RATHGEBER therefore proposes three-part trajectories: building, holding and reducing the acceleration, each with a polynomial.
  • the trajectories for building up and reducing the acceleration have a fixed predetermined duration, which can result in situation-related disadvantages in practice.
  • z. B. for the polynomial-based trajectory planning specific functional extensions of a generic assistance system (z. B. ACC) are not taken into account.
  • DE 10 2017 200 580 A1 describes a method for optimizing maneuver planning for a vehicle.
  • the method comprises a planning level which is divided into at least three different abstraction levels for all planning layers of the planning level.
  • a combination of continuous planning and semantic information takes place by grouping several identified maneuver options.
  • the success of each maneuver option is assessed, taking into account uncertainties in the behavior of other road users, in order to select the best strategy for carrying out the maneuver. task
  • the present invention is based on the object of providing an improved method for trajek- torien planning of an assistance system and an improved assistance system, in which the disadvantages of the prior art are overcome.
  • At least one trajectory with a definable total duration is initially determined , which is divided into segments, preferably three segments.
  • Each of the segments has a variable segment duration, the sum of the respective segment durations corresponding to the previously determined total duration of the trajectory, i.e. H. while the individual segment durations are designed to be variable or changeable, the total duration or total length of the trajectory remains unchanged.
  • An expansion of the basic functionality of the respective assistance system can also be made possible in a simple manner, e.g. B.
  • a first segment can be provided to build up the acceleration, a second segment to maintain the acceleration and a third segment to reduce the acceleration.
  • these segments can also be divided into further sub-segments and / or have segments before, after and / or in between.
  • the segments for building up and reducing the acceleration should not have a fixed segment duration, so that they can be easily adapted to the respective situation. This improves the flexibility and usability of the entire system to a particular degree.
  • the accelerations in the building up and in the declining segment of the trajectory are each described by a third order polynomial for speed control. This has the advantage that such a description or calculation can be implemented particularly easily.
  • this quality measure can be selected so that it corresponds to the integral component of the quality measure for evaluating a one-part trajectory, which enables, among other things, the direct replacement of a one-part trajectory with a three-part trajectory.
  • segment duration of the first segment can be determined as a function of the segment duration of the third segment or vice versa; H. the segment duration of the first segment can e.g. B. be determined via a quadratic equation depending on the segment duration of the third segment.
  • a three-part trajectory can be calculated for distance control, in which the first and second segments correspond to the segments of the speed control, while the third segment is described by a polynomial of a different order, in particular a fifth order, so that the trajectory transforms the system into the desired Final state (acceleration, speed and position) transferred.
  • the segment duration of one or more of the segments is preferably selected in such a way that the quality measure of the three-part trajectory is minimal or reduced.
  • the trajectory can expediently be planned by varying the total duration of the respective trajectory.
  • an adaptive search space with grid points for determining a trajectory can be provided, the target states of the trajectories in the search space being selected on the basis of a shift of the grid points.
  • the grid points are shifted towards the optimal trajectory, ie that a concentration of the grid points indicates the optimal trajectory.
  • the adjustment of the grid points is preferably carried out iteratively over several time steps, ie the target points can be varied or adapted using an iterative (over several time steps) procedure.
  • a spring-damper system or a mass-spring-damper system can be provided, which is used to generate steady and consistent target states (distance, speed and acceleration) of the means of locomotion, which are the target points of the trajectory and / or represent braking motion planning.
  • a spring-damper system can be arranged as a virtual bumper between the means of locomotion and a means of locomotion moving ahead, in addition to trajectory planning, depending on the situation (e.g. in the area close to a standstill).
  • the dynamics of the virtual bumper can be defined by the definable distance between the means of transport (e.g. host vehicle and vehicle in front), the speed, the acceleration, the mass of the means of transport and / or the (virtual) spring path.
  • At least one acceleration and / or speed plateau can be provided as a buffer for system deviations that occur.
  • an acceleration plateau can be provided before the means of locomotion comes to a standstill, which specifies the possible target state range for the trajectory planning. Starting from the plateau, the means of locomotion can be defined (or controlled) and brought to a standstill in order to bring about gentle acceleration processes that are familiar to the driver when stopping (e.g. slow braking). This allows z. B. abrupt and unwanted braking maneuvers can be avoided.
  • a trajectory planner can expediently be provided for determining the trajectory.
  • a trajectory planner can be designed as a hardware or software module, so that the respective system can easily be pre-assembled at the factory.
  • the trajectory planner comprises several modules and / or levels. These can e.g. B. permanently configured or modularly interchangeable and / or addable so that the respective functions of the individual modules and levels can be selected user-specific or function-specific.
  • the range of functions and the preconfigurability of the respective trajectory planner are thereby simplified to a particular degree, whereby costs and time can be saved to a particular degree.
  • the trajectory planner can include a coordination level for the situation and function-specific specification of a target state and a planning level for determining a trajectory based on the target state.
  • the coordination level and / or the planning level can also have a modular structure.
  • the coordination level can include a speed module for setting the speed and a distance assistance module for setting the distance or the route or route.
  • z. B. also include the speed module further modules for functional design or functional architecture, such. B. a cruise control module, a speed limit assistance module and / or a cornering assistance module.
  • the planning level can also have a modular structure and include individual modules, such as B. a speed planner and / or a distance planner.
  • a trajectory selection module for selecting the respective trajectory can also be provided, which can be provided as a module of one of the levels or as a separate level.
  • the entire coordination level or the distance module can also comprise further modules or subordinate modules.
  • the modules listed here represent only a non-exhaustive selection of possible modules.
  • other (sub) modules that are not mentioned are also expressly included, which z. B. include further functions known from the prior art for trajectory planning. This has the advantage that intuitive and simple parameterization or application is made possible. In addition, the scalability in terms of computing power of the respective system and the scope of functions is improved to a particular degree. With such a modular structure, it is z. B.
  • the method can be implemented as an algorithm in a practical and simple manner. This has the advantage that it can be implemented in new systems particularly easily and cost-effectively. In addition, existing systems can be retrofitted in the same way.
  • the invention also claims a trajectory planner for a corresponding assistance system or driver assistance system, which is designed in particular such that the trajectory planning takes place by means of the method according to the invention.
  • There is one Coordination level for setting a target state, a planning level for determining a trajectory based on the target state and a trajectory selection module for selecting the respective trajectory are provided.
  • the present invention claims an assistance system or driver assistance system for a means of transportation, in particular an assistance system for longitudinal and / or vertical control (e.g. ACC, LKA or EBA system), which is characterized, among other things, by that the assistance system carries out a trajectory planning by means of the method according to the invention and / or comprises a trajectory planner according to the invention.
  • an assistance system for longitudinal and / or vertical control e.g. ACC, LKA or EBA system
  • FIG. 1 shows a simplified schematic representation of an embodiment of a structure of a trajectory planner according to the invention
  • FIG. 2 shows a simplified representation of trajectories for a free travel according to the prior art
  • FIG. 3 shows a simplified representation of a trajectory (dotted) within the meaning of the invention for the one-part trajectory from FIG. 2;
  • 5 shows a further simplified representation of a trajectory planned according to the invention for distance control
  • 6 shows a simplified representation of a target state specification in the following travel
  • FIG. 7 shows a simplified representation of a mass-spring-damper system for generating target states on a vehicle, as well as
  • Fig. 8 is a simplified representation of a virtual bumper between an ego vehicle and a vehicle driving ahead.
  • a trajectory transfers the system state from its initial value to a defined final value.
  • the system status is described by the position s, the speed v, the acceleration a and, depending on the system model, the jerk r.
  • the vehicle is modeled using a point mass.
  • an integrator chain in particular a multi-level chain, serves as the system model.
  • the trajectory calculation represents an optimization problem that can be solved analytically according to the prior art.
  • such solutions usually describe the system states using polynomials, which have the disadvantage that they only reach the maximum values of jerk and acceleration at certain points and cannot be kept constant in sections.
  • the trajectory planner comprises a coordination level 1 (or coordination layer) and a planning level 2 (or planning layer). While planning level 2 universally optimizes and calculates trajectories for transferring the vehicle from its current actual state to a desired target state, coordination level 1 provides an interface for the situation and function-specific setting of the target state, the optimization criteria and limitations of the trajectory planning .
  • planning level 2 consists of a planner for speed trajectories (speed planner 9) and one or more (multi-object ACC) planners for distance trajectories (distance or route planner 10).
  • a so-called free journey refers to a journey by a vehicle when its own lane is clear or no vehicle driving ahead is identified as a relevant target object and can be driven unhindered at a target speed set by the driver. However, if z. If, for example, an assistance system detects a vehicle driving ahead, which prevents it from driving clear, the speed can be regulated accordingly and adapted to the speed of the vehicle driving ahead.
  • a trajectory selection module 3 connects the different planners to the change between the trajectories of the free travel and the following travel.
  • the trajectory selection can be based on the current trajectory acceleration. Alternatively, the selection of the trajectories can also be carried out using the complete trajectories.
  • the coordination level 1 is preferably of modular design and contains an independent module or several independent modules for each delimitable functionality of the system, such as B. a speed module 4 and a distance assistance module 5.
  • Each module offers an intuitive interface for the application of the respective functionality. To do this, the respective module translates and reduces the large number of optimization parameters of the controlled trajectory planner (weightings in the quality measure, status restrictions, search area limits) to a few parameters for the targeted parameterization of the respective functionality. More complex algorithms that control the behavior in complete scenarios are also conceivable here.
  • the modules can also have a modular structure and include subordinate functions or modules. As shown by way of example in FIG. 1, the speed module 4 comprises at least three further (subordinate) modules: a speed control module 6, a speed limit assistance module 7 and a curve assistance module 8.
  • the individual modules thus offer an intuitive interface for the situation-specific application of the subordinate planners and thus the resulting trajectories or the desired trajectories.
  • the multitude of optimization parameters of the trajectory planning e.g. weightings in the quality measure, status restrictions, selection of the search area
  • the function modules of coordination level 1 initially relate the application task to a few easy-to-use parameters for the targeted setting of the desired Translate and reduce trajectory behavior.
  • the coordination level 1 offers the possibility of arbitrating between different functionalities in advance or the coordination level 1 can take over the arbitration between different functionalities.
  • the requirements and target states of functions for speed control without a target object e.g. based on driver specifications, predictive traffic sign recognition or predictive Curve detection
  • an EBA request can always override an ACC request; H. that, from a safety-critical point of view, the respective functions can be prioritized.
  • distance control on the other hand, it may be necessary to calculate several planners for distance or distance trajectories in parallel, as there are often several target objects in the immediate vicinity of the vehicle (in front of or on the adjacent lanes) and the most critical object is not always known in advance and selected for planning can be. For example, in a scenario in which overtaking in the “slower lane” (“right-hand overtaking maneuver”) with target objects in one's own and the neighboring lane is to be prevented.
  • the additional planners for distance trajectories can be designed more simply (e.g. by delimited / coarser grid of the search area) than the main planner optimized for maximum comfort, e.g. B. with an increasing number of relevant objects in order to limit the resource requirements.
  • Fig. 2 shows the speed v (above) and the acceleration a (below) an exemplary one-piece trajectory T1 for a free ride according to the prior art.
  • the speed is to be increased from 10 m / s to 20 m / s, with an acceleration limitation of 2 m / s 2 being effective. Since the calculated one-piece trajectory violates the acceleration limitation, it is classified as inadmissible according to the state of the art and discarded.
  • three-part trajectories can be used. In FIG. 2, such a three-part trajectory T2 is shown in addition to the one-part trajectory T1.
  • the first trajectory segment leads the acceleration to the maximum or minimum value a cst
  • the second segment keeps the acceleration constant and the third segment reduces the acceleration again.
  • the duration for the first and third trajectory segment is kept constant and the duration of the second segment is varied in such a way that the desired final speed is reached.
  • the duration t e of the three-part trajectory generally deviates from the duration of the one-part trajectory T1, as shown in FIG. 2.
  • the comparison of the one-part trajectory T1 and the three-part trajectory T2 is therefore inconsistent, since the trajectory length is included in the quality measure.
  • Another disadvantage arises from the invariant duration of the first and third trajectory segments, which cannot be adapted to the specific situation as a result.
  • the calculation of three-part speed trajectories is proposed according to the invention with variable duration of all trajectory segments while maintaining the total duration t e .
  • the duration of the respective segments follows through the minimization of a quality measure.
  • the quality measure evaluates the use of the manipulated variable at the input of the system model or the integrator chain and in this respect corresponds to the integral part of the quality measure for evaluating one-part trajectories. Due to the consistent trajectory duration and the consistent quality measure of one- and three-part trajectories, these can be exchanged directly in the superimposed optimization.
  • the total trajectory length t e corresponds to the sum of the segment durations Ati, ⁇ t 2 and ⁇ t 3 .
  • the duration At 3 is chosen so that the quality measure of the three-part trajectory is minimal.
  • a subordinate optimization is used for this.
  • the possible solution range for At 3 is determined. Initially, this cannot be less than zero and no longer than the trajectory length t e .
  • a third inequality results from the further requirement that At 2 should also be positive.
  • a bisection process is used in a second step. After a few calculation steps, this results in an optimal replacement for the one-part trajectory that is consistent with it.
  • FIG. 3 shows a three-part trajectory T3 within the meaning of the invention for the example in FIG. 2. In Fig.
  • a further example is shown in which a non-symmetrical trajectory T5 is calculated as a replacement for the one-piece trajectory T4 be.
  • the problem described above is also relevant for path trajectories.
  • a trajectory can violate both the lower and the upper acceleration limit.
  • the substitute trajectory has up to five trajectory segments and can no longer be calculated analytically.
  • a three-part path trajectory can be calculated similarly to the speed trajectory.
  • the first and the second trajectory segments ai and a cst are identical to the case of the speed trajectories, while the third segment uses a fifth order polynomial to convert the final state to the desired final speed v e . So that a three-part trajectory bridges the specified distance s e - so, the following equation must be fulfilled:
  • An alternative way of planning multi-part path trajectories results from the integration of three-part speed trajectories.
  • a trajectory can be found that approximates a one-part path trajectory, i.e. H. approximates a one-part trajectory.
  • target states for trajectory planning can be specified.
  • d s to stands for the distance to the target vehicle when the vehicle is stationary
  • v t for the speed of the target vehicle
  • headway for the time gap.
  • the movement of the target vehicle can be predicted into the future assuming a constant acceleration a t, o:
  • the measured distance is denoted by do.
  • v w v t - CL t ⁇ headway
  • FIG. 6 shows the progression of the states (path or distance (above), speed (middle) and acceleration (below)) of a target vehicle and the resulting therefrom Target states shown.
  • the status of the target vehicle is shown in solid black and the target statuses for trajectory planning according to the distance equation in dot-dashed-black and after filtering with a mass-spring-damper system (dashed line). If the acceleration of the target vehicle changes, the predicted setpoint speed jumps by -a t * headway.
  • the target vehicle starts to brake (e.g. from 12 s to 17 s)
  • a suddenly higher target speed than that of the target vehicle is requested.
  • the trajectory planning finds solutions that accelerate the vehicle in order to reach this higher speed, ie the vehicle is attracted by the decreasing target distance.
  • the target speed jumps to zero when the predicted target vehicle comes to a standstill.
  • This jump in the target state specification unfavorably leads to the vehicle following a stopping or stationary target vehicle at too high a speed and a small distance.
  • the target distance increases again, so that the target values for planning are for a period of time at negative speeds and thus push the stationary vehicle backwards.
  • One embodiment variant of the method represents the insertion or provision of a virtual mass-spring-damper system arranged on the target vehicle (FIG. 7).
  • the target distance d w corresponds to the spring length I, where c describes the spring constant.
  • the state x r of the mass m is used as the new target state for planning. This is a consistent filtering of the target vehicle state in all states.
  • the filtered target state is shown in FIG. 6.
  • the target vehicle brakes from 12 s to 17 s
  • the target speed goes steadily to the setpoint without a jump.
  • the specified distance is slightly larger than the calculated target distance and enables braking to a standstill without the target speed and target acceleration being discontinuous.
  • the invention also expressly includes further refinements or interconnections of springs and dampers not explicitly mentioned. Column stability can be achieved by such filtering.
  • a dynamic search area can expediently also be provided.
  • the rasterization of the search area determines how well the exact solution of the optimization problem is approximated by the calculated trajectory.
  • a fine grid contrasts with a low computational requirement. However, in certain situations it is necessary to rasterize very finely in order to find a valid solution in the search space.
  • a disadvantage of a fixed and coarse grid is the discontinuous influence of the optimization parameters on the trajectory found. Parameter changes are effective for as long no change in the trajectory until another grid point has a lower quality measure than the current grid point. This behavior complicates the application and prevents an intuitive procedure.
  • An adaptive search space is therefore proposed. This means that the grid points are shifted in such a way that there are more grid points near the best solution than in more distant areas. It is also important that grid points are located in the entire search area so that sudden changes in the target states can be reacted to quickly (e.g. target object change, strong target object braking, etc.). By iterative adaptation of the grid points over several cycles of optimization, it is possible to refine the grid around a selected point and in this way to approach the optimum.
  • a “stop-and-go function” can be provided, in particular for an ACC control.
  • the vehicle can follow a vehicle traveling in front to a standstill and start again when the vehicle traveling in front starts moving.
  • the stopping process can be designed to be comfortable and reproducible by defined “crawling” (i.e. moving particularly slowly) shortly before the standstill.
  • the above-described filtering of the target vehicle states generates target states that are preferably familiar to the driver. While the prediction of such target states based on unfiltered target vehicle data shows a jump to a negative target speed when following a target vehicle approaching from a standstill, the filtering of the target vehicle data developed here results in steady target states with consistently positive target speed and target path specifications. The same can also be seen for sudden changes in the target vehicle acceleration (positive or negative) during normal following travel (at speeds v> 0 km / h).
  • the stopping process is particularly difficult to set or regulate due to the lack of the ability to “dive in”. Any control deviations (deviation between the planned and actually driven trajectory) cannot be corrected without further ado, since this would often require sections with negative speed (reverse travel). In order to compensate for the occurring control deviations, various extensions are conceivable and can improve the stopping behavior individually or in combination, such. B. by adapting the target states of the trajectory planning at low speeds and / or by applying a plateau of constant acceleration and / or by fading the trajectory planning at very low speeds with a virtual bumper.
  • the planning takes into account that a defined intermediate state is reached before the final standstill. This guarantees a safe approach by representing a kind of buffer zone in which any system deviations can be compensated, especially with regard to the distance to the target vehicle.
  • the precise transfer from the plateau to standstill can, for. B. take place via a pre-controlled acceleration profile.
  • An additional advantage of this approach is the possibility of applying specific stopping behavior separately from the general trajectory planning.
  • a virtual bumper represents a spring-damper system that is virtually attached or arranged between the vehicle (x ego ) and the target vehicle (x t ) (as shown in FIG. 8).
  • a suitable design ensures that the vehicle brakes to a standstill at a predetermined distance from the target vehicle, follows at low speeds and can also start behind the target vehicle. Through the previous or preceding filtering of the target distance, z. B. by means of a spring-damper system, suitable states can be created for the transfer to the virtual bumper.
  • the virtual bumper offers In addition, a safe fall-back level in the event that the primary planning does not find a trajectory in the solution space.
  • the modular structure of the coordination layer enables the separate parameterization and application of individual functionalities using the same planner architecture and thus the system can be easily expanded to include future functionalities.
  • the concept of three-part trajectories is being renewed or expanded. If, for example, the flanks of the acceleration trajectories were previously fixed, they are now always selected to match any starting and ending conditions of the trajectory through a subordinate optimization.
  • the trajectory planning is divided into two layers or levels, a coordination or parameterization layer and a planning layer to further increase the applicability in series applications.
  • the parameterization layer enables a situation-dependent adaptation of the trajectory properties, e.g. B. by gain scheduling of the optimization parameters or the like.
  • the high relevance of the parameterization layer becomes particularly clear when looking at human driving profiles.
  • the optimization delivers trajectories that are optimal in terms of the quality measure, the course of these trajectories can sometimes be unfamiliar to the human driver in some situations. In particular because there is a discrepancy between the mathematical and the optimum perceived by humans in the trajectories.
  • a “full-speed range ACC” can be provided, which is configured in such a way that a switchover takes place between the trajectory planner according to the invention and a further controller (e.g. the concept of the virtual bumper) to control the vehicle z. B. even at very low speeds (z. B. When stopping or crawling chen) to control optimally.
  • a further controller e.g. the concept of the virtual bumper
  • good damping control behavior is important in a low speed range in order to e.g. B. to ensure column stability with an ACC control concept based on optimization.
  • extensions of the basic functionality of the respective assistance system z. B. ACC, EBA, etc.
  • inventive method can be applied regardless of the controller structure of the respective means of transport and thus offers the possibility of Be taking into account the transverse movement of the means of transport, eg. B. an ACC system can serve as a starting point for automated or autonomous driving.
  • T1 one-part trajectory (according to the state of the art)
  • T6 one-part trajectory (according to the state of the art)

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

L'invention concerne un procédé de planification de trajectoire d'un système d'assistance au conducteur, en particulier d'un système d'assistance de régulation longitudinale et/ou transversale. Dans le procédé, une trajectoire (T1, T3-T7) est définie avec une durée totale (te) pouvant être fixée, la trajectoire (T3, T5, T7) est divisée en segments. Chaque segment présente une durée (Δt1, Δt2, Δt3) de segment pouvant être modifiée et la somme des durées (Δt1, Δt2, Δt3) de segment correspond à la durée totale (te) fixée de la trajectoire (T3, T5, T7).
EP20707559.9A 2019-02-12 2020-01-16 Procédé de planification de trajectoire d'un système d'assistance Pending EP3924797A1 (fr)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
DE102019201800.9A DE102019201800A1 (de) 2019-02-12 2019-02-12 Verfahren zur Trajektorienplanung eines Assistenzsystems
PCT/DE2020/200005 WO2020164670A1 (fr) 2019-02-12 2020-01-16 Procédé de planification de trajectoire d'un système d'assistance

Publications (1)

Publication Number Publication Date
EP3924797A1 true EP3924797A1 (fr) 2021-12-22

Family

ID=69723761

Family Applications (1)

Application Number Title Priority Date Filing Date
EP20707559.9A Pending EP3924797A1 (fr) 2019-02-12 2020-01-16 Procédé de planification de trajectoire d'un système d'assistance

Country Status (6)

Country Link
US (1) US20220176958A1 (fr)
EP (1) EP3924797A1 (fr)
JP (1) JP7266684B2 (fr)
CN (1) CN113412458B (fr)
DE (1) DE102019201800A1 (fr)
WO (1) WO2020164670A1 (fr)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114590274A (zh) * 2022-03-25 2022-06-07 奥特酷智能科技(南京)有限公司 用于驾驶辅助系统的路径规划方法及驾驶辅助系统

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20220397904A1 (en) * 2019-08-05 2022-12-15 Sony Group Corporation Information processing apparatus, information processing method, and program
FR3115516B1 (fr) * 2020-10-22 2022-09-09 Psa Automobiles Sa Procédé et dispositif de typage du mode de conduite d’un véhicule autonome
CN112455720B (zh) * 2020-11-30 2022-04-22 中国运载火箭技术研究院 一种空天飞行器气动力辅助变轨设计方法
FR3116782B1 (fr) * 2020-11-30 2022-11-04 Psa Automobiles Sa Procédé et dispositif d’adaptation d’une trajectoire d’accélération de consigne d’un régulateur de vitesse véhicule adaptatif d’un véhicule autonome.
FR3138099A1 (fr) * 2022-07-19 2024-01-26 Psa Automobiles Sa Procédé et dispositif de contrôle d’un système de régulation adaptative de vitesse d’un véhicule

Family Cites Families (28)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3632533B2 (ja) * 1999-11-26 2005-03-23 トヨタ自動車株式会社 車両の自動走行制御方法および自動走行制御装置
US11267338B2 (en) * 2005-11-17 2022-03-08 Invently Automotive Inc. Electric vehicle power management system
WO2009129106A1 (fr) * 2008-04-15 2009-10-22 The Uwm Research Foundation, Inc. Systèmes et procédés de gestion d'énergie dans un véhicule hybride
WO2010113319A1 (fr) * 2009-04-03 2010-10-07 トヨタ自動車株式会社 Dispositif de contrôle d'entraînement de véhicule
SE534023C2 (sv) * 2009-08-24 2011-04-05 Scania Cv Ab System och metod för att hålla körtider
DE112010003789T5 (de) * 2009-09-24 2012-11-29 Mitsubishi Electric Corporation Fahrmuster-erzeugungsvorrichtung
WO2012103228A1 (fr) * 2011-01-25 2012-08-02 Nextgen Aerosciences, Llc Procédé et appareil de gestion dynamique de trajectoires d'aéronefs
US9002612B2 (en) * 2012-03-20 2015-04-07 Toyota Motor Engineering & Manufacturing North America, Inc. Prediction of driver-specific cruise speed using dynamic modeling
DE102012213321A1 (de) * 2012-07-30 2014-01-30 Robert Bosch Gmbh Verfahren und Vorrichtung zum Betreiben eines Fahrzeugs
US9045144B2 (en) * 2013-05-09 2015-06-02 Robert Bosch Gmbh Third-order polynomial-based course prediction for driver assistance functions
DE102015208790A1 (de) * 2015-05-12 2016-11-17 Volkswagen Aktiengesellschaft Bestimmen einer Trajektorie für ein Fahrzeug
US11027735B2 (en) * 2015-08-06 2021-06-08 Honda Motor Co., Ltd. Vehicle control apparatus, vehicle control method, and vehicle control program
DE102015217801A1 (de) * 2015-09-17 2017-03-23 Zf Friedrichshafen Ag Geschwindigkeitssteuerung eines Kraftfahrzeugs
DE102015221612A1 (de) * 2015-11-04 2017-05-04 Bayerische Motoren Werke Aktiengesellschaft Verfahren, Computer-lesbares Medium, Fahrerassistenzsystem und Fahrzeug umfassend das Fahrerassistenzsystem zum Berechnen einer Trajektorie zum Führen eines Fahrzeugs
JP6194942B2 (ja) * 2015-11-20 2017-09-13 マツダ株式会社 エンジンの制御装置
US9823660B2 (en) * 2016-01-19 2017-11-21 Ford Global Technologies, Llc System for distance to stop
JP6645649B2 (ja) * 2016-02-17 2020-02-14 本田技研工業株式会社 車両制御装置、車両制御方法、および車両制御プログラム
US9857795B2 (en) * 2016-03-24 2018-01-02 Honda Motor Co., Ltd. System and method for trajectory planning for unexpected pedestrians
JP6590270B2 (ja) * 2016-05-16 2019-10-16 本田技研工業株式会社 車両制御システム、車両制御方法、および車両制御プログラム
WO2017220705A1 (fr) * 2016-06-24 2017-12-28 Jaguar Land Rover Limited Système de commande pour véhicule
DE102017200580A1 (de) * 2017-01-16 2018-07-19 Bayerische Motoren Werke Aktiengesellschaft Verfahren zur Optimierung einer Manöverplanung für autonom fahrende Fahrzeuge
US11148666B2 (en) * 2017-06-27 2021-10-19 Honda Motor Co., Ltd. Vehicle control apparatus
DE102017212899B4 (de) * 2017-07-27 2019-04-18 Audi Ag Verfahren zur Bahnkurvenberechnung und Regelung für ein Fahrerassistenzsystem sowie eine Steuereinheit und Kraftfahrzeug
US10606277B2 (en) * 2017-09-18 2020-03-31 Baidu Usa Llc Speed optimization based on constrained smoothing spline for autonomous driving vehicles
CN109878518B (zh) * 2017-12-04 2021-08-17 京东方科技集团股份有限公司 用于控制车辆行驶的装置及方法
JP6950546B2 (ja) * 2018-01-24 2021-10-13 スズキ株式会社 車両の走行制御装置
CN109177972B (zh) * 2018-07-26 2020-06-30 南京航空航天大学 一种车辆柔性避撞系统及其控制方法
US20210173402A1 (en) * 2019-12-06 2021-06-10 Lyft, Inc. Systems and methods for determining vehicle trajectories directly from data indicative of human-driving behavior

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114590274A (zh) * 2022-03-25 2022-06-07 奥特酷智能科技(南京)有限公司 用于驾驶辅助系统的路径规划方法及驾驶辅助系统

Also Published As

Publication number Publication date
CN113412458A (zh) 2021-09-17
WO2020164670A1 (fr) 2020-08-20
CN113412458B (zh) 2023-12-29
US20220176958A1 (en) 2022-06-09
DE102019201800A1 (de) 2020-08-13
JP7266684B2 (ja) 2023-04-28
JP2022515437A (ja) 2022-02-18

Similar Documents

Publication Publication Date Title
EP3924797A1 (fr) Procédé de planification de trajectoire d'un système d'assistance
EP2881829B1 (fr) Procédé destiné à la commande automatique d'un véhicule, dispositif de production de signaux de commande pour un véhicule et véhicule
DE102014223000B4 (de) Einstellbare Trajektorienplanung und Kollisionsvermeidung
DE102010006442A1 (de) Verfahren zum Integrieren einer adaptiven Mehrmerkmals-Geschwindigkeitsregelung
DE102014215244A1 (de) Kollisionsfreie Quer-/Längsführung eines Fahrzeugs
DE102012215060A1 (de) Verfahren zum Führen eines Fahrzeugs und Fahrerassistenzsystem
DE102012001405A1 (de) Verfahren zur Durchführung eines Fahrspurwechsels und Vorrichtung zur Durchführung des Verfahrens
DE102019214121A1 (de) Verfahren zum Betrieb eines Fahrerassistenzsystems
AT14433U2 (de) Automatisierter Fahrstreifenwechsel im dynamischen Verkehr, basierend auf fahrdynamisch bedingten Einschränkungen
WO2019086518A1 (fr) Système d'aide à la conduite d'un véhicule automobile au moins partiellement autonome, véhicule automobile et procédé de régulation d'une dynamique de conduite
DE102015221626A1 (de) Verfahren zur Ermittlung einer Fahrzeug-Trajektorie entlang einer Referenzkurve
DE102015221612A1 (de) Verfahren, Computer-lesbares Medium, Fahrerassistenzsystem und Fahrzeug umfassend das Fahrerassistenzsystem zum Berechnen einer Trajektorie zum Führen eines Fahrzeugs
EP3395634B1 (fr) Procédé d'obtention d'une souplesse de conduite dans des véhicules autonomes
DE102015115163A1 (de) Verfahren zur situationsabhängigen Auswahl von Trajektorien für Fahrerassistenzsysteme von Fahrzeugen
DE102015209066A1 (de) Aufwandsreduzierte Trajektorienplanung für ein Fahrzeug
WO2015010901A1 (fr) Fourniture efficace d'informations d'occupation pour l'environnement d'un véhicule
DE102019133970A1 (de) Steuern eines Ego-Fahrzeugs in einer Umgebung einer Vielzahl von Durchfahrten
DE102010055373A1 (de) Verfahren zur Regelung einer Längsdynamik eines Kraftfahrzeugs und Kraftfahrzeug, in dem das Verfahren angewendet wird
WO2020001700A1 (fr) Procédé de détermination d'une trajectoire actualisée d'un véhicule
DE102005000808B4 (de) Vorrichtung zum Steuern/Regeln des Abstands zwischen Fahrzeugen
WO2004041578A1 (fr) Systeme de guidage de vehicule
DE102020214865A1 (de) Verfahren und Vorrichtung zur Unterstützung eines Fahrers eines Kraftfahrzeugs bei einem Spurwechselvorgang
DE102021211711A1 (de) Fahrerassistenzsystem und Verfahren zum Steuern eines Kraftfahrzeugs
DE102021129244A1 (de) Fahrassistenzsystem und Verfahren zum Betreiben eines Fahrassistenzsystems
DE102019128685A1 (de) Verfahren und Steuereinheit zur Planung einer Trajektorie für die Längsführung eines Fahrzeugs

Legal Events

Date Code Title Description
STAA Information on the status of an ep patent application or granted ep patent

Free format text: STATUS: UNKNOWN

STAA Information on the status of an ep patent application or granted ep patent

Free format text: STATUS: THE INTERNATIONAL PUBLICATION HAS BEEN MADE

PUAI Public reference made under article 153(3) epc to a published international application that has entered the european phase

Free format text: ORIGINAL CODE: 0009012

STAA Information on the status of an ep patent application or granted ep patent

Free format text: STATUS: REQUEST FOR EXAMINATION WAS MADE

17P Request for examination filed

Effective date: 20210913

AK Designated contracting states

Kind code of ref document: A1

Designated state(s): AL AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HR HU IE IS IT LI LT LU LV MC MK MT NL NO PL PT RO RS SE SI SK SM TR

DAV Request for validation of the european patent (deleted)
DAX Request for extension of the european patent (deleted)
RAP1 Party data changed (applicant data changed or rights of an application transferred)

Owner name: CONTINENTAL AUTONOMOUS MOBILITY GERMANY GMBH

STAA Information on the status of an ep patent application or granted ep patent

Free format text: STATUS: EXAMINATION IS IN PROGRESS

17Q First examination report despatched

Effective date: 20240325