[go: up one dir, main page]

CN115257724B - A plug-in hybrid vehicle safety and energy-saving decision control method and system - Google Patents

A plug-in hybrid vehicle safety and energy-saving decision control method and system Download PDF

Info

Publication number
CN115257724B
CN115257724B CN202210802285.5A CN202210802285A CN115257724B CN 115257724 B CN115257724 B CN 115257724B CN 202210802285 A CN202210802285 A CN 202210802285A CN 115257724 B CN115257724 B CN 115257724B
Authority
CN
China
Prior art keywords
vehicle
safety
obstacle
speed
longitudinal
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.)
Active
Application number
CN202210802285.5A
Other languages
Chinese (zh)
Other versions
CN115257724A (en
Inventor
赵治国
李涛
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.)
Tongji University
Original Assignee
Tongji University
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 Tongji University filed Critical Tongji University
Priority to CN202210802285.5A priority Critical patent/CN115257724B/en
Publication of CN115257724A publication Critical patent/CN115257724A/en
Application granted granted Critical
Publication of CN115257724B publication Critical patent/CN115257724B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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
    • 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
    • B60W20/00Control systems specially adapted for hybrid vehicles
    • 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
    • B60W20/00Control systems specially adapted for hybrid vehicles
    • B60W20/10Controlling the power contribution of each of the prime movers to meet required power demand
    • 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
    • B60W20/00Control systems specially adapted for hybrid vehicles
    • B60W20/10Controlling the power contribution of each of the prime movers to meet required power demand
    • B60W20/11Controlling the power contribution of each of the prime movers to meet required power demand using model predictive control [MPC] strategies, i.e. control methods based on models predicting performance
    • 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
    • B60W20/00Control systems specially adapted for hybrid vehicles
    • B60W20/10Controlling the power contribution of each of the prime movers to meet required power demand
    • B60W20/12Controlling the power contribution of each of the prime movers to meet required power demand using control strategies taking into account route information
    • 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
    • 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/09Taking automatic action to avoid collision, e.g. braking and steering
    • 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/0956Predicting travel path or likelihood of collision the prediction being responsive to traffic or environmental 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
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/10Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
    • B60W40/105Speed
    • 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
    • B60W50/0098Details of control systems ensuring comfort, safety or stability not otherwise provided for
    • 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
    • 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
    • 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
    • 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/0043Signal treatments, identification of variables or parameters, parameter estimation or state estimation
    • 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/0043Signal treatments, identification of variables or parameters, parameter estimation or state estimation
    • B60W2050/0052Filtering, filters
    • 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
    • B60W2552/00Input parameters relating to infrastructure
    • B60W2552/50Barriers
    • 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
    • B60W2554/00Input parameters relating to objects
    • B60W2554/40Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404Characteristics
    • 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
    • B60W2554/00Input parameters relating to objects
    • B60W2554/40Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404Characteristics
    • B60W2554/4042Longitudinal 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
    • B60W2554/00Input parameters relating to objects
    • B60W2554/40Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404Characteristics
    • B60W2554/4043Lateral 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
    • B60W2554/00Input parameters relating to objects
    • B60W2554/80Spatial relation or speed relative to objects
    • 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
    • B60W50/0097Predicting future conditions

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Electric Propulsion And Braking For Vehicles (AREA)

Abstract

本发明涉及一种插电式混动汽车安全节能决策控制方法和系统,该方法包括以下步骤:获取目标车辆周围的环境信息,对障碍物进行过滤,确定危险障碍物;对自车和危险障碍物分别进行轨迹预测和碰撞检测,采用博弈决策理论进行自车安全行为决策;基于自车安全行为决策结果,建立离散状态下车辆纵向动力学状态模型,以系统能量消耗最小车辆燃油经济性、安全性和驾驶舒适性构建多目标协调代价优化函数,规划局部行驶轨迹与纵向安全经济车速;根据规划得到的纵向安全经济车速,采用模型预测控制算法进行纵向车速跟随,得到车辆目标需求驱动转矩,对目标车辆进行控制。与现有技术相比,本发明在保证车辆安全行驶前提下,充分挖掘了插电式混合动力节能潜力。

The present invention relates to a plug-in hybrid vehicle safety and energy-saving decision-making control method and system, the method comprising the following steps: obtaining environmental information around a target vehicle, filtering obstacles, and determining dangerous obstacles; performing trajectory prediction and collision detection on the vehicle and dangerous obstacles respectively, and using game decision theory to make decisions on the safety behavior of the vehicle; based on the results of the safety behavior decision of the vehicle, establishing a vehicle longitudinal dynamic state model under a discrete state, constructing a multi-objective coordinated cost optimization function with the minimum system energy consumption, vehicle fuel economy, safety and driving comfort, planning local driving trajectory and longitudinal safety and economic speed; according to the longitudinal safety and economic speed obtained by planning, using a model predictive control algorithm to follow the longitudinal speed, obtain the vehicle target demand driving torque, and control the target vehicle. Compared with the prior art, the present invention fully taps the energy-saving potential of plug-in hybrid vehicles under the premise of ensuring safe driving of the vehicle.

Description

