EP4581445A1 - Trajectory planning method and apparatus, device and storage medium - Google Patents

Trajectory planning method and apparatus, device and storage medium

Info

Publication number
EP4581445A1
EP4581445A1 EP23758623.5A EP23758623A EP4581445A1 EP 4581445 A1 EP4581445 A1 EP 4581445A1 EP 23758623 A EP23758623 A EP 23758623A EP 4581445 A1 EP4581445 A1 EP 4581445A1
Authority
EP
European Patent Office
Prior art keywords
trajectory
model
vehicle
basis
control
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
EP23758623.5A
Other languages
German (de)
French (fr)
Inventor
Zhiying SHANG
Huan YOU
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.)
Aumovio Autonomous Mobility Germany GmbH
Original Assignee
Continental Autonomous Mobility Germany 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 Continental Autonomous Mobility Germany GmbH filed Critical Continental Autonomous Mobility Germany GmbH
Publication of EP4581445A1 publication Critical patent/EP4581445A1/en
Pending legal-status Critical Current

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes 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/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/095Predicting travel path or likelihood of collision
    • B60W30/0953Predicting travel path or likelihood of collision the prediction being responsive to vehicle dynamic parameters
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Details 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
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • B60W60/0011Planning or execution of driving tasks involving control alternatives for a single driving scenario, e.g. planning several paths to avoid obstacles
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Details 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
    • B60W2050/0001Details of the control system
    • B60W2050/0002Automatic control, details of type of controller or control system architecture
    • B60W2050/0004In digital systems, e.g. discrete-time systems involving sampling
    • B60W2050/0005Processor details or data handling, e.g. memory registers or chip architecture
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Details 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
    • B60W2050/0001Details of the control system
    • B60W2050/0019Control system elements or transfer functions
    • B60W2050/0028Mathematical models, e.g. for simulation
    • B60W2050/0031Mathematical model of the vehicle
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/10Longitudinal speed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/10Longitudinal speed
    • B60W2520/105Longitudinal acceleration
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/14Yaw
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Output or target parameters relating to overall vehicle dynamics
    • B60W2720/10Longitudinal speed
    • B60W2720/106Longitudinal acceleration
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Output or target parameters relating to overall vehicle dynamics
    • B60W2720/24Direction of travel

