METHOD FOR GENERATING A LATERAL OFFSET TRAJECTORY

Abstract

A method for generating a lateral offset trajectory for an at least partially automated mobile platform. The method includes: providing a target lateral offset; inverting a provided dynamic model of the mobile platform; providing at least one limit of a system variable of the dynamic model for determining the lateral offset trajectory; determining a time sequence of lateral offset trajectory points for the inverted dynamic model with a state variable filter, based on the limit(s) of the system variable, and the target lateral offset as an input signal; and determining a time sequence of values of at least one manipulated variable for the mobile platform, using the inverted dynamic model and the time sequence of the lateral offset trajectory points as an input signal for the inverted dynamic model, to generate the lateral offset trajectory.

Claims

1-15. (canceled)

16. A method for generating a lateral offset trajectory for an at least partially automated mobile platform, comprising the following steps: providing a target lateral offset; inverting a provided dynamic model of the mobile platform; providing at least one limit of a system variable of the dynamic model in order to determine the lateral offset trajectory; determining a time sequence of lateral offset trajectory points for the inverted dynamic model with a state variable filter, based on the at least one limit of the system variable, and the target lateral offset as an input signal, wherein each point of the time sequence of the lateral offset trajectory is determined analytically; and determining a time sequence of values of at least one manipulated variable for the mobile platform, using the inverted dynamic model and the time sequence of the lateral offset trajectory points as an input signal for the inverted dynamic model, to generate the lateral offset trajectory.

17. The method according to claim 16, wherein the state variable filter has predetermined target dynamics, and the predetermined target dynamics are characterized by an extended single-track model of the mobile platform.

18. The method according to claim 16, wherein the dynamic model of the mobile platform is transformed into flat coordinates; and a system of the state variable filter and a system of the dynamic model have an identical system order.

19. The method according to claim 16, wherein the points of the time sequence of the lateral offset trajectories are determined analytically using a numerical solution of a differential equation.

20. The method according to claim 16, wherein the at least one system variable of the dynamic flatness-based model is limited using a polytopical state limit of the at least one system variable of the state variable filter.

21. The method according to claim 16, wherein the at least one limit of a system variable of the dynamic model relates to at least one limit of a manipulated variable and/or at least one limit of a state variable of the dynamic model.

22. The method according to claim 21, wherein the state variable filter is limited depending on a prioritizing sequence based on a limit of a manipulated variable of the dynamic model, and/or based on a limit of a state variable of the dynamic model.

23. The method according to claim 21, wherein the at least one limited manipulated variable of the dynamic model is a manipulated variable and/or a gradient of the manipulated variable and/or an acceleration of the manipulated variable of at least one actuator which influences lateral dynamics of the mobile platform.

24. The method according to claim 23, wherein the at least one actuator controls a steering angle and/or at least one brake pressure and/or at least one wheel damper.

25. The method according to claim 21, wherein the at least one limit of the state variable of the dynamic model is a slip angle and/or a yaw angle and/or a yaw rate and/or a lateral acceleration and/or a steering angle and/or a lateral offset of the mobile platform.

26. A method, the method comprising: providing a control signal for controlling an at least partially automated vehicle based on a time sequence of values of at least one manipulated variable; and/or providing a warning signal for warning a vehicle occupant based on the time sequence of values of at least one manipulated variable.

27. The method as recited in claim 1, wherein the method is used for avoiding accidents in road traffic.

28. A control device configured to generate a lateral offset trajectory for an at least partially automated mobile platform, the control device configured to: provide a target lateral offset; invert a provided dynamic model of the mobile platform; provide at least one limit of a system variable of the dynamic model in order to determine the lateral offset trajectory; determine a time sequence of lateral offset trajectory points for the inverted dynamic model with a state variable filter, based on the at least one limit of the system variable, and the target lateral offset as an input signal, wherein each point of the time sequence of the lateral offset trajectory is determined analytically; and determine a time sequence of values of at least one manipulated variable for the mobile platform, using the inverted dynamic model and the time sequence of the lateral offset trajectory points as an input signal for the inverted dynamic model, to generate the lateral offset trajectory.

29. A non-transitory machine-readable storage medium on which is stored a computer program for generating a lateral offset trajectory for an at least partially automated mobile platform, the computer program, when executed by a computer, causing the computer to perform the following steps: providing a target lateral offset; inverting a provided dynamic model of the mobile platform; providing at least one limit of a system variable of the dynamic model in order to determine the lateral offset trajectory; determining a time sequence of lateral offset trajectory points for the inverted dynamic model with a state variable filter, based on the at least one limit of the system variable, and the target lateral offset as an input signal, wherein each point of the time sequence of the lateral offset trajectory is determined analytically; and determining a time sequence of values of at least one manipulated variable for the mobile platform, using the inverted dynamic model and the time sequence of the lateral offset trajectory points as an input signal for the inverted dynamic model, to generate the lateral offset trajectory.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

[0107] Exemplary embodiments of the invention are illustrated with reference to FIG. 1 and explained in more detail below. In the drawings:

[0108] FIG. 1 shows a data flow diagram of a method for generating a lateral offset trajectory, according to an example embodiment of the present invention.

[0109] FIG. 2 shows a data flow diagram of the online trajectory planning with the limited state variable filter, according to an example embodiment of the present invention.

[0110] FIG. 3 shows a cascade of two saturation elements for the prioritization-based consideration of state and manipulated variable limits within the trajectory plan, according to an example embodiment of the present invention.

[0111] FIG. 4 shows a time profile of the limited highest derivative of the flat output of the dynamic model, according to an example embodiment of the present invention.