Safety energy-saving decision control method and system for plug-in hybrid electric vehicle
Technical Field
The invention relates to the technical field of energy-saving control of hybrid electric vehicles, in particular to a safety energy-saving decision control method and system for a plug-in hybrid electric vehicle.
Background
Plug-in Hybrid ELECTRIC VEHICLE, PHEV is a new energy automobile with the advantages of both pure electric and Hybrid electric automobiles, and can charge a power battery by utilizing the surplus power of an external power grid and an engine, reasonably distribute the output energy of electric energy and mechanical energy in a power system in the driving process, fully exert the advantages of Plug-in Hybrid power configuration and improve the fuel economy of the automobile. The working mode of the power system is closely related to the instantaneous driving working condition, and the problems of different modes and switching coordination control thereof under different working conditions need to be considered.
At present, the intelligent safety decision in the instant traffic environment has the problems of low control dimension and poor energy coordination and optimization control energy-saving effect, and a novel plug-in hybrid electric vehicle safety energy-saving decision control method and system are needed to be designed so as to fully exploit the plug-in hybrid power energy-saving potential.
Disclosure of Invention
The invention aims to overcome the defects of the prior art and provide a safety energy-saving decision control method and a system for a plug-in hybrid electric vehicle, which can fully dig the energy-saving potential of the plug-in hybrid electric vehicle.
The aim of the invention can be achieved by the following technical scheme:
According to a first aspect of the invention, a safety energy-saving decision control method of a plug-in hybrid electric vehicle is provided, and the method comprises the following steps:
s1, acquiring environmental information around a target vehicle, filtering obstacles, and determining dangerous obstacles; track prediction and collision detection are respectively carried out on the self-vehicle and the dangerous obstacle, and a game decision theory is adopted to carry out self-vehicle safety behavior decision;
Step S2, based on a self-vehicle safety behavior decision result, a vehicle longitudinal dynamics state model in a discrete state is established, a multi-objective coordination cost optimization function is established according to the minimum system energy consumption vehicle fuel economy, safety and driving comfort, and a local running track and a longitudinal safety economic vehicle speed are planned;
And step S3, according to the planned longitudinal safe economic vehicle speed, adopting a model predictive control algorithm to carry out longitudinal vehicle speed following, obtaining a vehicle target required driving torque, and controlling a target vehicle.
Preferably, in the step S1, environmental information around the target vehicle is obtained, the obstacle is filtered, and the dangerous obstacle is determined, which specifically is:
1) Performing a preliminary filtering according to the presence or absence of a lateral velocity of the obstacle relative to the trajectory of the vehicle, comprising:
filtering obstacles which have transverse and longitudinal speeds smaller than a set value and are not on the track of the vehicle;
track prediction is carried out based on the positions and speeds of the vehicle and the obstacle at the current moment, and when the motion trends of the two vehicles are separated, filtering is carried out;
2) And determining a filtering area of the own vehicle according to the position, the speed boundary and the movement trend of the obstacle relative to the own vehicle, filtering the obstacle which is outside the filtering area of the own vehicle and has no transverse speed on the track again, and determining the dangerous obstacle.
Preferably, the track prediction in step S1 is specifically:
And (5) predicting a self-vehicle track: predicting a running track and a vehicle posture of a vehicle in the future for a period of time according to the position, the course angle, the driving operation characteristic and the vehicle dynamics characteristic of the target vehicle at the current moment, wherein the running track and the vehicle posture comprise track points, the time for reaching the track points and the vehicle posture;
Obstacle trajectory prediction: judging the behaviors and driving style probability of the obstacle according to the historical data of the obstacle, and predicting the obstacle track for a long time by adopting a multi-source information fusion method to obtain the contour and the transverse and longitudinal speeds of the obstacle in a future period of time.
Preferably, the collision detection in step S1 specifically includes:
Traversing the track predicted positions of all dangerous obstacles and the track predicted positions of the vehicle, judging whether collision conflict exists or not from two dimensions of time and distance, and recording obstacle conflict information including the transverse and longitudinal speeds of the obstacles and the time of reaching a conflict point and vehicle conflict information including the time of reaching the conflict point and the distance of the conflict point of the vehicle.
Preferably, in the step S1, a game decision theory is adopted to make a decision on the safety behavior of the vehicle, specifically:
1) When the vehicle runs straight, dangerous obstacles run in the front or at the left and right sides, and reach a predicted conflict point in advance of the vehicle for a certain time, the vehicle runs without acceleration;
2) When the vehicle moves straight, the dangerous obstacle runs in the front or at the left and right sides, and reaches the predicted conflict point in a certain time range simultaneously with the vehicle, and the vehicle runs at a reduced speed if collision risk exists;
3) When the vehicle runs straight, dangerous obstacles run in the front or at the left and right sides, no conflict exists between the dangerous obstacles and the vehicle, and the vehicle runs normally;
4) When the vehicle turns, the dangerous obstacle runs in front, and reaches the predicted conflict point simultaneously with the vehicle within a certain time range, and the vehicle runs at a reduced speed with collision risk.
Preferably, the step S2 specifically includes:
Virtualizing dangerous obstacle track prediction, track curvature limitation and safety behavior decision results into control targets, constructing a discrete vehicle longitudinal dynamics model, taking vehicle fuel economy, safety and driving comfort as optimization targets, constructing a multi-target coordination cost optimization function, combining a vehicle running track and an optimal control algorithm under a system constraint condition, planning longitudinal vehicle speed point by point, updating the state of a target object in real time, and dynamically updating local longitudinal safety speed planning according to actual vehicle speed;
When the self-vehicle makes a deceleration and non-acceleration safety behavior decision, planning a local longitudinal safety economic vehicle speed, and intervening in driving demand power in advance.
Preferably, the longitudinal dynamics model of the vehicle in the step S2 is expressed in mathematical expression:
y(k)=Cx(k)
where x is a state variable, k represents the kth sampling time, Representing a system matrix, wherein y is a system output, C is an output matrix, u is a control input, the speed or acceleration of the vehicle is used as a control quantity, w is a system disturbance, and the speed or acceleration of an obstacle is used as a disturbance quantity.
Preferably, the multi-objective coordination cost optimization function in step S2 has the expression:
J=JF+Js+Jc
Js=wΔdΔd2+wΔvΔv2
JC=waaf 2
Wherein J F is a fuel economy optimization performance index, w u is a desired acceleration weight coefficient, and w du is a weight coefficient of a desired acceleration change rate; j s is a system safety tracking performance index, w Δd is a vehicle spacing error weight coefficient, deltad is a vehicle spacing, w Δv is a vehicle relative speed weight coefficient, deltav is a relative speed; j C is a vehicle comfort performance index, w a is a longitudinal acceleration weight coefficient, and a f is a longitudinal acceleration.
Wherein the multi-objective coordination cost function satisfies constraints in terms of vehicle economy, safety and comfort performance as constraints of comprehensive performance.
Preferably, in the step S3, a model predictive control algorithm is adopted to perform longitudinal vehicle speed following control, specifically:
Selecting the square accumulation of the difference value between the output quantity y p (i|k) and the target vehicle speed v (i) in a prediction time domain window T p = [ k+1:k+p ], optimizing to obtain a control variable sequence with the minimum target function in the corresponding prediction time domain, taking the first value in the sequence as the total required torque value of the current vehicle, and repeating the process at the next moment;
umin≤u≤umax
Wherein the target vehicle speed v (i) is a vehicle longitudinal safe economic vehicle speed reference curve, the output quantity of y p (i|k) obtained by real-time iteration of a vehicle dynamics model is u min、umax, and the current upper limit and the lower limit of the required torque are represented.
According to a second aspect of the present invention, a system based on the plug-in hybrid electric vehicle safety energy-saving decision control method is provided, the system comprises:
the environment sensing module is used for acquiring environment information around the target vehicle through the intelligent sensor, including obstacle information;
the obstacle filtering module is used for filtering obstacles around the target vehicle to obtain dangerous obstacles;
The track prediction module is used for predicting the track of the dangerous obstacle and the vehicle obtained by the obstacle filtering module;
the collision detection module is used for detecting the collision of the dangerous obstacle obtained by the obstacle filtering module and the own vehicle;
The safety behavior decision module is used for making a self-vehicle safety behavior decision based on track prediction and collision detection results;
The local longitudinal speed planning module is used for planning the vehicle speed based on the vehicle safety behavior decision result to obtain the longitudinal safety economic vehicle speed;
And the speed following control module is used for carrying out longitudinal speed following control of the bicycle.
Compared with the prior art, the invention has the following advantages:
1) According to the real-time decision control method provided by the invention, on the premise of ensuring the safety of the vehicle in the dynamic traffic environment, the vehicle economy is taken as a constraint condition in the steps of behavior decision, speed planning and vehicle speed following, so that the fuel economy of the plug-in hybrid electric vehicle can be further improved, and the problems of low intelligent safety decision control dimension and poor energy coordination optimization control energy-saving effect in the current instantaneous traffic environment are solved;
2) The collision detection times are reduced by filtering the obstacles around the target vehicle for a plurality of times;
3) When the self-vehicle makes a deceleration and non-acceleration safety decision, the driving demand power is intervened in advance by further planning the local longitudinal safety economic vehicle speed, so that the energy loss caused by rapid acceleration and rapid deceleration is avoided, the torques of the engine and the motor are reasonably distributed, and the economical efficiency of the vehicle is improved;
4) The intelligent sensing technology based on the intelligent sensor provides a way for acquiring short-distance working condition information, and the intelligent auxiliary controller improves the calculation force and provides calculation force support for multi-source information fusion and obstacle motion prediction.
Drawings
FIG. 1 is a flow chart of the method of the present invention;
FIG. 2 is a control flow diagram of the present invention;
FIG. 3 is a schematic diagram of trajectory prediction;
FIG. 4 is a schematic diagram of filtering obstacles according to movement trends;
FIG. 5 is a schematic view of a vehicle filtration zone.
Detailed Description
The following description of the embodiments of the present invention will be made clearly and fully with reference to the accompanying drawings, in which it is evident that the embodiments described are some, but not all embodiments of the invention. All other embodiments, which can be made by those skilled in the art based on the embodiments of the present invention without making any inventive effort, shall fall within the scope of the present invention.
Examples
Firstly, an embodiment of the method of the invention is provided, and the method comprises the following steps:
s1, acquiring environmental information around a target vehicle, filtering obstacles, and determining dangerous obstacles; track prediction and collision detection are respectively carried out on the self-vehicle and the dangerous obstacle, and a game decision theory is adopted to carry out self-vehicle safety behavior decision;
A, filtering obstacle:
1) Performing a preliminary filtering according to the presence or absence of a lateral velocity of the obstacle relative to the trajectory of the vehicle, comprising:
filtering obstacles which have transverse and longitudinal speeds smaller than a set value and are not on the track of the vehicle;
track prediction is carried out based on the positions and speeds of the vehicle and the obstacle at the current moment, and when the movement trends of the two vehicles are separated, filtering is carried out, as shown in fig. 4;
2) And determining the size of a vehicle filtering area according to the transverse offset of the vehicle track, the course angle of the vehicle, the intersection mark, the lane mark and the like by taking the current position of the vehicle as a reference, and determining the vehicle filtering area, and filtering the obstacles which are outside the vehicle filtering area and have no transverse speed on the track again as shown in fig. 5, thereby reducing the collision detection times.
B, track prediction:
And (5) predicting a self-vehicle track: predicting a running track and a vehicle posture of a vehicle in the future for a period of time according to the position, the course angle, the driving operation characteristic and the vehicle dynamics characteristic of the target vehicle at the current moment, wherein the running track and the vehicle posture comprise track points, the time for reaching the track points and the vehicle posture;
Obstacle trajectory prediction: judging the behaviors and driving style probability of the obstacle according to the historical data of the obstacle, and predicting the obstacle track for a long time by adopting a multi-source information fusion method to obtain the contour and the transverse and longitudinal speeds of the obstacle in a future period of time.
C, collision detection:
Traversing the track predicted positions of all dangerous obstacles and the track predicted positions of the vehicle, judging whether collision conflict exists or not from two dimensions of time and distance, and recording obstacle conflict information including the transverse and longitudinal speeds of the obstacles and the time of reaching a conflict point and vehicle conflict information including the time of reaching the conflict point and the distance of the conflict point of the vehicle.
D, vehicle safety behavior decision, as shown in table 1:
TABLE 1
Step S2, based on a self-vehicle safety behavior decision result, virtualizing dangerous obstacle track prediction, track curvature limitation and safety behavior decision result into control targets, constructing a discrete vehicle longitudinal dynamics model, constructing a multi-target coordination cost optimization function by taking vehicle fuel economy, safety and driving comfort as optimization targets, carrying out longitudinal vehicle speed planning point by combining a self-vehicle running track and an optimal control algorithm under a system constraint condition, updating the state of a target object in real time, and dynamically updating local longitudinal safety speed planning according to the actual vehicle speed;
When the self-vehicle makes a deceleration and non-acceleration safety behavior decision, planning a local longitudinal safety economic vehicle speed, and intervening in driving demand power in advance.
The longitudinal dynamics model of the vehicle has the mathematical expression:
y(k)=Cx(k)
where x is a state variable, k represents the kth sampling time, Representing a system matrix, wherein y is a system output, C is an output matrix, u is a control input, the speed or acceleration of the vehicle is used as a control quantity, w is a system disturbance, and the speed or acceleration of an obstacle is used as a disturbance quantity.
The multi-objective coordination cost optimization function has the expression:
J=JF+Js+Jc
Js=wΔdΔd2+wΔvΔv2
JC=waaf 2
Wherein J F is a fuel economy optimization performance index, w u is a desired acceleration weight coefficient, and w du is a weight coefficient of a desired acceleration change rate; j s is a system safety tracking performance index, w Δd is a vehicle spacing error weight coefficient, deltad is a vehicle spacing, w Δv is a vehicle relative speed weight coefficient, deltav is a relative speed; j C is a vehicle comfort performance index, w a is a longitudinal acceleration weight coefficient, and a f is a longitudinal acceleration.
Wherein the multi-objective coordination cost function satisfies constraints in terms of vehicle economy, safety and comfort performance as constraints of comprehensive performance.
Step S3, according to the longitudinal safe economic vehicle speed obtained by planning, adopting a model predictive control algorithm to carry out longitudinal vehicle speed following to obtain a vehicle target demand driving torque, and controlling a target vehicle, wherein the method specifically comprises the following steps:
the longitudinal vehicle speed following control is carried out by adopting a model predictive control algorithm, and specifically comprises the following steps:
Selecting the square accumulation of the difference value between the output quantity y p (i|k) and the target vehicle speed v (i) in a prediction time domain window T p = [ k+1:k+p ], optimizing to obtain a control variable sequence with the minimum target function in the corresponding prediction time domain, taking the first value in the sequence as the total required torque value of the current vehicle, and repeating the process at the next moment;
umin≤u≤umax
Wherein the target vehicle speed v (i) is a vehicle longitudinal safe economic vehicle speed reference curve, the output quantity of y p (i|k) obtained by real-time iteration of a vehicle dynamics model is u min、umax, and the current upper limit and the lower limit of the required torque are represented.
The method of the present embodiment will be described in detail with reference to the accompanying drawings.
As shown in fig. 2:
(1) And (5) predicting a self-vehicle track:
The running track of the vehicle is predicted according to the operation of the driver (accelerator opening, brake opening, steering lamp and steering wheel angle) and the feedback of the state of the vehicle (navigation line, speed and lane line). Based on the dynamics of the vehicle, the current speed is kept unchanged, and the vehicle posture on the future track is predicted, wherein the vehicle posture comprises the contour, arrival time and other information of the vehicle at each track point.
(2) Obstacle trajectory prediction:
Firstly, filtering the obstacle, and obtaining local road condition information such as the distance, speed and position of the obstacle around the vehicle based on an intelligent sensor, wherein the obstacle is filtered, as shown in fig. 3, v_self represents the speed of the vehicle, and v_obs represents the vector speed of the obstacle. Firstly, filtering an obstacle OBS_2, an obstacle OBS_4 and an obstacle OBS_5 which are outside an area and have no transverse speed on a track according to a static obstacle filtering mode; and predicting a running track according to the state of the vehicle according to a dynamic obstacle filtering mode, predicting the track according to the position and the speed of the obstacle at the current moment, and filtering out the obstacle OBS_3 when the two movement trends are separated.
Then, the pose of the obstacle which does not meet the obstacle filtering rule is predicted, as shown in fig. 3, which is an obs_1 obstacle, taking the state of the obstacle at time t0 as an example, the initial position of the obstacle is (x 0, y 0), the current speed of the obstacle is (vx, vy), and after the time t passes, the new obstacle position (x 1, y 1) can be expressed as the following formula, so that the coordinates and the pose of each position of the obstacle in the predicted time can be calculated.
(3) Collision detection:
And traversing all dangerous obstacle track predicted positions and vehicle track predicted positions according to the obstacle filtering result, judging whether collision conflict exists or not from two dimensions of time and distance, and recording information such as the transverse and longitudinal speeds of the obstacle, the time to reach the conflict point of the vehicle, the distance of the conflict point and the like if the collision conflict occurs.
(4) Safety decision:
The road weight and game decision theory is adopted, and the following safety decision behavior is adopted for collision information of the vehicle and the obstacle. When the vehicle moves straight, the most dangerous obstacle runs in the front or at the left and right sides, and reaches the predicted conflict point in advance of the vehicle for a certain time, the vehicle runs without acceleration.
(5) Local longitudinal speed planning:
The vehicle speed track planned by the vehicle is shown in fig. 3, the vehicle speed at the t time is P (x t,yt,vt), the driving demand power is intervened in advance by planning the local economic vehicle speed, the energy loss caused by rapid acceleration and rapid deceleration is avoided, the torques of the engine and the motor are reasonably distributed, and the economical efficiency of the vehicle is improved.
(6) Track following:
According to the planned local economic speed, in order to enable the vehicle to stably, safely and accurately track the expected track, a model predictive control algorithm is adopted for follow control. And selecting the square accumulation of the difference value between the output quantity y p (i|k) and the target track r (i) in a prediction time domain window (T p = [ k+1:k+p ]), obtaining a control variable sequence with the minimum target function in the corresponding prediction time domain through an optimization algorithm, taking the first value as the total required torque value of the current whole vehicle, and repeating the process at the next moment.
umin≤u≤umax
Wherein the target speed v (i) is a reference vehicle speed curve for vehicle speed track planning, y p (i|k) is obtained by real-time iteration of a vehicle dynamics model, and u min、umax represents upper and lower limits of the current required torque.
The embodiment of the system of the invention is provided next, a system based on the plug-in hybrid electric vehicle safety energy-saving decision control method, the system comprises:
the environment sensing module is used for acquiring environment information around the target vehicle through the intelligent sensor, including obstacle information;
the obstacle filtering module is used for filtering obstacles around the target vehicle to obtain dangerous obstacles;
The track prediction module is used for predicting the track of the dangerous obstacle and the vehicle obtained by the obstacle filtering module;
the collision detection module is used for detecting the collision of the dangerous obstacle obtained by the obstacle filtering module and the own vehicle;
The safety behavior decision module is used for making a self-vehicle safety behavior decision based on track prediction and collision detection results;
The local longitudinal speed planning module is used for planning the vehicle speed based on the vehicle safety behavior decision result to obtain the longitudinal safety economic vehicle speed;
And the speed following control module is used for carrying out longitudinal speed following control of the bicycle.
While the invention has been described with reference to certain preferred embodiments, it will be understood by those skilled in the art that various changes and substitutions of equivalents may be made and equivalents will be apparent to those skilled in the art without departing from the scope of the invention. Therefore, the protection scope of the invention is subject to the protection scope of the claims.