Definitions

  • the present invention relates to the field of autonomous driving, in particular to a trajectory planning method and apparatus, a device and a storage medium.
  • trajectory planning system needs to plan a trajectory that meets the dynamic requirements of the vehicle; this trajectory needs to satisfy decision-making layer instructions and be able to avoid collisions with surrounding obstacles.
  • trajectory planning includes the following methods: using the method of enumerating a trajectory cluster and then screening out an optimal trajectory according to a cost function; establishing a neural network model, and using a machine learning method; the method of using geometric constraints to generate a random number of new nodes of a trajectory, and finally trimming the trajectory nodes and smoothing the trajectory; using the method of Hermite interpolation to perform trajectory planning in a selecte drivable region; and planning a safe and feasible travel trajectory by an improved artificial potential field method.
  • the prior art mentioned above has problems, such as high computing costs, low computing efficiency, and failure to take into account vehicle kinematic or vehicle dynamic characteristics.
  • the present invention was created to solve the abovementioned problems; its objective is to provide a trajectory planning method and apparatus, as well as a device and a storage medium, which take into account vehicle kinematic characteristics, and have low requirements for computing resources and a fast computing speed.
  • a trajectory planning method comprising the following steps: acquiring a reference trajectory of a predetermined planning interval on the basis of vehicle information, environment information and end point information; establishing a vehicle kinematic model in a road coordinate system on the basis of the vehicle information and the reference trajectory; and using a model predictive controller to determine a sequence of control quantities in a predetermined planning interval according to the reference trajectory, the vehicle information and the vehicle kinematic model, and obtaining a final trajectory on the basis of the sequence of control quantities.
  • the step of using a model predictive controller to determine a sequence of control quantities in a predetermined planning interval according to the reference trajectory, the vehicle information and the vehicle kinematic model, and obtaining a final trajectory on the basis of the sequence of control quantities comprises: linearizing the vehicle kinematic model, to obtain a time domain linearized vehicle model and a space domain linearized vehicle model; the model predictive controller comprising a longitudinal control model and a transverse control model, designing a cost function of the longitudinal control model and a cost function of the transverse control model, and determining a sequence of control quantities of a predetermined planning interval on the basis of the cost function of the longitudinal control model, the cost function of the transverse control model, the time domain linearized vehicle model and the space domain linearized vehicle model; and acquiring a final trajectory on the basis of the sequence of control quantities.
  • control quantities comprise: desired acceleration and desired front wheel deflection angle.
  • the vehicle kinematic model is linearized to obtain the time domain linearized vehicle model and the space domain linearized vehicle model.
  • the longitudinal control model is established in the time domain, state quantities thereof comprise longitudinal position, speed and acceleration, and the sequence of desired accelerations among the control quantities is determined on the basis of the cost function of the longitudinal control model and the time domain linearized vehicle model.
  • the transverse control model is established in the space domain, state quantities thereof comprise transverse position, yaw angle and front wheel deflection angle, and the sequence of desired front wheel deflection angles among the control quantities is determ ined on the basis of the cost function of the transverse control model and the space domain linearized vehicle model.
  • the cost function of the longitudinal control model comprises a first term and a second term, the first term representing minimization of state cost and control cost, and the second term representing end state cost.
  • the cost function of the transverse control model comprises a third term and a fourth term, the third term representing minimization of state cost and control cost, and the fourth term representing end state cost.
  • the cost function of the longitudinal control model comprises weights corresponding to longitudinal position error, speed error, acceleration error and desired acceleration.
  • the cost function of the transverse control model comprises weights corresponding to transverse position error, yaw angle, front wheel deflection angle and desired front wheel deflection angle.
  • the step of acquiring a reference trajectory of a predetermined planning interval on the basis of vehicle information, environment information and end point information comprises: performing global trajectory planning on the basis of vehicle information and end point information, to obtain a global trajectory from a start point to an end point; and judging whether a collision will occur on the basis of environment information and the global trajectory; if a collision will occur, then performing local trajectory planning to obtain the reference trajectory; if no collision will occur, then acquiring the reference trajectory on the basis of the global trajectory.
  • a trajectory planning apparatus comprising: a reference trajectory acquisition module, configured to acquire a reference trajectory of a predetermined planning interval on the basis of vehicle information, environment information and end point information; a model establishing module, configured to establish a vehicle kinematic model in a road coordinate system on the basis of the vehicle information and the reference trajectory; and a final trajectory acquisition module, configured to use a model predictive controller to determine a sequence of control quantities in a predetermined planning interval according to the reference trajectory, the vehicle information and the vehicle kinematic model, and obtain a final trajectory on the basis of the sequence of control quantities.
  • an electronic device comprising a processor and a memory, and at least one instruction or at least one program is stored in the memory, the at least one instruction or the at least one program being loaded by the processor and executing the trajectory planning method described above.
  • a computer storage medium stores an instruction for execution by a computing device, and when the computing device executes the instruction, the trajectory planning method described above is realized.
  • Fig. 1 is a schematic flow chart of a trajectory planning method provided in embodiments of the present invention.
  • Fig. 2 is a schematic drawing of parameters in a vehicle kinematic model provided in embodiments of the present invention.
  • Fig. 3 is a structural block diagram of the trajectory planning apparatus provided in embodiments of the present invention.
  • Fig. 4 is a structural block diagram of an electronic device provided in embodiments of the present invention.
  • Embodiments of the present application provide a trajectory planning method, in which a vehicle 1 can compute a smooth trajectory according to information about the vehicle itself, a target state, road condition information about a road, and dynamic and comfort constraints, so that the vehicle 1 can reach the target state along this trajectory.
  • Fig. 1 is a schematic flow chart of the trajectory planning method provided in embodiments of the present invention; the method may be executed by a trajectory planning apparatus, which may be realized by software and/or hardware.
  • This Description provides method operating steps according to the embodiments or flow chart, but may include a larger or smaller number of operating steps, based on conventional or non-creative effort.
  • the order of the steps set out in the embodiments is merely one of many orders in which steps may be executed, and does not represent the only order of execution.
  • the steps may be executed in the order of the method shown in the embodiments or drawings, or executed in parallel (for example, parallel processors or a multi-thread processing environment).
  • the trajectory planning method provided in this embodiment comprises the following steps.
  • S110 acquiring a reference trajectory of a predetermined planning interval on the basis of vehicle information, environment information and end point information.
  • global trajectory planning may be performed first, on the basis of vehicle information and end point information, to obtain a global trajectory from a start point to an end point, and preliminarily determine a position and speed of the vehicle 1 at each moment.
  • Local trajectory planning is then performed; in the process of local trajectory planning, the already-planned global trajectory is used as a basis, then small-range, small-timescale trajectory planning is performed with reference to obstacle information acquired by various sensors, so as to obtain a reference trajectory of a predetermined planning interval.
  • the global trajectory planning in this embodiment may use third-degree polynomial interpolation to obtain the global trajectory.
  • the global trajectory planning method used in this embodiment is prior art in this field, so details are not repeated here.
  • each time global trajectory planning is performed the current position of the vehicle is taken to be the start point of the global trajectory planning.
  • the displacement and time of the start point are both 0; therefore, the position and time of the end point are the distance and time separating the start point and end point, and are independent of absolute coordinates.
  • the road coordinate system is also called the Frenet coordinate system.
  • the vehicle kinematic model in the road coordinate system has the road start point as the origin of coordinates, the road direction as the s direction, and the direction perpendicular to a tangent to the road as the I direction; the coordinates are expressed as (s, I).
  • the reference trajectory obtained in step S110 is used as a reference coordinate system. Therefore, the start point (or any point) of the reference trajectory is used as the origin of the coordinate system, the direction along the reference trajectory is s, and the direction perpendicular to the trajectory is I.
  • the trajectory T is the reference trajectory, and the start point 0 of the reference trajectory is chosen to be the origin of the coordinate system.
  • Point C in Fig. 2 represents the centre of mass of the vehicle, and the coordinates (s, I) of the centre of mass of the vehicle are taken to be the coordinates of the vehicle, i.e. the longitudinal position of the vehicle is s, and the transverse position of the vehicle is I.
  • RW in Fig. 2 represents the rear wheels of the vehicle
  • FW represents the front wheels of the vehicle
  • represents the yaw angle of the vehicle
  • [3 represents the deflection angle of the centre of mass of the vehicle.
  • Vehicle control quantities include: desired acceleration: a com desired deflection angle of front wheels: 6
  • the vehicle kinematic model shown in formula (1 ) above is linearized, to obtain a time domain linearized vehicle model and a space domain linearized vehicle model.
  • a first-order inertial process is used to fit the step response of acceleration and front wheel deflection angle, giving:
  • the cost function of the longitudinal control model shown in formula (4) comprises a first term and a second term, i.e. the term preceding the plus sign and the term following the plus sign in formula (4).
  • the first term represents minimization of the state cost and the control cost, i.e. bringing the system as close as possible to the reference state quantity while consuming as little energy as possible.
  • the control cost of each step is Ri on a com k 2 > Rion being the weight factor of desired acceleration in the cost.
  • the second term represents the end state cost, which is intended to take into account a scenario in which the vehicle must forcibly reach a particular state at a particular time; the expanded form thereof is as follows: where Q ni , Q n2 are weight factors of the end state cost in the cost function.
  • the cost function of the transverse control model shown in formula (6) comprises a third term and a fourth term, i.e. the term preceding the plus sign and the term following the plus sign in formula (6).
  • the third term represents minimization of the state cost and the control cost, i.e. bringing the system as close as possible to the reference state quantity while consuming as little energy as possible.
  • Qi atl , Qiat 2 and Q tat3 are preset constants, respectively representing weight factors of the transverse position error relative to the reference trajectory, the yaw angle and the front wheel deflection angle in the cost.
  • the fourth term represents the end state cost, intended to take into account a scenario in which the vehicle must forcibly reach a particular state at a particular time;
  • Z? iat is the weight factor of desired front wheel deflection angle.
  • Q ⁇ t and Q ⁇ at3 are weight factors of the end state cost in the cost function. Deflection angle values for the front wheels of the vehicle are not planned in the reference trajectory in this embodiment,
  • the transverse control model is established in the space domain; the state quantity thereof includes transverse position error, yaw angle and front wheel deflection angle as stated above, and the control quantity is desired acceleration.
  • Fig. 3 is a structural block diagram of the trajectory planning apparatus provided in embodiments of the present invention.
  • the trajectory planning apparatus 200 comprises: a reference trajectory acquisition module 201 , a model establishing module 202 and a final trajectory acquisition module 203.
  • the reference trajectory acquisition module 201 is configured to acquire a reference trajectory of a predetermined planning interval on the basis of vehicle information, environment information and end point information.
  • Global trajectory planning may be performed first, on the basis of vehicle information and end point information, to obtain a global trajectory from a start point to an end point, and preliminarily determine a position and speed of the vehicle 1 at each moment.
  • Local trajectory planning is then performed; in the process of local trajectory planning, the already-planned global trajectory is used as a basis, then small-range, smalltimescale trajectory planning is performed with reference to obstacle information acquired by various sensors, so as to obtain a reference trajectory of a predetermined planning interval.
  • the model establishing module 202 is configured to establish a vehicle kinematic model in a road coordinate system on the basis of vehicle information and the reference trajectory.
  • the final trajectory acquisition module 204 is configured to use a model predictive controller to determine a sequence of control quantities in a predetermined planning interval according to the reference trajectory, vehicle information and the vehicle kinematic model, and obtain a final trajectory on the basis of the sequence of control quantities.
  • Fig. 4 is a structural block diagram of an electronic device 300 provided in embodiments of the present invention. As shown in Fig. 4, the present invention further provides an electronic device 300, the electronic device 300 comprising a processor and a memory; at least one instruction or at least one program is stored in the memory, the at least one instruction or the at least one program being loaded by the processor and executing the local trajectory planning method described in the embodiments above.
  • the storage medium may be located in at least one of multiple network servers of a computer network.
  • the storage medium may include but is not limited to various media capable of storing program code, such as a USB stick, read-only memory (ROM), random access memory (RAM), external hard drive, magnetic disk or optical disk.

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Feedback Control In General (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)

Abstract

The present invention provides a trajectory planning method and apparatus, a device, and a storage medium. The trajectory planning method comprises the following steps: acquiring a reference trajectory of a predetermined planning interval on the basis of vehicle information, environment information and end point information; establishing a vehicle kinematic model in a road coordinate system on the basis of the vehicle information and the reference trajectory; and using a model predictive controller to determine a sequence of control quantities in a predetermined planning interval according to the reference trajectory, the vehicle information and the vehicle kinematic model, and obtaining a final trajectory on the basis of the sequence of control quantities. The present invention takes vehicle kinematic characteristics into account, and has low requirements for computing resources and a fast computing speed.

Description

Trajectory planning method and apparatus, device and storage medium
Technical Field
[0001] The present invention relates to the field of autonomous driving, in particular to a trajectory planning method and apparatus, a device and a storage medium.
Background Art
[0002] As artificial intelligence has developed, autonomous driving technology has also experienced massive development in recent years. To realize autonomous driving, multiple systems of central importance are required, including positioning, environmental perception, fused prediction, decision-making, planning and baselayer control, etc.; the trajectory planning system is one of these. The trajectory planning system needs to plan a trajectory that meets the dynamic requirements of the vehicle; this trajectory needs to satisfy decision-making layer instructions and be able to avoid collisions with surrounding obstacles.
[0003] As prior art, trajectory planning includes the following methods: using the method of enumerating a trajectory cluster and then screening out an optimal trajectory according to a cost function; establishing a neural network model, and using a machine learning method; the method of using geometric constraints to generate a random number of new nodes of a trajectory, and finally trimming the trajectory nodes and smoothing the trajectory; using the method of Hermite interpolation to perform trajectory planning in a selecte drivable region; and planning a safe and feasible travel trajectory by an improved artificial potential field method. However, the prior art mentioned above has problems, such as high computing costs, low computing efficiency, and failure to take into account vehicle kinematic or vehicle dynamic characteristics.
Summary of the Invention
[0004] The present invention was created to solve the abovementioned problems; its objective is to provide a trajectory planning method and apparatus, as well as a device and a storage medium, which take into account vehicle kinematic characteristics, and have low requirements for computing resources and a fast computing speed.
[0005] According to one aspect of the present invention, a trajectory planning method is provided, comprising the following steps: acquiring a reference trajectory of a predetermined planning interval on the basis of vehicle information, environment information and end point information; establishing a vehicle kinematic model in a road coordinate system on the basis of the vehicle information and the reference trajectory; and using a model predictive controller to determine a sequence of control quantities in a predetermined planning interval according to the reference trajectory, the vehicle information and the vehicle kinematic model, and obtaining a final trajectory on the basis of the sequence of control quantities.
[0006] Preferably, the step of using a model predictive controller to determine a sequence of control quantities in a predetermined planning interval according to the reference trajectory, the vehicle information and the vehicle kinematic model, and obtaining a final trajectory on the basis of the sequence of control quantities, comprises: linearizing the vehicle kinematic model, to obtain a time domain linearized vehicle model and a space domain linearized vehicle model; the model predictive controller comprising a longitudinal control model and a transverse control model, designing a cost function of the longitudinal control model and a cost function of the transverse control model, and determining a sequence of control quantities of a predetermined planning interval on the basis of the cost function of the longitudinal control model, the cost function of the transverse control model, the time domain linearized vehicle model and the space domain linearized vehicle model; and acquiring a final trajectory on the basis of the sequence of control quantities.
[0007] Preferably, the control quantities comprise: desired acceleration and desired front wheel deflection angle.
[0008] Preferably, based on a situation where the yaw angle <p and the deflection angle [3 of the centre of mass of the vehicle are small, the vehicle kinematic model is linearized to obtain the time domain linearized vehicle model and the space domain linearized vehicle model. [0009] Preferably, the longitudinal control model is established in the time domain, state quantities thereof comprise longitudinal position, speed and acceleration, and the sequence of desired accelerations among the control quantities is determined on the basis of the cost function of the longitudinal control model and the time domain linearized vehicle model.
[0010] Preferably, the transverse control model is established in the space domain, state quantities thereof comprise transverse position, yaw angle and front wheel deflection angle, and the sequence of desired front wheel deflection angles among the control quantities is determ ined on the basis of the cost function of the transverse control model and the space domain linearized vehicle model.
[0011] Preferably, the cost function of the longitudinal control model comprises a first term and a second term, the first term representing minimization of state cost and control cost, and the second term representing end state cost.
[0012] Preferably, the cost function of the transverse control model comprises a third term and a fourth term, the third term representing minimization of state cost and control cost, and the fourth term representing end state cost.
[0013] Preferably, the cost function of the longitudinal control model comprises weights corresponding to longitudinal position error, speed error, acceleration error and desired acceleration.
[0014] Preferably, the cost function of the transverse control model comprises weights corresponding to transverse position error, yaw angle, front wheel deflection angle and desired front wheel deflection angle.
[0015] Preferably, the step of acquiring a reference trajectory of a predetermined planning interval on the basis of vehicle information, environment information and end point information, comprises: performing global trajectory planning on the basis of vehicle information and end point information, to obtain a global trajectory from a start point to an end point; and judging whether a collision will occur on the basis of environment information and the global trajectory; if a collision will occur, then performing local trajectory planning to obtain the reference trajectory; if no collision will occur, then acquiring the reference trajectory on the basis of the global trajectory.
[0016] According to another aspect of the present invention, a trajectory planning apparatus is provided, comprising: a reference trajectory acquisition module, configured to acquire a reference trajectory of a predetermined planning interval on the basis of vehicle information, environment information and end point information; a model establishing module, configured to establish a vehicle kinematic model in a road coordinate system on the basis of the vehicle information and the reference trajectory; and a final trajectory acquisition module, configured to use a model predictive controller to determine a sequence of control quantities in a predetermined planning interval according to the reference trajectory, the vehicle information and the vehicle kinematic model, and obtain a final trajectory on the basis of the sequence of control quantities.
[0017] According to another aspect of the present invention, an electronic device is provided, wherein the electronic device comprises a processor and a memory, and at least one instruction or at least one program is stored in the memory, the at least one instruction or the at least one program being loaded by the processor and executing the trajectory planning method described above.
[0018] According to another aspect of the present invention, a computer storage medium is provided, wherein the computer storage medium stores an instruction for execution by a computing device, and when the computing device executes the instruction, the trajectory planning method described above is realized.
Brief Description of the Drawings
[0019] Fig. 1 is a schematic flow chart of a trajectory planning method provided in embodiments of the present invention.
[0020] Fig. 2 is a schematic drawing of parameters in a vehicle kinematic model provided in embodiments of the present invention.
[0021] Fig. 3 is a structural block diagram of the trajectory planning apparatus provided in embodiments of the present invention. [0022] Fig. 4 is a structural block diagram of an electronic device provided in embodiments of the present invention.
Detailed Description of the Invention
[0023] The present invention is described in further detail below with reference to the drawings and embodiments. It will be understood that the specific embodiments described here are merely used to explain the associated invention, without limiting it. It must also be explained that to facilitate description, only parts relevant to the associated invention are shown in the drawings.
[0024] The terms used herein are merely used to describe specific embodiments, and are not intended to limit the present disclosure. As used herein, the singular forms “a” and “the” are also intended to include the plural form, unless clearly indicated otherwise in the context. It will also be understood that when the terms “comprises” and/or “made of...” are used herein, the existence of the mentioned feature, entity, step, operation, element and/or component is specified, without ruling out the existence or addition of one or more other features, entities, steps, operations, elements, components and/or groups thereof.
[0025] The embodiments mentioned herein may be described with reference to planar drawings and/or sectional drawings with the aid of the ideal schematic drawings of the present disclosure. Thus, exemplary drawings may be modified according to manufacturing techniques and/or tolerances. Therefore, the embodiments are not limited to the embodiments shown in the drawings, but include modifications to configurations formed on the basis of manufacturing processes. For this reason, regions illustrated in the drawings have schematic attributes, and the shapes of the regions shown in the drawings illustrate specific shapes of regions of elements, but are not intended to be limiting.
[0026] Unless otherwise defined, all terms used herein (including technical and scientific terms) have the same meanings as commonly understood by those skilled in the art. It will also be understood that terms such as those defined in common dictionaries should be interpreted as having the same meanings as they have in the context of the present disclosure and the related art, and shall not be interpreted as having idealized or excessively formal meanings, unless explicitly defined in this way herein.
[0027] Embodiments of the present application provide a trajectory planning method, in which a vehicle 1 can compute a smooth trajectory according to information about the vehicle itself, a target state, road condition information about a road, and dynamic and comfort constraints, so that the vehicle 1 can reach the target state along this trajectory.
[0028] Fig. 1 is a schematic flow chart of the trajectory planning method provided in embodiments of the present invention; the method may be executed by a trajectory planning apparatus, which may be realized by software and/or hardware. This Description provides method operating steps according to the embodiments or flow chart, but may include a larger or smaller number of operating steps, based on conventional or non-creative effort. The order of the steps set out in the embodiments is merely one of many orders in which steps may be executed, and does not represent the only order of execution. When executed in an actual system or server product, the steps may be executed in the order of the method shown in the embodiments or drawings, or executed in parallel (for example, parallel processors or a multi-thread processing environment).
[0029] As shown in Fig. 1 , the trajectory planning method provided in this embodiment comprises the following steps.
[0030] S110: acquiring a reference trajectory of a predetermined planning interval on the basis of vehicle information, environment information and end point information.
[0031] In this embodiment, global trajectory planning may be performed first, on the basis of vehicle information and end point information, to obtain a global trajectory from a start point to an end point, and preliminarily determine a position and speed of the vehicle 1 at each moment. Local trajectory planning is then performed; in the process of local trajectory planning, the already-planned global trajectory is used as a basis, then small-range, small-timescale trajectory planning is performed with reference to obstacle information acquired by various sensors, so as to obtain a reference trajectory of a predetermined planning interval.
[0032] The global trajectory planning in this embodiment may use third-degree polynomial interpolation to obtain the global trajectory. The global trajectory planning method used in this embodiment is prior art in this field, so details are not repeated here.
[0033] In this embodiment, each time global trajectory planning is performed, the current position of the vehicle is taken to be the start point of the global trajectory planning. Thus, the displacement and time of the start point are both 0; therefore, the position and time of the end point are the distance and time separating the start point and end point, and are independent of absolute coordinates.
[0034] After obtaining the global trajectory, a judgment is made as to whether a collision will occur on the basis of environment information and the global trajectory. If a collision will occur, then local trajectory planning is performed, to obtain a reference trajectory of a predetermined planning interval. If no collision will occur, a reference trajectory of a predetermined planning interval is acquired on the basis of the global trajectory. Specifically, a trajectory of a predetermined planning interval may be screened out of the global trajectory to serve as a reference trajectory.
[0035] The predetermined planning interval in this electric machine may be a reference trajectory of a predetermined length, or a reference trajectory of a predetermined duration.
[0036] S120: a vehicle kinematic model in a road coordinate system is established on the basis of the vehicle information and the reference trajectory.
[0037] The road coordinate system is also called the Frenet coordinate system. The vehicle kinematic model in the road coordinate system has the road start point as the origin of coordinates, the road direction as the s direction, and the direction perpendicular to a tangent to the road as the I direction; the coordinates are expressed as (s, I). In this embodiment, the reference trajectory obtained in step S110 is used as a reference coordinate system. Therefore, the start point (or any point) of the reference trajectory is used as the origin of the coordinate system, the direction along the reference trajectory is s, and the direction perpendicular to the trajectory is I.
[0038] Fig. 2 is a schematic drawing of parameters in the vehicle kinematic model in the road coordinate system as provided in embodiments of the present invention.
[0039] As shown in Fig. 2, the trajectory T is the reference trajectory, and the start point 0 of the reference trajectory is chosen to be the origin of the coordinate system. Point C in Fig. 2 represents the centre of mass of the vehicle, and the coordinates (s, I) of the centre of mass of the vehicle are taken to be the coordinates of the vehicle, i.e. the longitudinal position of the vehicle is s, and the transverse position of the vehicle is I. In addition, RW in Fig. 2 represents the rear wheels of the vehicle, FW represents the front wheels of the vehicle,^ represents the yaw angle of the vehicle, represents the deflection angle of the front wheels, and [3 represents the deflection angle of the centre of mass of the vehicle.
Vehicle state quantities include: longitudinal position (position in the direction of the reference trajectory): s transverse position (position in the direction perpendicular to the reference trajectory): I yaw angle: <p speed: v acceleration: a deflection angle of front wheels: 6f
Vehicle control quantities include: desired acceleration: acom desired deflection angle of front wheels: 6
J f com [0040] The vehicle kinematic model shown in formula (a) below is obtained by differentiation of the vehicle state quantities: where t represents time, the subscript t + 1 represents the state at time t + 1 , the subscript t represents the state at time t, w represents the wheelbase of the vehicle, kt is the curvature of the reference trajectory, lon_slopet is the longitudinal slope of the road (in units of radians), and lat_slopet is the transverse slope of the road (in units of radians).
[0041] S130: a model predictive controller is used to determine a sequence of control quantities in a predetermined planning interval according to the reference trajectory, vehicle information and the vehicle kinematic model, and a final trajectory is obtained on the basis of the sequence of control quantities.
[0042] Firstly, the vehicle kinematic model shown in formula (1 ) above is linearized, to obtain a time domain linearized vehicle model and a space domain linearized vehicle model.
[0043] Specifically, a first-order inertial process is used to fit the step response of acceleration and front wheel deflection angle, giving:
[0044] When the front wheel deflection angle is small, the yaw angle p and the deflection angle [3 of the centre of mass of the vehicle are small; therefore, vehicle motion exhibits only slight non-linearity, and linear modeling of the vehicle kinematic model is reasonable. [0045] If the yaw angle p and the deflection angle [3 of the centre of mass of the vehicle are small, the following reasonable assumptions hold:
Applying the reasonable assumptions above, the vehicle kinematic model shown in formula (1 ) is linearized, to obtain the time domain linearized vehicle model shown in formula (2).
[0046] Since st+1 - st = v x At, At = — ; this is substituted into the time domain linearized vehicle model above to obtain a space domain linearized vehicle model as shown in formula (3) below:
[0047] The model predictive controller used in this embodiment comprises a longitudinal control model and a transverse control model; a cost function of the longitudinal control model and a cost function of the transverse control model are designed separately. [0048] The cost function of the longitudinal control model is shown in formula (4) below:
[0049] The cost function of the longitudinal control model shown in formula (4) comprises a first term and a second term, i.e. the term preceding the plus sign and the term following the plus sign in formula (4). The first term represents minimization of the state cost and the control cost, i.e. bringing the system as close as possible to the reference state quantity while consuming as little energy as possible. The state quantity of the longitudinal control model of the model predictive controller is ^ion = [s, v, a] , i.e. includes longitudinal position, speed and acceleration, the control quantity is ition = acom, i.e. desired acceleration, and the reference state quantity is
[0050] The first term of the cost function of the longitudinal control model is the sum of the state cost and the control cost of each step from step k = 0 to step k = N - 1, wherein the state cost of each step is as follows: where Qioni, Qion2 anc* Qion3 are preset constants, respectively representing weight factors of longitudinal position error, speed error and acceleration error in the cost. In this embodiment, acceleration is not planned in the reference trajectory, so ar k ef = 0, and Qion 3 is set to 0.
[0051] The control cost of each step is Rion acomk 2 > Rion being the weight factor of desired acceleration in the cost.
[0052] The second term represents the end state cost, which is intended to take into account a scenario in which the vehicle must forcibly reach a particular state at a particular time; the expanded form thereof is as follows: where Q ni, Q n2 are weight factors of the end state cost in the cost function.
[0053] The longitudinal control model is established in the time domain, and the state quantity thereof includes longitudinal position, speed and acceleration as stated above, while the control quantity is desired acceleration.
[0054] Thus, based on the time domain linearized vehicle model shown in formula (2), a system dynamic equation of the longitudinal control model may be obtained, as shown in formula (5) below:
[0055] Thus, based on the cost function of the longitudinal control model shown in formula (4) and the system dynamic equation (5) of the longitudinal control model, a sequence of desired accelerations in the control quantity can be determined.
[0056] The cost function of the transverse control model is shown in formula (6) below:
[0057] The cost function of the transverse control model shown in formula (6) comprises a third term and a fourth term, i.e. the term preceding the plus sign and the term following the plus sign in formula (6). Similarly, the third term represents minimization of the state cost and the control cost, i.e. bringing the system as close as possible to the reference state quantity while consuming as little energy as possible. The state quantity of the transverse control model of the model predictive controller is ^tat = [Z, (p,8f], i.e. includes transverse position, yaw angle and front wheel deflection angle; the control quantity is itiat i-e- the front wheel deflection angle. Since I and <p of the state quantity are already errors, and the front wheel deflection angle 6f is not planned in the reference trajectory, the transverse reference state quantity is = [0,0,0], The state cost of each step is as follows:
Qiatl, Qiat2 and Qtat3 are preset constants, respectively representing weight factors of the transverse position error relative to the reference trajectory, the yaw angle and the front wheel deflection angle in the cost.
[0058] The fourth term represents the end state cost, intended to take into account a scenario in which the vehicle must forcibly reach a particular state at a particular time; Z?iat is the weight factor of desired front wheel deflection angle. Q^t and Q^at3 are weight factors of the end state cost in the cost function. Deflection angle values for the front wheels of the vehicle are not planned in the reference trajectory in this embodiment,
[0059] The transverse control model is established in the space domain; the state quantity thereof includes transverse position error, yaw angle and front wheel deflection angle as stated above, and the control quantity is desired acceleration.
[0060] Thus, based on the space domain linearized vehicle model shown in formula (3), a system dynamic equation of the transverse control model may be obtained, as shown in formula (7) below:
[0061] Thus, based on the cost function of the transverse control model shown in formula (6) and the system dynamic equation (7) of the transverse control model, a sequence of desired front wheel deflection angles in the control quantity can be determined.
[0062] Finally, based on the sequences of control quantities obtained by means of the longitudinal control model and transverse control model, i.e. the sequences of desired accelerations and desired front wheel deflection angles, an optimized final trajectory can be acquired.
[0063] Fig. 3 is a structural block diagram of the trajectory planning apparatus provided in embodiments of the present invention.
[0064] As shown in Fig. 3, the trajectory planning apparatus 200 comprises: a reference trajectory acquisition module 201 , a model establishing module 202 and a final trajectory acquisition module 203.
[0065] The reference trajectory acquisition module 201 is configured to acquire a reference trajectory of a predetermined planning interval on the basis of vehicle information, environment information and end point information. Global trajectory planning may be performed first, on the basis of vehicle information and end point information, to obtain a global trajectory from a start point to an end point, and preliminarily determine a position and speed of the vehicle 1 at each moment. Local trajectory planning is then performed; in the process of local trajectory planning, the already-planned global trajectory is used as a basis, then small-range, smalltimescale trajectory planning is performed with reference to obstacle information acquired by various sensors, so as to obtain a reference trajectory of a predetermined planning interval. The model establishing module 202 is configured to establish a vehicle kinematic model in a road coordinate system on the basis of vehicle information and the reference trajectory. The final trajectory acquisition module 204 is configured to use a model predictive controller to determine a sequence of control quantities in a predetermined planning interval according to the reference trajectory, vehicle information and the vehicle kinematic model, and obtain a final trajectory on the basis of the sequence of control quantities.
[0066] Fig. 4 is a structural block diagram of an electronic device 300 provided in embodiments of the present invention. As shown in Fig. 4, the present invention further provides an electronic device 300, the electronic device 300 comprising a processor and a memory; at least one instruction or at least one program is stored in the memory, the at least one instruction or the at least one program being loaded by the processor and executing the local trajectory planning method described in the embodiments above.
[0067] The present invention further provides a computer storage medium, in which is stored at least one instruction or at least one program, the at least one instruction or at least one program being loaded and executed by the processor to realize the lane structure fusion method described in the embodiments above.
[0068] Optionally, in this embodiment, the storage medium may be located in at least one of multiple network servers of a computer network. Optionally, in this embodiment, the storage medium may include but is not limited to various media capable of storing program code, such as a USB stick, read-only memory (ROM), random access memory (RAM), external hard drive, magnetic disk or optical disk.
[0069] Those skilled in the art should be able to realize that the modules, units and method steps in the examples described with reference to the embodiments disclosed herein can be realized with electronic hardware, computer software or a combination of both. In order to clearly explain the interchangeability of electronic hardware and software, the composition and steps of each example have already been described in general terms according to functions in the description above. Whether these functions are ultimately executed with electronic hardware or software depends on the specific application of the technical solution and design constraints. Those skilled in the art may use different methods to implement the described functions for each specific application, but such implementations should not be regarded as exceeding the scope of the present invention.
[0070] Although the present invention has been described with reference to the current particular embodiments, those skilled in the art should realize that the inventive scope involved in the present invention is not limited to the technical solution formed by a specific combination of the technical features mentioned above, and should also encompass other technical solutions formed by any combination of the abovementioned technical features or their equivalent features without departing from the inventive concept. Examples are technical solutions formed by mutual replacement of the abovementioned features and technical features disclosed in the present invention and (but not limited to) having similar functions.

Claims

Claims
1. A trajectory planning method, comprising the following steps: acquiring a reference trajectory of a predetermined planning interval on the basis of vehicle information, environment information and end point information; establishing a vehicle kinematic model in a road coordinate system on the basis of the vehicle information and the reference trajectory; and using a model predictive controller to determine a sequence of control quantities in a predetermined planning interval according to the reference trajectory, the vehicle information and the vehicle kinematic model, and obtaining a final trajectory on the basis of the sequence of control quantities.
2. The trajectory planning method as claimed in claim 1 , wherein the step of using a model predictive controller to determine a sequence of control quantities in a predetermined planning interval according to the reference trajectory, the vehicle information and the vehicle kinematic model, and obtaining a final trajectory on the basis of the sequence of control quantities, comprises: linearizing the vehicle kinematic model, to obtain a time domain linearized vehicle model and a space domain linearized vehicle model; the model predictive controller comprising a longitudinal control model and a transverse control model, designing a cost function of the longitudinal control model and a cost function of the transverse control model, and determining a sequence of control quantities of a predetermined planning interval on the basis of the cost function of the longitudinal control model, the cost function of the transverse control model, the time domain linearized vehicle model and the space domain linearized vehicle model; and acquiring a final trajectory on the basis of the sequence of control quantities.
3. The trajectory planning method as claimed in claim 2, wherein the control quantities comprise: desired acceleration and desired front wheel deflection angle.
4. The trajectory planning method as claimed in claim 2 or 3, wherein based on a situation where the yaw angle <p and the deflection angle [3 of the centre of mass of the vehicle are small, the vehicle kinematic model is linearized to obtain the time domain linearized vehicle model and the space domain linearized vehicle model.
5. The trajectory planning method as claimed in claim 3, wherein the longitudinal control model is established in the time domain, state quantities thereof comprise longitudinal position, speed and acceleration, and the sequence of desired accelerations among the control quantities is determined on the basis of the cost function of the longitudinal control model and the time domain linearized vehicle model.
6. The trajectory planning method as claimed in claim 3, wherein the transverse control model is established in the space domain, state quantities thereof comprise transverse position, yaw angle and front wheel deflection angle, and the sequence of desired front wheel deflection angles among the control quantities is determined on the basis of the cost function of the transverse control model and the space domain linearized vehicle model.
7. The trajectory planning method as claimed in claim 5, wherein the cost function of the longitudinal control model comprises a first term and a second term, the first term representing minimization of state cost and control cost, and the second term representing end state cost.
8. The trajectory planning method as claimed in claim 6, wherein the cost function of the transverse control model comprises a third term and a fourth term, the third term representing minimization of state cost and control cost, and the fourth term representing end state cost.
9. The trajectory planning method as claimed in claim 5 or 7, wherein the cost function of the longitudinal control model comprises weights corresponding to longitudinal position error, speed error, acceleration error and desired acceleration.
10. The trajectory planning method as claimed in claim 6 or 8, wherein the cost function of the transverse control model comprises weights corresponding to transverse position error, yaw angle, front wheel deflection angle and desired front wheel deflection angle.
11. The trajectory planning method as claimed in claim 1 , wherein the step of acquiring a reference trajectory of a predetermined planning interval on the basis of vehicle information, environment information and end point information, comprises: performing global trajectory planning on the basis of vehicle information and end point information, to obtain a global trajectory from a start point to an end point; and judging whether a collision will occur on the basis of environment information and the global trajectory; if a collision will occur, then performing local trajectory planning to obtain the reference trajectory; if no collision will occur, then acquiring the reference trajectory on the basis of the global trajectory.
12. A trajectory planning apparatus, comprising: a reference trajectory acquisition module, configured to acquire a reference trajectory of a predetermined planning interval on the basis of vehicle information, environment information and end point information; a model establishing module, configured to establish a vehicle kinematic model in a road coordinate system on the basis of the vehicle information and the reference trajectory; and a final trajectory acquisition module, configured to use a model predictive controller to determine a sequence of control quantities in a predetermined planning interval according to the reference trajectory, the vehicle information and the vehicle kinematic model, and obtain a final trajectory on the basis of the sequence of control quantities.
13. An electronic device, wherein the electronic device comprises a processor and a memory, and at least one instruction or at least one program is stored in the memory, the at least one instruction or the at least one program being loaded by the processor and executing the method as claimed in any one of claims 1 - 11 .
14. A computer storage medium, wherein the computer storage medium stores an instruction for execution by a computing device, and when the computing device executes the instruction, the method as claimed in any one of claims 1 - 11 is realized.
EP23758623.5A 2022-09-02 2023-08-18 Trajectory planning method and apparatus, device and storage medium Pending EP4581445A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202211074939.3A CN117681898A (en) 2022-09-02 2022-09-02 Trajectory planning method, device, equipment, storage medium
PCT/EP2023/072833 WO2024046789A1 (en) 2022-09-02 2023-08-18 Trajectory planning method and apparatus, device and storage medium

Publications (1)

Publication Number Publication Date
EP4581445A1 true EP4581445A1 (en) 2025-07-09

Family

ID=87797807

Family Applications (1)

Application Number Title Priority Date Filing Date
EP23758623.5A Pending EP4581445A1 (en) 2022-09-02 2023-08-18 Trajectory planning method and apparatus, device and storage medium

Country Status (3)

Country Link
EP (1) EP4581445A1 (en)
CN (1) CN117681898A (en)
WO (1) WO2024046789A1 (en)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN118112935B (en) * 2024-04-23 2024-07-23 上海易咖智车科技有限公司 Vehicle path tracking control method, device, equipment and storage medium
CN119749588A (en) * 2024-07-31 2025-04-04 比亚迪股份有限公司 Vehicle control method, vehicle and storage medium
CN121363965B (en) * 2025-12-23 2026-03-24 江苏龙威中科技术有限公司 A sensor-based method and system for navigating motion trajectories in signal-free areas

Also Published As

Publication number Publication date
CN117681898A (en) 2024-03-12
WO2024046789A1 (en) 2024-03-07

Similar Documents

Publication Publication Date Title
EP4581445A1 (en) Trajectory planning method and apparatus, device and storage medium
CN111923905B (en) System and method for estimating trajectory
Dai et al. Modeling vehicle interactions via modified LSTM models for trajectory prediction
Wang et al. A reinforcement learning based approach for automated lane change maneuvers
CN110162046A (en) Unmanned vehicle path following method based on event trigger type model predictive control
Xu et al. Tell-drive: Enhancing autonomous driving with teacher llm-guided deep reinforcement learning
Németh et al. Optimal control of overtaking maneuver for intelligent vehicles
CN109808707A (en) A kind of auto steering control method and controller based on stochastic model prediction
CN111857112B (en) A vehicle local path planning method and electronic device
CN116501056B (en) Vehicle trajectory tracking control methods and devices, unmanned vehicles and storage media
Lee Efficient perception, planning, and control algorithm for vision-based automated vehicles: DH Lee
Rasib et al. Are Self‐Driving Vehicles Ready to Launch? An Insight into Steering Control in Autonomous Self‐Driving Vehicles
Li et al. Four-wheel steering vehicle trajectory tracking control based on PSO optimized MPC
Peng et al. Lane‐change model and tracking control for autonomous vehicles on curved highway sections in rainy weather
Yu et al. Parallel parking path planning and tracking control based on simulated annealing algorithm
CN115511222B (en) Vehicle state prediction method and device, electronic equipment and storage medium
CN115092176B (en) Automobile, pre-aiming control method and device thereof and storage medium
Kanarachos A new min-max methodology for computing optimised obstacle avoidance steering manoeuvres of ground vehicles
CN115903851A (en) A self-driving vehicle trajectory tracking control method based on adaptive learning
Zhang et al. Real-time Improvement Measures of Nonlinear Model Predictive Control for Intelligent Vehicle Trajectory Tracking
Flad et al. Individual driver modeling via optimal selection of steering primitives
WO2026026110A1 (en) Control method for vehicle, and vehicle and storage medium
CN116729361B (en) Vehicle transverse control method and device
CN116841298B (en) Finite time tracking control method suitable for four-wheel mobile robot lane change early warning
CN116400707A (en) Vehicle trajectory tracking control method and device, unmanned vehicle and storage medium

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: 20250402

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 ME MK MT NL NO PL PT RO RS SE SI SK SM TR

RAP3 Party data changed (applicant data changed or rights of an application transferred)

Owner name: AUMOVIO AUTONOMOUS MOBILITY GERMANY GMBH

DAV Request for validation of the european patent (deleted)
DAX Request for extension of the european patent (deleted)