[0112] FIGS. 5A, 5B show a time profile of the steering angle and the limited steering angle rate.

[0113] FIG. 6A shows a comparison of evasion trajectories.

[0114] FIG. 6B shows a comparison of yaw rate profiles.

[0115] FIG. 7 shows a simulation of a scenario of an evasion function with a lateral offset trajectory.

DETAILED DESCRIPTION OF EXAMPLE EMBODIMENTS

[0116] FIG. 1 schematically shows a flow diagram of the method 100 for generating a lateral offset trajectory 620 for an at least partially automated mobile platform. In step S1, the method is provided with a target lateral offset w.sub.y(t) 110. In step S2, the target lateral offset w.sub.y(t) 110 is transformed into flat coordinates w.sub.z(t) using the filter 130. For an online trajectory planning 140, the state variable 142 of the online trajectory planning 140 is provided with the target lateral offset in flat coordinates w.sub.z(t), and, in step S4, with a limit of a manipulated variable 120 {dot over (8)}.sub.u,max and a limit of a state variable 120 {dot over (ψ)}.sub.max as input variables. In addition, in step S3 a time sequence of lateral offset trajectory points z*(t.sub.n) and the fifth time derivative z.sup.5*(t) are determined as input variables for the inverted flatness-based dynamic model 150 for the determination of the time sequence of lateral offset trajectory points and provided to the inverted dynamic model in step S5. By means of the time sequence of lateral offset trajectory points z*(t.sub.n) and the fifth time derivative z.sup.5*(t) a time sequence of values of at least one manipulated variable {dot over (δ)}.sub.u*(t) 160 of the mobile platform is determined by the inverted flatness-based dynamic model 150 in step S6. The time sequence of values 160 of at least one manipulated variable {dot over (δ)}.sub.u*(t) 160 of the mobile platform can be used for pilot control for a trajectory control of the mobile platform.

[0117] FIG. 2 schematically illustrates the information flows of the online trajectory planning 140 of FIG. 1 in flat coordinates, wherein the online trajectory planning 140 has a limiter 144 and an integrator chain 146 according to an extended, switching state variable filter 140 with unlimited filter desired dynamics 142.

[0118] In this case, from the target lateral offset in flat coordinates w.sub.z(t) 130, an unlimited desired signal for the highest time derivative of the flat output z.sup.n*(t) of the dynamic model is determined by means of the predetermined desired dynamics of the state variable filter 142, which time derivative is limited by the limiter 144 and is integrated by the integrator chain 146, from which trajectories z* and z*.sup.(1), . . . , z*.sup.(n) and n time derivatives thereof result, in order to provide a time sequence of lateral offset trajectory points as an input variable for the inverse flatness-based dynamic model of the mobile platform 150. In this case, this input variable is coupled back into the limiter 144 and into the dynamics of the state variable filter 142 for the next calculation step. The output signal of the online trajectory planning 140 is provided to the inverse flatness-based dynamic model 150, for example for calculating the pilot control {dot over (δ)}(t). In this method, the system variable is dynamically limited according to the limit functions 4.25, 4.26, 4.27 and 4.28, i.e. the dynamics of the filter are limited in a time-variant manner.

[0119] FIG. 3 schematically illustrates a data flow of a prioritization of the limit of a state variable and/or a manipulated variable by means of a first saturation filter 144b and a second saturation filter 144d connected behind it in series, wherein the first saturation filter 144b can limit a state variable, such as a yaw rate, and the second saturation filter 144d arranged in the information flow direction behind the first saturation filter 144b can limit a manipulated variable, such as a steering angle speed, in order to limit an input variable, namely a fifth derivative of z, only by means of the first saturation filter 144b and/or by means of the second saturation filter 144d. In this case, the yaw rate limitation 144a is provided with both a limit of the yaw rate and the trajectory profile of the flat output z*(t) of the dynamic model, as well as its time derivatives, or the filter states of equation 4.18. The steering angle speed limitation 144c is provided with both a limit of the steering angle speed and of the trajectories profile of the flat output z*(t) of the dynamic model of the dynamic model, as well as the time derivatives thereof. Thus, a prioritization of the limit can be achieved by a cascading sequence of the two limiters.

[0120] FIG. 4 shows a diagram 400 in which the fifth derivative of the trajectory profile of the flat output z is plotted against the time t with the curve 450. The limitation of the fifth derivative is outlined by the profile of the curve of a limit by the state variable 410 and by the profile of the curve of a limit by the manipulated variable 420. It can be seen here that the fifth derivative is determined within the upper and lower limit of the manipulated variable 420 by the maximum utilization of the state variable 410.

[0121] FIG. 5A illustrates an example of a profile of the manipulated variable of the steering angle 510 over time in the diagram 500a.

[0122] And FIG. 5B illustrates the corresponding profile of the steering angle rate 520 with the upper and lower limits 525 in the diagram 500b.

[0123] FIG. 6A compares a lateral offset trajectory 620 generated with this method with a differently generated lateral offset trajectory 610 in the diagram 600a, wherein the latter was generated according to the related art, without maximized use of a state limit for determining the trajectory. The lateral offset y of the mobile platform is plotted in the diagram 600a within the same distance x and it can be seen that an increase in the lateral offset by about 20% can be realized with the new method.

[0124] With the diagram 600b of FIG. 6B, in which the yaw rate is plotted against the time t both for the method 640 described here and according to the related art 630, it is illustrated that an improved profile of the trajectory can be achieved by utilization of the maximally possible yaw rate that is maximized within the time range of the trajectory according to the described method.

[0125] FIG. 7 illustrates a traffic scenario with a simulation of an evasion function with a lateral offset trajectory which is triggered by a person on the road.