Claims (9)

1.一种插电式混动汽车安全节能决策控制方法,其特征在于,该方法包括以下步骤:1. A plug-in hybrid vehicle safety and energy-saving decision control method, characterized in that the method comprises the following steps: 步骤S1、获取目标车辆周围的环境信息,对障碍物进行过滤,确定危险障碍物;对自车和危险障碍物分别进行轨迹预测和碰撞检测,采用博弈决策理论进行自车安全行为决策;Step S1, obtaining environmental information around the target vehicle, filtering obstacles, and determining dangerous obstacles; performing trajectory prediction and collision detection on the ego vehicle and dangerous obstacles respectively, and using game decision theory to make decisions on the ego vehicle's safety behavior; 步骤S2、基于自车安全行为决策结果,建立离散状态下车辆纵向动力学状态模型,以系统能量消耗最小车辆燃油经济性、安全性和驾驶舒适性构建多目标协调代价优化函数,规划局部行驶轨迹与纵向安全经济车速;Step S2: Based on the decision result of the vehicle safety behavior, a vehicle longitudinal dynamic state model under discrete state is established, a multi-objective coordinated cost optimization function is constructed with the minimum system energy consumption, vehicle fuel economy, safety and driving comfort, and the local driving trajectory and longitudinal safety and economic speed are planned; 所述多目标协调代价优化函数,表达式为:The multi-objective coordination cost optimization function is expressed as: J=JF+Js+Jc J=J F +J s +J c Js=wΔdΔd2+wΔvΔv2 J s =w Δd Δd 2 +w Δv Δv 2 JC=waaf 2 J C = w a a f 2 式中,JF为燃油经济性优化性能指标,wu为期望加速度权重系数,wdu为期望加速度变化率的权重系数;Js为系统安全跟踪性能指标,wΔd为车辆间距误差权重系数,Δd为车辆间距,wΔv为车辆相对速度权重系数,Δv为相对速度;JC为车辆舒适性性能指标,wa为纵向加速度权重系数,af为纵向加速度;Wherein, J F is the fuel economy optimization performance index, w u is the expected acceleration weight coefficient, w du is the expected acceleration change rate weight coefficient; J s is the system safety tracking performance index, w Δd is the vehicle spacing error weight coefficient, Δd is the vehicle spacing, w Δv is the vehicle relative speed weight coefficient, Δv is the relative speed; J C is the vehicle comfort performance index, w a is the longitudinal acceleration weight coefficient, a f is the longitudinal acceleration; 其中,多目标协调代价函数满足车辆经济性、安全性和舒适性性能方面的约束作为综合性能的约束条件;Among them, the multi-objective coordination cost function satisfies the constraints of vehicle economy, safety and comfort performance as the constraints of comprehensive performance; 步骤S3、根据规划得到的纵向安全经济车速,采用模型预测控制算法进行纵向车速跟随,得到车辆目标需求驱动转矩,对目标车辆进行控制。Step S3: Based on the planned longitudinal safe and economical vehicle speed, a model predictive control algorithm is used to perform longitudinal vehicle speed following, obtain the vehicle target demand driving torque, and control the target vehicle. 2.根据权利要求1所述的一种插电式混动汽车安全节能决策控制方法,其特征在于,所述步骤S1中获取目标车辆周围的环境信息,对障碍物进行过滤,确定危险障碍物,具体为:2. A plug-in hybrid vehicle safety and energy-saving decision control method according to claim 1, characterized in that the environmental information around the target vehicle is obtained in step S1, obstacles are filtered, and dangerous obstacles are determined, specifically: 1)按照障碍物相对于自车轨迹有无横向速度进行初步过滤,包括:1) Perform preliminary filtering based on whether the obstacle has a lateral speed relative to the vehicle's trajectory, including: 对横纵向速度小于设定值且不在自车轨迹上的障碍物进行过滤;Filter obstacles whose lateral and longitudinal speeds are less than the set values and are not on the vehicle's trajectory; 基于当前时刻自车和障碍物的位置、速度,进行轨迹预测,当两车运动趋势相离,则过滤掉;Based on the current position and speed of the vehicle and the obstacle, the trajectory is predicted. If the two vehicles move in different directions, they are filtered out. 2)按照障碍物相对自车的位置、速度边界和运动趋势,确定自车过滤区域,对于自车过滤区域以外且在轨迹上无横向速度的障碍物进行再次过滤,确定危险障碍物。2) According to the position, speed boundary and movement trend of the obstacle relative to the ego vehicle, the ego vehicle filtering area is determined. Obstacles outside the ego vehicle filtering area and without lateral speed on the trajectory are filtered again to determine dangerous obstacles. 3.根据权利要求1所述的一种插电式混动汽车安全节能决策控制方法,其特征在于,所述步骤S1中的轨迹预测,具体为:3. The plug-in hybrid vehicle safety and energy-saving decision control method according to claim 1, characterized in that the trajectory prediction in step S1 is specifically: 自车轨迹预测:根据目标车辆当前时刻的位置、航向角、驾驶操作特性和车辆动力学特性,预测自车未来一段时间的行驶轨迹和自车姿态,包括轨迹点、到达轨迹点的时间和车辆姿态;Ego vehicle trajectory prediction: Based on the current position, heading angle, driving operation characteristics and vehicle dynamics characteristics of the target vehicle, the driving trajectory and attitude of the ego vehicle in the future are predicted, including the trajectory point, the time to reach the trajectory point and the vehicle attitude; 障碍物轨迹预测:依据障碍物历史数据判断障碍物的行为和驾驶风格概率,采用多源信息融合方法进行障碍物轨迹长时预测,得到未来一段时间内的障碍物轮廓和横纵向速度。Obstacle trajectory prediction: The obstacle behavior and driving style probability are judged based on the historical obstacle data, and the multi-source information fusion method is used to perform long-term obstacle trajectory prediction to obtain the obstacle contour and lateral and longitudinal speed in the future. 4.根据权利要求1所述的一种插电式混动汽车安全节能决策控制方法,其特征在于,所述步骤S1中的碰撞检测,具体为:4. The plug-in hybrid vehicle safety and energy-saving decision control method according to claim 1, characterized in that the collision detection in step S1 is specifically: 遍历所有危险障碍物的轨迹预测位置与自车轨迹预测位置,从时间和距离两个维度判断是否存在碰撞冲突,若发生冲突则记录障碍物冲突信息,包括障碍物横纵向速度和到达冲突点的时间,以及自车冲突信息,包括自车到达冲突点的时间和冲突点的距离。Traverse the predicted trajectory positions of all dangerous obstacles and the predicted trajectory positions of the ego vehicle, and determine whether there is a collision conflict from the two dimensions of time and distance. If a conflict occurs, record the obstacle conflict information, including the obstacle's lateral and longitudinal speeds and the time it arrives at the conflict point, as well as the ego vehicle conflict information, including the time the ego vehicle arrives at the conflict point and the distance from the conflict point. 5.根据权利要求1所述的一种插电式混动汽车安全节能决策控制方法,其特征在于,所述步骤S1中采用博弈决策理论进行自车安全行为决策,具体为:5. A plug-in hybrid vehicle safety and energy-saving decision control method according to claim 1, characterized in that the game decision theory is used in step S1 to make the vehicle safety behavior decision, specifically: 1)当自车直行,危险障碍物在前方或左右两侧行驶,较自车提前一定时间到达预测冲突点,则自车非加速行驶;1) When the vehicle is moving straight ahead and a dangerous obstacle is moving in front or on the left or right side and arrives at the predicted conflict point a certain time earlier than the vehicle, the vehicle does not accelerate; 2)当自车直行,危险障碍物在前方或左右两侧行驶,与自车在一定时间范围内同时到达预测冲突点,且存在碰撞风险,则自车减速行驶;2) When the vehicle is traveling straight ahead and a dangerous obstacle is traveling in front or on the left or right side, and reaches the predicted conflict point at the same time as the vehicle within a certain time range, and there is a risk of collision, the vehicle will slow down; 3)当自车直行,危险障碍物在前方或左右两侧行驶,与自车不存在冲突,自车正常行驶;3) When the vehicle is moving straight ahead, dangerous obstacles are moving in front or on the left or right sides, and there is no conflict with the vehicle, so the vehicle moves normally; 4)当自车转弯,危险障碍物在前方行驶,与自车在一定时间范围内同时到达预测冲突点,且存在碰撞风险,自车减速行驶。4) When the ego vehicle turns, a dangerous obstacle is moving ahead and reaches the predicted conflict point at the same time as the ego vehicle within a certain time range, and there is a risk of collision, so the ego vehicle slows down. 6.根据权利要求1所述的一种插电式混动汽车安全节能决策控制方法,其特征在于,所述步骤S2具体为:6. The plug-in hybrid vehicle safety and energy-saving decision control method according to claim 1, characterized in that the step S2 is specifically: 将危险障碍物轨迹预测、轨迹曲率限制、安全行为决策结果虚拟化为控制目标,构建离散的车辆纵向动力学模型,以车辆燃油经济性、安全性和驾驶舒适性为优化目标,构建多目标协调代价优化函数,在系统约束条件下,结合自车运行轨迹和最优控制算法,逐点进行纵向车速规划,并实时更新目标物体状态,依据实际车速动态更新局部纵向安全速度规划;The prediction of dangerous obstacle trajectories, trajectory curvature restrictions, and safety behavior decision results are virtualized as control targets, and a discrete vehicle longitudinal dynamics model is constructed. With vehicle fuel economy, safety, and driving comfort as optimization targets, a multi-objective coordinated cost optimization function is constructed. Under system constraints, the vehicle's running trajectory and the optimal control algorithm are combined to perform longitudinal vehicle speed planning point by point, and the target object state is updated in real time. The local longitudinal safety speed planning is dynamically updated according to the actual vehicle speed. 当自车进行减速、非加速的安全行为决策时,规划局部纵向安全经济车速,提前干预驾驶需求功率。When the vehicle makes a safety behavior decision of deceleration or non-acceleration, the local longitudinal safe and economical speed is planned to intervene in the driving demand power in advance. 7.根据权利要求6所述的一种插电式混动汽车安全节能决策控制方法,其特征在于,所述步骤S2中的车辆纵向动力学模型,数学表达式为:7. A plug-in hybrid vehicle safety and energy-saving decision control method according to claim 6, characterized in that the vehicle longitudinal dynamics model in step S2 is expressed as follows: 式中,x为状态变量,k代表第k个取样时间,代表系统矩阵,y为系统输出,C输出矩阵,u为控制输入,以自车速度或加速度为控制量,w为系统扰动,以障碍物速度或加速度为扰动量。In the formula, x is the state variable, k represents the kth sampling time, represents the system matrix, y is the system output, C is the output matrix, u is the control input, with the vehicle speed or acceleration as the control variable, and w is the system disturbance, with the obstacle speed or acceleration as the disturbance variable. 8.根据权利要求1所述的一种插电式混动汽车安全节能决策控制方法,其特征在于,所述步骤S3中采用模型预测控制算法进行纵向车速跟随控制,具体为:8. The plug-in hybrid vehicle safety and energy-saving decision control method according to claim 1, characterized in that the longitudinal vehicle speed following control is performed using a model predictive control algorithm in step S3, specifically: 选择在预测时域窗口Tp=[k+1:k+p]内的输出量yp(i|k)与目标车速v(i)的差异值的平方累加,优化得到对应预测时域内目标函数最小的控制变量序列,并把序列中的第一个值作为当前自车总的需求转矩值,下一时刻重复此过程;Select the square accumulation of the difference between the output yp (i|k) and the target vehicle speed v(i) in the prediction time domain window Tp = [k+1: k+p], optimize and obtain the control variable sequence with the minimum objective function in the corresponding prediction time domain, and take the first value in the sequence as the total required torque value of the current vehicle, and repeat this process at the next moment; umin≤u≤umax u min ≤u ≤u max 式中,目标车速v(i)为车辆纵向安全经济车速参考曲线,yp(i|k)由车辆动力学模型实时迭代得到的输出量,umin、umax表示目前需求转矩上下限。Wherein, the target vehicle speed v(i) is the reference curve of the vehicle longitudinal safety and economic speed, yp (i|k) is the output obtained by real-time iteration of the vehicle dynamics model, and umin and umax represent the upper and lower limits of the current required torque. 9.一种基于权利要求1所述的插电式混动汽车安全节能决策控制方法的系统,其特征在于,该系统包括:9. A system based on the plug-in hybrid vehicle safety and energy-saving decision control method according to claim 1, characterized in that the system comprises: 环境感知模块,用于通过智能传感器获取目标车辆周围的环境信息,包括障碍物信息;Environmental perception module, used to obtain environmental information around the target vehicle, including obstacle information, through intelligent sensors; 障碍物过滤模块,用于对目标车辆周围的障碍物进行过滤,得到危险障碍物;The obstacle filtering module is used to filter the obstacles around the target vehicle to obtain dangerous obstacles; 轨迹预测模块,用于对障碍物过滤模块得到的危险障碍物和自车进行轨迹预测;The trajectory prediction module is used to predict the trajectory of the dangerous obstacles and the ego vehicle obtained by the obstacle filtering module; 碰撞检测模块,用于对障碍物过滤模块得到的危险障碍物和自车进行碰撞检测;A collision detection module is used to perform collision detection between the dangerous obstacles obtained by the obstacle filtering module and the vehicle; 安全行为决策模块,用于基于轨迹预测和碰撞检测结果进行自车安全行为决策;Safety behavior decision module, used to make safety behavior decisions for the ego vehicle based on trajectory prediction and collision detection results; 局部纵向速度规划模块,用于基于自车安全行为决策结果进行自车速度规划,得到纵向安全经济车速;The local longitudinal speed planning module is used to plan the vehicle speed based on the vehicle safety behavior decision results to obtain the longitudinal safe and economical vehicle speed; 速度跟随控制模块,用于进行自车纵向车速跟随控制。The speed following control module is used to perform longitudinal speed following control of the vehicle.
CN202210802285.5A 2022-07-07 2022-07-07 A plug-in hybrid vehicle safety and energy-saving decision control method and system Active CN115257724B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210802285.5A CN115257724B (en) 2022-07-07 2022-07-07 A plug-in hybrid vehicle safety and energy-saving decision control method and system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210802285.5A CN115257724B (en) 2022-07-07 2022-07-07 A plug-in hybrid vehicle safety and energy-saving decision control method and system

Publications (2)

Publication Number Publication Date
CN115257724A CN115257724A (en) 2022-11-01
CN115257724B true CN115257724B (en) 2024-11-26

Family

ID=83766743

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210802285.5A Active CN115257724B (en) 2022-07-07 2022-07-07 A plug-in hybrid vehicle safety and energy-saving decision control method and system

Country Status (1)

Country Link
CN (1) CN115257724B (en)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115871658B (en) * 2022-12-07 2023-10-27 之江实验室 Dense people stream-oriented intelligent driving speed decision method and system
CN116118705B (en) * 2022-12-09 2023-08-11 聊城大学 A method for energy management and control of plug-in hybrid electric buses in car-following scenarios
CN116513246B (en) * 2023-07-04 2023-09-12 北京理工大学 A method, system and equipment for speed planning in off-road environment
CN117141473B (en) * 2023-10-31 2024-01-19 广州市德赛西威智慧交通技术有限公司 Intelligent obstacle avoidance method and device for vehicle
CN117246320B (en) * 2023-11-10 2024-02-09 新石器慧通(北京)科技有限公司 Control method, device, equipment and storage medium for vehicle
CN118387135B (en) * 2024-04-19 2025-01-03 广东汽车检测中心有限公司 A method for detecting and controlling automatic driving of an intelligent networked vehicle and a control system thereof
CN118529018B (en) * 2024-05-14 2025-01-24 重庆大学 A method for optimizing the comprehensive efficiency of hybrid electric vehicles in transverse and longitudinal coordination
CN118579058B (en) * 2024-08-05 2024-10-22 深圳佑驾创新科技股份有限公司 Speed planning method and device

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101425106A (en) * 2008-11-06 2009-05-06 清华大学 Mathematical quantisation method for vehicle multiple target coordinating type self-adapting cruise control performance
CN111968377A (en) * 2020-08-31 2020-11-20 姜忠太 Vehicle network-based vehicle track optimization method for fuel saving and driving comfort

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101425106A (en) * 2008-11-06 2009-05-06 清华大学 Mathematical quantisation method for vehicle multiple target coordinating type self-adapting cruise control performance
CN111968377A (en) * 2020-08-31 2020-11-20 姜忠太 Vehicle network-based vehicle track optimization method for fuel saving and driving comfort

Also Published As

Publication number Publication date
CN115257724A (en) 2022-11-01

Similar Documents

Publication Publication Date Title
CN115257724B (en) A plug-in hybrid vehicle safety and energy-saving decision control method and system
CN113386795B (en) Intelligent decision-making and local track planning method for automatic driving vehicle and decision-making system thereof
CN111338340B (en) Local path planning method for unmanned vehicles based on model prediction
WO2021175313A1 (en) Automatic driving control method and device, vehicle, and storage medium
CN113276848B (en) Intelligent driving lane changing and obstacle avoiding track planning and tracking control method and system
CN107200020B (en) It is a kind of based on mixing theoretical pilotless automobile self-steering control system and method
WO2020143288A1 (en) Autonomous vehicle decision-making system under complex operating conditions, and trajectory planning method therefor
CN106740846B (en) A dual-mode switching electric vehicle adaptive cruise control method
CN101837781B (en) Model-Based Predictive Control of Control Systems for Automatic Lane Alignment or Lane Changing
CN110362096A (en) A kind of automatic driving vehicle dynamic trajectory planing method based on local optimality
CN110377039A (en) A kind of vehicle obstacle-avoidance trajectory planning and tracking and controlling method
CN111750866B (en) Intelligent automobile transverse and longitudinal coupling path planning method based on regional virtual force field
CN109733395B (en) Automatic driving automobile transverse coordination control method based on extendability evaluation
CN114967676A (en) Model predictive control trajectory tracking control system and method based on reinforcement learning
CN110187639A (en) A Control Method for Trajectory Planning Based on Parameter Decision Framework
US20140297116A1 (en) Self-driving vehicle with integrated active suspension
CN107264534A (en) Intelligent driving control system and method, vehicle based on driver experience's model
CN111681452A (en) A dynamic lane-changing trajectory planning method for driverless vehicles based on Frenet coordinate system
CN109606368B (en) Intelligent automobile extension vehicle speed self-adaptive change trajectory tracking control method
CN106681327A (en) Method and system for intelligent driving horizontal and vertical decoupling control of great inertia electric motor coach
CN112578672B (en) Unmanned vehicle trajectory control system and trajectory control method based on chassis nonlinearity
CN114942642B (en) A trajectory planning method for unmanned vehicles
CN113110489B (en) Trajectory planning method and device, electronic equipment and storage medium
Zhang et al. Structured road-oriented motion planning and tracking framework for active collision avoidance of autonomous vehicles
CN112238856A (en) An intelligent vehicle overtaking trajectory optimization method based on hybrid particle swarm algorithm

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant