CN114387787B - Vehicle track control method and device, electronic equipment and storage medium - Google Patents

Vehicle track control method and device, electronic equipment and storage medium Download PDF

Info

Publication number
CN114387787B
CN114387787B CN202210293317.3A CN202210293317A CN114387787B CN 114387787 B CN114387787 B CN 114387787B CN 202210293317 A CN202210293317 A CN 202210293317A CN 114387787 B CN114387787 B CN 114387787B
Authority
CN
China
Prior art keywords
vehicle
fleet
state
equation
intelligent networked
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
CN202210293317.3A
Other languages
Chinese (zh)
Other versions
CN114387787A (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.)
Ismartways Wuhan Technology Co ltd
Original Assignee
Ismartways Wuhan Technology Co ltd
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 Ismartways Wuhan Technology Co ltd filed Critical Ismartways Wuhan Technology Co ltd
Priority to CN202210293317.3A priority Critical patent/CN114387787B/en
Publication of CN114387787A publication Critical patent/CN114387787A/en
Application granted granted Critical
Publication of CN114387787B publication Critical patent/CN114387787B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/01Detecting movement of traffic to be counted or controlled
    • G08G1/0104Measuring and analyzing of parameters relative to traffic conditions
    • G08G1/0125Traffic data processing
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/01Detecting movement of traffic to be counted or controlled
    • G08G1/0104Measuring and analyzing of parameters relative to traffic conditions
    • G08G1/0137Measuring and analyzing of parameters relative to traffic conditions for specific applications
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/20Monitoring the location of vehicles belonging to a group, e.g. fleet of vehicles, countable or determined number of vehicles
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/20Monitoring the location of vehicles belonging to a group, e.g. fleet of vehicles, countable or determined number of vehicles
    • G08G1/202Dispatching vehicles on the basis of a location, e.g. taxi dispatching
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/80Technologies aiming to reduce greenhouse gasses emissions common to all road transportation technologies
    • Y02T10/84Data processing systems or methods, management, administration

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Chemical & Material Sciences (AREA)
  • Analytical Chemistry (AREA)
  • Hybrid Electric Vehicles (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Abstract

The invention provides a vehicle track control method, a vehicle track control device, electronic equipment and a storage medium, wherein the method comprises the following steps: dividing the mixed fleet into a plurality of sub fleets by taking the intelligent networked vehicles as head vehicles, wherein each sub fleet comprises one intelligent networked vehicle and at least one full-manual driving vehicle; selecting a state variable, and establishing a state vector of the hybrid fleet according to the state variable; selecting a control variable, and establishing a fleet continuous time domain state transfer equation based on the control variable, a vehicle kinematics model and a speed difference stress-response model; discretizing the continuous time domain state transition equation to obtain an augmented form state equation; and establishing an optimization objective function, determining constraint conditions of the optimization objective function, and acquiring the vehicle track of the hybrid fleet based on the optimization objective function and the constraint conditions. The invention can carry out cooperative control on the running of each vehicle in the mixed motorcade consisting of a plurality of intelligent networked vehicles and a plurality of full-manual driving vehicles, thereby improving the traffic efficiency of the mixed motorcade.

Description

Vehicle track control method and device, electronic equipment and storage medium
Technical Field
The invention relates to the technical field of motorcade track control, in particular to a vehicle track control method, a vehicle track control device, electronic equipment and a storage medium.
Background
In the urban road network environment, the vehicle passing efficiency is greatly influenced by the signal timing of the road junction on the passing path, the green light resource distribution is unreasonable under the practical condition, the vehicle can not adjust the motion state according to the real-time condition of the traffic light, and the purpose of reasonably utilizing the traffic light resource is achieved. Along with the construction of intelligent network connection infrastructures in urban road networks, high-grade automatic driving automobiles gradually develop commercial operation, the significance of developing a crossing vehicle track control method in an intelligent network connection environment is great, and the aims of saving oil consumption and improving the operation efficiency of vehicles and urban traffic can be fulfilled.
The existing vehicle track control method mainly comprises two types of vehicle speed guidance and full-intelligent networked vehicle fleet passing. The method mainly comprises the steps of calculating based on the time distribution of traffic lights and the real-time motion state of vehicles, achieving the purpose of passing through the intersection without stopping as much as possible by giving reasonable suggested speed or acceleration, helping the vehicles to improve the operation efficiency and optimizing the travel service, but mostly considering single vehicle passing, being incapable of carrying out integral or differential passing speed optimization aiming at a motorcade formed by a plurality of vehicles at the intersection, and being limited in helping to improve the traffic efficiency at the intersection. The vehicle fleet composed of a plurality of intelligent networked vehicles is integrally researched, the vehicle fleet passing efficiency can be greatly improved based on longitudinal control of the passing vehicle fleet, however, considering that the current intelligent networked vehicles have limited permeability and cannot meet the harsh conditions of the vehicle fleet composed of full intelligent networked vehicles under the non-intentional actual operation scene, most of the vehicle flees are composed of the intelligent networked vehicles and full-manual driving vehicles in a mixed mode.
Therefore, it is urgently needed to provide a vehicle trajectory control method, a vehicle trajectory control device, an electronic device and a storage medium to solve the technical problem that the prior art cannot perform trajectory control on a hybrid fleet composed of intelligent networked vehicles and fully-manually-driven vehicles in an actual application scene, so that the traffic efficiency of the hybrid fleet is low.
Disclosure of Invention
In view of the above, it is necessary to provide a vehicle trajectory control method, device, electronic device and storage medium to solve the technical problem in the prior art that the trajectory control cannot be performed on a hybrid fleet composed of an intelligent internet vehicle and a fully-manually-driven vehicle in an actual application scene, so that the traffic efficiency of the hybrid fleet is low.
In order to solve the above technical problem, the present invention provides a vehicle trajectory control method for controlling the trajectory of each vehicle in a hybrid fleet, where the hybrid fleet includes a plurality of intelligent networked vehicles and a plurality of fully manually driven vehicles, and the vehicle trajectory control method includes:
dividing the mixed fleet into a plurality of sub fleets by taking the intelligent networked vehicle as a head vehicle, wherein each sub fleet comprises one intelligent networked vehicle and at least one full-manual driving vehicle; selecting the position and the speed of the vehicle as state variables, and establishing a state vector of the hybrid fleet according to the state variables;
selecting the acceleration of the intelligent networked vehicle as a control variable, and establishing a fleet continuous time domain state transfer equation based on the control variable, a vehicle kinematics model and a speed difference stress-response model;
discretizing the continuous time domain state transition equation to obtain an augmented form state equation;
and establishing an optimization objective function with the aim of minimizing the difference between the motion state and the ideal state of the intelligent networked vehicle at a stop line of the intersection and minimizing the accumulated oil consumption of the hybrid fleet, determining a constraint condition of the optimization objective function, and obtaining vehicle tracks of the intelligent networked vehicle and the fully-manually-driven vehicle in the hybrid fleet based on the state equation of the augmented form, the optimization objective function and the constraint condition.
In some possible implementations, the establishing a fleet continuous time domain state transition equation based on the control variables, the vehicle kinematics model, and the speed difference stress-response model includes:
establishing a head-vehicle state equation of the intelligent networked vehicle based on the control variables and the vehicle kinematics model;
establishing a following vehicle linear time-varying state equation of the fully manually driven vehicle based on the control variables and the speed difference stress-response model;
and establishing a fleet continuous time domain state transfer equation of the sub fleet based on the head vehicle state equation and the following vehicle state equation.
In some possible implementations, the fleet continuous time domain state transition equation is:
Figure 494706DEST_PATH_IMAGE001
Figure 688927DEST_PATH_IMAGE002
Figure 978701DEST_PATH_IMAGE003
Figure 526357DEST_PATH_IMAGE004
Figure 821072DEST_PATH_IMAGE005
Figure 186194DEST_PATH_IMAGE006
Figure 605674DEST_PATH_IMAGE007
in the formula (I), the compound is shown in the specification,
Figure 81655DEST_PATH_IMAGE008
is composed of
Figure 902981DEST_PATH_IMAGE009
The position of the intelligent networked vehicle of the mth sub-fleet at the moment;
Figure 206048DEST_PATH_IMAGE010
is composed of
Figure 112824DEST_PATH_IMAGE009
The speed of the intelligent networked vehicle of the mth sub-fleet at the moment;
Figure 126917DEST_PATH_IMAGE011
the position of the intelligent networked vehicle of the mth sub-fleet at the moment t;
Figure 396224DEST_PATH_IMAGE012
the speed of the intelligent networked vehicle of the mth sub-fleet at the moment t;
Figure 978515DEST_PATH_IMAGE013
the acceleration of the intelligent networked vehicle of the mth sub-fleet at the moment t;
Figure 497221DEST_PATH_IMAGE014
instantaneous acceleration of the nth fully manually driven vehicle in any mth sub-fleet;
Figure 190371DEST_PATH_IMAGE015
the driver sensitivity coefficient is used for representing the stress response speed of the fully-manually driven vehicle along with the change of the speed difference and is a constant;
Figure 609457DEST_PATH_IMAGE016
is a real-time distance difference between the current vehicle and the preceding vehicle,
Figure 97070DEST_PATH_IMAGE017
an optimal speed model is obtained;
Figure 368652DEST_PATH_IMAGE018
is the first derivative;
Figure 865492DEST_PATH_IMAGE019
for mth sub-fleet
Figure 843812DEST_PATH_IMAGE020
A state vector of a time;
Figure 626961DEST_PATH_IMAGE021
the state transition matrix is the state transition matrix of the mth sub-fleet in the continuous time domain;
Figure 995625DEST_PATH_IMAGE022
the mth sub-fleet is
Figure 656676DEST_PATH_IMAGE023
A state vector of a time;
Figure 427186DEST_PATH_IMAGE024
the input matrix is the input matrix of the mth sub-fleet in the continuous time domain;
Figure 381235DEST_PATH_IMAGE025
is the input vector of the mth sub-fleet.
In some possible implementations, the discretizing the continuous time-domain state-transition equation to obtain an augmented form state equation includes:
discretizing the continuous time domain state transition equation based on discrete sampling step length, and establishing a state transition and state output equation in a discrete time domain;
obtaining an incremental form state equation based on the state transition equation and the state output equation in the discrete time domain;
and obtaining an augmented form state equation in the prediction time domain based on the incremental form state equation.
In some possible implementations, the augmented form state equations include an augmented state transition equation and an augmented state output equation;
the augmented state transition equation is:
Figure 502775DEST_PATH_IMAGE026
Figure 200473DEST_PATH_IMAGE027
Figure 825489DEST_PATH_IMAGE028
the augmented state output equation is:
Figure 419281DEST_PATH_IMAGE029
Figure 120128DEST_PATH_IMAGE030
Figure 762462DEST_PATH_IMAGE031
Figure 632198DEST_PATH_IMAGE032
Figure 68995DEST_PATH_IMAGE033
Figure 758602DEST_PATH_IMAGE034
Figure 266944DEST_PATH_IMAGE035
Figure 600974DEST_PATH_IMAGE036
Figure 100350DEST_PATH_IMAGE037
Figure 152620DEST_PATH_IMAGE038
Figure 995811DEST_PATH_IMAGE039
Figure 449926DEST_PATH_IMAGE040
in the formula (I), the compound is shown in the specification,
Figure 556422DEST_PATH_IMAGE041
to be composed of
Figure 486201DEST_PATH_IMAGE042
Augmented state vector prediction of time of day
Figure 8449DEST_PATH_IMAGE043
An augmented state vector of time;
Figure 143502DEST_PATH_IMAGE044
is composed of
Figure 217637DEST_PATH_IMAGE042
An augmented state vector of time;
Figure 244499DEST_PATH_IMAGE045
a state transition matrix in an augmented form for the mth sub-fleet within the prediction horizon;
Figure 695072DEST_PATH_IMAGE046
a state transition matrix in an augmented form within a prediction horizon;
Figure 186096DEST_PATH_IMAGE047
an input matrix in an augmented form for the mth sub-fleet;
Figure 306499DEST_PATH_IMAGE048
the change value of the control vector at the k moment;
Figure 446756DEST_PATH_IMAGE049
to be composed of
Figure 576386DEST_PATH_IMAGE042
Output vector prediction of time of day
Figure 718654DEST_PATH_IMAGE043
An output vector of time;
Figure 275537DEST_PATH_IMAGE050
a state transition matrix in a discrete time domain;
Figure 136046DEST_PATH_IMAGE051
an input matrix in a discrete time domain;
Figure 131684DEST_PATH_IMAGE021
the state transition matrix is the state transition matrix of the mth sub-fleet in the continuous time domain;
Figure 269404DEST_PATH_IMAGE024
the input matrix is the input matrix of the mth sub-fleet in the continuous time domain; ca is a preset matrix in an augmented form; e is a natural constant, and tau is a discretized control matrix; i is an identity matrix; o is a zero matrix.
In some possible implementations, the establishing an optimization objective function with the objective of minimizing the difference between the motion state and the ideal state of the intelligent networked vehicle at the intersection stop line and minimizing the cumulative fuel consumption of the hybrid fleet includes:
acquiring a motion state vector difference between a motion state of the intelligent networked vehicle at a stop line of an intersection and an ideal state in a prediction time domain;
acquiring a control vector difference of the intelligent networked vehicle in a control time domain;
acquiring the instantaneous oil consumption of the intelligent networked vehicles and the full-manual driving vehicles in each sub-fleet;
and establishing the optimization objective function based on the motion state vector difference, the control vector difference and the instantaneous fuel consumption.
In some possible implementations, the optimization objective function is:
Figure 847057DEST_PATH_IMAGE052
Figure 194862DEST_PATH_IMAGE053
Figure 666295DEST_PATH_IMAGE054
Figure 783155DEST_PATH_IMAGE055
in the formula (I), the compound is shown in the specification,
Figure 9737DEST_PATH_IMAGE056
is the optimization objective function;
Figure 720204DEST_PATH_IMAGE057
actual output vectors in the ith prediction step length of the intelligent networked vehicles of the mth sub-fleet are obtained;
Figure 559110DEST_PATH_IMAGE058
a reference output vector in the ith prediction step length of the intelligent networked vehicle of the mth sub-fleet is obtained;
Figure 796056DEST_PATH_IMAGE059
the actual control vector is in the ith control step length of the intelligent networked vehicle of the mth sub-fleet;
Figure 865643DEST_PATH_IMAGE060
the reference control vector is a reference control vector in the ith control step length of the intelligent networked vehicle of the mth sub-fleet; q is a weight factor matrix of the output vector; r is a weight factor matrix of the control vector;
Figure 188040DEST_PATH_IMAGE061
instantaneous fuel consumption of intelligent networked vehicles in each sub-fleet;
Figure 329171DEST_PATH_IMAGE062
instantaneous fuel consumption for all manually driven vehicles in each sub-vehicle; and | | is a norm.
In another aspect, the present invention further provides a vehicle trajectory control device for controlling the trajectory of each vehicle in a hybrid fleet, where the hybrid fleet includes a plurality of intelligent networked vehicles and a plurality of fully manually driven vehicles, the vehicle trajectory control device comprising:
the hybrid fleet division unit is used for dividing the hybrid fleet into a plurality of sub-fleets by taking the intelligent networked vehicles as head vehicles, and each sub-fleet comprises one intelligent networked vehicle and at least one full-manual driving vehicle; selecting the position and the speed of the vehicle as state variables, and establishing a state vector of the hybrid fleet according to the state variables;
the time domain state transfer equation establishing unit is used for selecting the acceleration of the intelligent networked vehicle as a control variable and establishing a continuous time domain state transfer equation of the fleet based on the control variable, a vehicle kinematics model and a speed difference stress-response model;
the augmented form state equation establishing unit is used for discretizing the continuous time domain state transfer equation to obtain an augmented form state equation;
and the vehicle track control unit is used for establishing an optimization objective function with the purposes of minimizing the difference between the motion state and the ideal state of the intelligent networked vehicle at a stop line of an intersection and minimizing the accumulated oil consumption of the mixed fleet, determining the constraint condition of the optimization objective function, and obtaining the vehicle tracks of the intelligent networked vehicle and the fully-manually driven vehicle in the mixed fleet based on the state equation of the augmented form, the optimization objective function and the constraint condition.
In another aspect, the present invention also provides an electronic device comprising a memory and a processor, wherein,
the memory is used for storing programs;
the processor, coupled to the memory, is configured to execute the program stored in the memory to implement the steps of the vehicle trajectory control method in any one of the above implementations.
In another aspect, the present invention further provides a computer-readable storage medium for storing a computer-readable program or instructions, which when executed by a processor, can implement the steps of the vehicle trajectory control method in any one of the above-mentioned implementation manners.
The beneficial effects of adopting the above embodiment are: according to the vehicle track control method, firstly, the intelligent internet vehicle is used as a head vehicle, the mixed fleet is divided into a plurality of sub-fleets, each sub-fleet comprises one intelligent internet vehicle and at least one fully manually driven vehicle, and the technical effect of cooperatively controlling the running of each vehicle in the mixed fleet consisting of the plurality of intelligent internet vehicles and the plurality of fully manually driven vehicles is achieved.
Furthermore, the vehicle track control method provided by the invention establishes an optimization objective function aiming at the minimum difference between the motion state and the ideal state of the intelligent networked vehicle at the stop line of the intersection and the minimum accumulated oil consumption of the hybrid fleet, and obtains the vehicle tracks of the intelligent networked vehicle and the fully-manually-driven vehicle in the hybrid fleet based on the optimization objective function, so that the traffic efficiency of the hybrid fleet can be improved, and the energy consumption of each vehicle in the hybrid fleet can be optimized.
Drawings
In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the drawings needed to be used in the description of the embodiments will be briefly introduced below, and it is obvious that the drawings in the following description are only some embodiments of the present invention, and it is obvious for those skilled in the art to obtain other drawings based on these drawings without creative efforts.
FIG. 1 is a flow chart illustrating a vehicle trajectory control method according to an embodiment of the present invention;
FIG. 2 is a schematic structural diagram of an embodiment of a hybrid fleet provided by the present invention;
FIG. 3 is a flowchart illustrating an embodiment of S101 in FIG. 1 according to the present invention;
FIG. 4 is a flowchart illustrating an embodiment of S103 of FIG. 1 according to the present invention;
FIG. 5 is a flowchart illustrating an embodiment of S104 of FIG. 1 according to the present invention;
FIG. 6 is a schematic structural diagram of an embodiment of a vehicle trajectory control device provided by the present invention;
fig. 7 is a schematic structural diagram of an embodiment of an electronic device provided in the present invention.
Detailed Description
The technical solution in the embodiments of the present invention will be clearly and completely described below with reference to the accompanying drawings in the embodiments of the present invention. It is to be understood that the described embodiments are merely exemplary of the invention, and not restrictive of the full scope of the invention. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
In the description of the embodiments of the present application, "a plurality" means two or more unless otherwise specified.
It should be understood that the schematic drawings are not necessarily to scale. The flowcharts used in this invention illustrate operations performed in accordance with some embodiments of the present invention. It should be understood that the operations of the flow diagrams may be performed out of order, and that steps without logical context may be reversed in order or performed concurrently. One skilled in the art, under the direction of this summary, may add one or more other operations to, or remove one or more operations from, the flowchart.
Some of the block diagrams shown in the figures are functional entities and do not necessarily correspond to physically or logically separate entities. These functional entities may be implemented in the form of software, or in one or more hardware modules or integrated circuits, or in different networks and/or processor systems and/or microcontroller systems.
Reference herein to "an embodiment" means that a particular feature, structure, or characteristic described in connection with the embodiment can be included in at least one embodiment of the invention. The appearances of the phrase in various places in the specification are not necessarily all referring to the same embodiment, nor are separate or alternative embodiments mutually exclusive of other embodiments. It is explicitly and implicitly understood by one skilled in the art that the embodiments described herein can be combined with other embodiments.
The invention provides a vehicle track control method, a vehicle track control device, an electronic device and a storage medium, which are respectively described below.
Fig. 1 is a schematic flowchart of an embodiment of a vehicle trajectory control method provided by the present invention, where the vehicle trajectory control method is used to control trajectories of vehicles in a hybrid fleet, where the hybrid fleet includes a plurality of intelligent networked vehicles and a plurality of fully manually driven vehicles, and as shown in fig. 1, the vehicle trajectory control method includes:
s101, dividing a mixed fleet into a plurality of sub fleets by taking an intelligent networked vehicle as a head vehicle, wherein each sub fleet comprises an intelligent networked vehicle and at least one full-manual driving vehicle; selecting the position and the speed of the vehicle as state variables, and establishing a state vector of the hybrid fleet according to the state variables;
s102, selecting the acceleration of the intelligent networked vehicle as a control variable, and establishing a fleet continuous time domain state transfer equation based on the control variable, a vehicle kinematics model and a speed difference stress-response model;
s103, discretizing the continuous time domain state transfer equation to obtain an augmented form state equation;
s104, establishing an optimization objective function aiming at the minimum difference between the motion state and the ideal state of the intelligent networked vehicle at the stop line of the intersection and the minimum accumulated oil consumption of the hybrid fleet, determining a constraint condition of the optimization objective function, and obtaining vehicle tracks of the intelligent networked vehicle and the fully-manually-driven vehicle in the hybrid fleet based on the state equation of the augmented form, the optimization objective function and the constraint condition.
Specifically, step S104 specifically includes: obtaining target acceleration, target speed and target position of intelligent networked vehicles in the hybrid fleet as well as following speed and following position of full-manual driving vehicles based on the state equation of the augmentation form, the target function and the constraint condition; and obtaining a vehicle trajectory for the hybrid fleet based on the target speed, the target location, the following speed, and the following location.
Compared with the prior art, the vehicle track control method provided by the embodiment of the invention has the advantages that the intelligent networked vehicle is taken as the head vehicle, the mixed fleet is divided into a plurality of sub-fleets, each sub-fleet comprises an intelligent networked vehicle and at least one fully-manually-driven vehicle, and the technical effect of cooperatively controlling the running of each vehicle in the mixed fleet consisting of the intelligent networked vehicles and the fully-manually-driven vehicles is realized.
Further, the vehicle track control method provided by the embodiment of the invention establishes the optimization objective function with the purposes of minimizing the difference between the motion state and the ideal state of the intelligent internet vehicle at the intersection stop line and minimizing the accumulated oil consumption of the hybrid fleet, and obtains the vehicle tracks of the intelligent internet vehicle and the fully-manually-driven vehicle in the hybrid fleet based on the optimization objective function, so that the traffic efficiency of the hybrid fleet can be improved, and the energy consumption of each vehicle in the hybrid fleet can be optimized.
In one embodiment of the present invention, as shown in fig. 2, the hybrid fleet includes m sub-fleets, each sub-fleet includes an intelligent networked vehicle (CAV) and at least one full Human Driven Vehicle (HDV), and is represented by a matrix family:
Figure 295990DEST_PATH_IMAGE063
wherein the content of the first and second substances,
Figure 97331DEST_PATH_IMAGE064
a state matrix representing all vehicles in the mth sub-fleet. When the vehicle position and the vehicle speed are selected as the state variables, the state variables can be expressed as:
Figure 907024DEST_PATH_IMAGE065
wherein the content of the first and second substances,
Figure 258371DEST_PATH_IMAGE066
respectively representing the position and the speed of the intelligent networked vehicle in the mth sub-vehicle fleet;
Figure 204330DEST_PATH_IMAGE067
respectively representing the position and the speed of the w-th full-man driving vehicle in the mth sub-fleet;
Figure 881299DEST_PATH_IMAGE068
representing the acceleration of the w-th fully human-driven vehicle in the m-th sub-fleet.
In some embodiments of the present invention, as shown in fig. 3, step S101 includes:
s301, establishing a head-vehicle state equation of the intelligent networked vehicle based on the control variables and the vehicle kinematics model;
s302, establishing a following vehicle linear time-varying state equation of the full-manual driving vehicle based on the control variable and the speed difference stress-response model;
s303, establishing a continuous time domain state transfer equation of the sub-fleet of vehicles based on the state equation of the head vehicle and the state equation of the following vehicle.
The intelligent internet vehicle is used as a head vehicle of a sub-fleet with controllable tracks, the fleet is in a cruising state during green light is considered, a state equation is established according to a vehicle kinematics model, and the state equation of the head vehicle is as follows:
Figure 115971DEST_PATH_IMAGE069
in the formula (I), the compound is shown in the specification,
Figure 897108DEST_PATH_IMAGE008
and
Figure 838519DEST_PATH_IMAGE070
are respectively as
Figure 483127DEST_PATH_IMAGE009
The position and the speed of the intelligent networked vehicle of the mth sub-fleet at the moment;
Figure 1833DEST_PATH_IMAGE011
and
Figure 694983DEST_PATH_IMAGE012
the position and the speed of the intelligent networked vehicle of the mth sub-fleet at the moment t are respectively;
Figure 615534DEST_PATH_IMAGE013
and the acceleration of the intelligent networked vehicle of the mth sub-fleet at the moment t.
The vehicle kinematic model refers to a basic relation model of position and speed and a basic relation model of speed and acceleration of the vehicle in the motion process.
Since the fully manually driven vehicle is the following vehicle in the sub-fleet, it cannot be trajectory controlled. In the actual running process, a following vehicle driver can drive along with a front vehicle according to the actual situation so as to indirectly optimize the track, and based on the indirect optimization principle, a model for describing the following process of the following vehicle and the head vehicle can be constructed, wherein the model is called as a speed difference stress-reflecting model in the specific embodiment of the invention; it is to be understood that the velocity difference stress-reflecting model is an indirectly followed model theory and does not need to be characterized by a specific formula or functional model.
Specifically, describing the following vehicle following process based on the speed difference stress-response model, the acceleration of any following vehicle satisfies:
Figure 634306DEST_PATH_IMAGE071
wherein the content of the first and second substances,
Figure 138843DEST_PATH_IMAGE014
instantaneous acceleration of the nth fully manually driven vehicle in any mth sub-fleet;
Figure 698000DEST_PATH_IMAGE015
the driver sensitivity coefficient is used for representing the stress response speed of the fully-manually driven vehicle along with the change of the speed difference and is a constant;
Figure 348424DEST_PATH_IMAGE016
the real-time distance difference between the current vehicle and the preceding vehicle,
Figure 662731DEST_PATH_IMAGE017
is an Optimal Velocity (OVM) model.
Wherein, the OVM model satisfies:
Figure 31395DEST_PATH_IMAGE072
wherein the content of the first and second substances,
Figure 190981DEST_PATH_IMAGE073
v1, V2, C1, C2 are all constants, specifically:
Figure 525273DEST_PATH_IMAGE073
=0.85,V1=6.75,V2=7.91,C1=0.13,C2=1.57。
the following vehicle state equation is:
Figure 620268DEST_PATH_IMAGE074
expanding the following vehicle state equation at the time t according to the Taylor series to obtain an acceleration first-order linear differential equation as follows:
Figure 866442DEST_PATH_IMAGE075
order to
Figure 767401DEST_PATH_IMAGE007
And establishing a following vehicle linear time-varying state equation:
Figure 392418DEST_PATH_IMAGE076
wherein the content of the first and second substances,
Figure 48527DEST_PATH_IMAGE018
is the first derivative.
Combining the head vehicle state equation and the following vehicle linear time-varying state equation to obtain a fleet continuous time domain state transfer equation, wherein the fleet continuous time domain state transfer equation is as follows:
Figure 218215DEST_PATH_IMAGE001
Figure 188445DEST_PATH_IMAGE002
Figure 667968DEST_PATH_IMAGE003
Figure 494979DEST_PATH_IMAGE004
Figure 387848DEST_PATH_IMAGE005
Figure 302715DEST_PATH_IMAGE006
in the formula (I), the compound is shown in the specification,
Figure 528422DEST_PATH_IMAGE019
for mth sub-fleet
Figure 401700DEST_PATH_IMAGE020
A state vector of a time;
Figure 578603DEST_PATH_IMAGE021
the state transition matrix is the state transition matrix of the mth sub-fleet in the continuous time domain;
Figure 297161DEST_PATH_IMAGE077
the mth sub-fleet is
Figure 875910DEST_PATH_IMAGE023
A state vector of a time;
Figure 982406DEST_PATH_IMAGE024
the input matrix is the input matrix of the mth sub-fleet in the continuous time domain;
Figure 521972DEST_PATH_IMAGE025
is the input vector of the mth sub-fleet.
In order to reduce or eliminate static errors when the integration is introduced, so as to further improve the accuracy of predicting the vehicle trajectory, in some embodiments of the present invention, as shown in fig. 4, step S103 includes:
s401, discretizing a continuous time domain state transition equation based on discrete sampling step length, and establishing a state transition and state output equation in a discrete time domain;
s402, obtaining an incremental form state equation based on a state transition equation and a state output equation in a discrete time domain;
and S403, obtaining an augmented form state equation in the prediction time domain based on the incremental form state equation.
In some embodiments of the invention, the sampling step size in step S401 is determined by the fixed frequency of communication between the vehicle and the communication device (V2I). In one embodiment, the V2I communication message transmission period is 100 ms.
Specifically, let:
Figure 932968DEST_PATH_IMAGE078
wherein k represents the step length after unit time discretization, and the continuous time domain state transition equation is discretized to obtain:
Figure 241589DEST_PATH_IMAGE079
Figure 518987DEST_PATH_IMAGE080
wherein the content of the first and second substances,
Figure 404903DEST_PATH_IMAGE081
state vectors at the time k +1 in the discrete time domain;
Figure 324318DEST_PATH_IMAGE082
the control vector is the control vector of k time in a discrete time domain;
Figure 284184DEST_PATH_IMAGE050
a state transition matrix in a discrete time domain;
Figure 233947DEST_PATH_IMAGE051
an input matrix in a discrete time domain; e is a natural constant, and tau is a discretized control matrix; c is a preset matrix; i is an identity matrix; o is a zero matrix.
In order to reduce or eliminate static errors when introducing integration, the above discretization equation is rewritten as an incremental equation, let:
Figure 13685DEST_PATH_IMAGE083
in the formula (I), the compound is shown in the specification,
Figure 2369DEST_PATH_IMAGE084
the state vector difference between the kth +1 moment and the kth moment of the mth sub-fleet is obtained;
Figure 20004DEST_PATH_IMAGE085
the output vector difference of the mth sub-fleet at the k +1 th moment and the kth moment is obtained;
Figure 701521DEST_PATH_IMAGE086
state vector at time k;
Figure 765292DEST_PATH_IMAGE087
the vector is an output vector at the moment k + 1;
Figure 167454DEST_PATH_IMAGE088
is the output vector at time k.
The incremental form state transition equation and the output equation are obtained through derivation, and the incremental form state transition equation and the output equation are as follows:
Figure 397185DEST_PATH_IMAGE089
in the formula (I), the compound is shown in the specification,
Figure 921707DEST_PATH_IMAGE090
the control vector difference between the kth +1 th moment and the kth moment of the mth sub-fleet is obtained.
Writing the incremental state transition equation and the output equation into a matrix form to obtain a state transition matrix, a control matrix and a state output matrix:
Figure 207195DEST_PATH_IMAGE091
Figure 803262DEST_PATH_IMAGE092
Figure 61068DEST_PATH_IMAGE093
transforming the above equation into a standard augmented state transition and state output form:
Figure 818808DEST_PATH_IMAGE094
in the formula (I), the compound is shown in the specification,
Figure 358636DEST_PATH_IMAGE095
state vectors in an augmented form for the mth sub-fleet k + 1;
Figure 368180DEST_PATH_IMAGE096
a state transition matrix in an augmented form for the mth sub-fleet;
Figure 605127DEST_PATH_IMAGE097
state vectors in an augmented form for the mth sub-fleet k moment;
Figure 674714DEST_PATH_IMAGE098
an input matrix in an augmented form for the mth sub-fleet;
Figure 934794DEST_PATH_IMAGE099
the variable quantity of the input vector at the k moment of the mth sub-fleet is obtained;
Figure 138242DEST_PATH_IMAGE100
an output vector of an amplification form at the moment k +1 of the mth sub-fleet;
Figure 665913DEST_PATH_IMAGE101
an output vector of an amplification form at the k moment of the mth sub-fleet;
Figure 968718DEST_PATH_IMAGE102
for the purpose of broadeningA predetermined matrix of the mth sub-fleet of vehicles in the form.
Because the augmented state vector of any kth sampling step length can be obtained, the augmented state transition equation in the prediction step length p is respectively solved by combining the control variable increment expression in the range of the output prediction step length p as follows:
Figure 778411DEST_PATH_IMAGE103
Figure 129758DEST_PATH_IMAGE027
Figure 341297DEST_PATH_IMAGE028
the output equation of the augmentation state is:
Figure 487107DEST_PATH_IMAGE029
Figure 223244DEST_PATH_IMAGE030
Figure 768495DEST_PATH_IMAGE031
Figure 444327DEST_PATH_IMAGE037
Figure 151252DEST_PATH_IMAGE038
Figure 873221DEST_PATH_IMAGE039
Figure 566370DEST_PATH_IMAGE040
in the formula (I), the compound is shown in the specification,
Figure 985457DEST_PATH_IMAGE041
to be composed of
Figure 4228DEST_PATH_IMAGE042
Augmented state vector prediction of time of day
Figure 744651DEST_PATH_IMAGE043
An augmented state vector of time;
Figure 241492DEST_PATH_IMAGE044
is composed of
Figure 219812DEST_PATH_IMAGE042
An augmented state vector of time;
Figure 737381DEST_PATH_IMAGE045
a state transition matrix in an augmented form for the mth sub-fleet within the prediction horizon;
Figure 466565DEST_PATH_IMAGE046
a state transition matrix in an augmented form within a prediction horizon;
Figure 829413DEST_PATH_IMAGE047
an input matrix in an augmented form for an mth sub-fleet;
Figure 458977DEST_PATH_IMAGE048
the change value of the control vector at the k moment;
Figure 819552DEST_PATH_IMAGE049
to be composed of
Figure 534567DEST_PATH_IMAGE042
Output vector prediction of time of day
Figure 223078DEST_PATH_IMAGE043
An output vector of time;
Figure 848095DEST_PATH_IMAGE050
a state transition matrix in a discrete time domain;
Figure 238625DEST_PATH_IMAGE051
an input matrix in a discrete time domain;
Figure 316302DEST_PATH_IMAGE021
the state transition matrix is the state transition matrix of the mth sub-fleet in the continuous time domain;
Figure 817691DEST_PATH_IMAGE024
the input matrix is the input matrix of the mth sub-fleet in the continuous time domain; ca is a preset matrix in an augmented form; e is a natural constant, and tau is a discretized control matrix; i is an identity matrix; o is a zero matrix.
In some embodiments of the present invention, as shown in fig. 5, step S104 comprises:
s501, acquiring a motion state vector difference between a motion state of an intelligent networked vehicle at a stop line of an intersection and an ideal state in a prediction time domain;
s502, acquiring a control vector difference of the intelligent networked vehicle in a control time domain;
s503, acquiring the instantaneous oil consumption of the intelligent networked vehicles and the fully-manually driven vehicles in each sub-fleet;
and S504, establishing an optimization objective function based on the motion state vector difference, the control vector difference and the instantaneous oil consumption.
In the embodiment of the invention, the optimized objective function is established based on the motion state vector difference, the control vector difference and the instantaneous oil consumption, so that the oil consumption of a hybrid fleet is minimized while the traffic efficiency of the hybrid fleet is ensured, and the energy consumption is reduced.
It should be understood that: ideally, the intelligent networked vehicle is traveling at a constant speed at a saturated flow rate. In an embodiment of the present invention, the speed of the intelligent networked vehicle may be 15m/s and the instantaneous acceleration value may be 0m/s 2.
Specifically, the optimization objective function is:
Figure 562793DEST_PATH_IMAGE052
Figure 124224DEST_PATH_IMAGE053
Figure 423619DEST_PATH_IMAGE054
Figure 230163DEST_PATH_IMAGE055
in the formula (I), the compound is shown in the specification,
Figure 829771DEST_PATH_IMAGE056
to optimize the objective function;
Figure 234208DEST_PATH_IMAGE057
actual output vectors in the ith prediction step length of the intelligent networked vehicles of the mth sub-fleet are obtained;
Figure 348795DEST_PATH_IMAGE058
a reference output vector in the ith prediction step length of the intelligent networked vehicle of the mth sub-fleet is obtained;
Figure 129669DEST_PATH_IMAGE059
the actual control vector is in the ith control step length of the intelligent networked vehicle of the mth sub-fleet;
Figure 708418DEST_PATH_IMAGE060
the reference control vector is a reference control vector in the ith control step length of the intelligent networked vehicle of the mth sub-fleet; q is a weight factor matrix of the output vector; r is a weight factor matrix of the control vector;
Figure 221439DEST_PATH_IMAGE061
instantaneous fuel consumption of intelligent networked vehicles in each sub-fleet;
Figure 620059DEST_PATH_IMAGE062
instantaneous fuel consumption for all manually driven vehicles in each sub-vehicle; and | | is a norm.
Wherein, the reference output vector in the ith prediction step length of the intelligent networked vehicle of the mth sub-fleet meets the following requirements:
Figure 142307DEST_PATH_IMAGE104
the reference control vector in the ith control step of the intelligent networked vehicle of the mth sub-vehicle team meets the following requirements:
Figure 74098DEST_PATH_IMAGE105
the instantaneous fuel consumption of the vehicle conforms to the following formula:
Figure 23599DEST_PATH_IMAGE106
wherein the content of the first and second substances,
Figure 175095DEST_PATH_IMAGE107
Figure 32192DEST_PATH_IMAGE108
Figure 460900DEST_PATH_IMAGE109
are all constant terms; m represents the mass of the automobile,
Figure 705936DEST_PATH_IMAGE110
and
Figure 688936DEST_PATH_IMAGE111
respectively representing the instantaneous position of the vehicleTime acceleration and velocity; g (t) represents the total power of work done by the automobile engine, and meets the following requirements:
Figure 677620DEST_PATH_IMAGE112
since intersection signal timing and traffic light state need to be considered in the vehicle trajectory control process, in some embodiments of the present invention, the transit time T of all vehicles during the green light period should satisfy:
Figure 757572DEST_PATH_IMAGE113
wherein g is the green light time length, th is the time interval between any adjacent vehicles, nm is the number of following vehicles in the mth sub-fleet, tm is the time required by the mth sub-fleet for the head vehicle to pass through, and the minimum green light time length is set as
Figure 48876DEST_PATH_IMAGE114
Then:
Figure 410849DEST_PATH_IMAGE115
Figure 78591DEST_PATH_IMAGE116
the time required for the first vehicle to pass through the m-1 st sub-fleet;
Figure 544207DEST_PATH_IMAGE117
the number of following vehicles in the m-1 th sub-fleet.
According to the embodiment of the invention, the track control of the motorcade in signal periods can be realized by setting the time required by the first vehicle passing of the mth sub-motorcade, so that the controlled sub-motorcade can be ensured to smoothly pass along with the vehicles.
In some embodiments of the present invention, the constraint conditions in step S104 include a velocity constraint and an acceleration constraint, wherein the velocity constraint is:
the speed variable in the state vector meets the lowest and highest speed limit conditions of the road, and is expressed by a formula as follows:
Figure 131046DEST_PATH_IMAGE118
if the lowest speed limit does not exist for the road,
Figure 354217DEST_PATH_IMAGE119
the maximum speed limit is 60km/h,
Figure 950284DEST_PATH_IMAGE120
the acceleration constraints are:
the acceleration in the control vector meets the maximum and minimum acceleration constraint conditions, and is expressed by a formula as follows:
Figure 942511DEST_PATH_IMAGE121
according to the empirical value of the acceleration range, take
Figure 372355DEST_PATH_IMAGE122
Figure 705991DEST_PATH_IMAGE123
In order to better implement the vehicle trajectory control method in the embodiment of the present invention, on the basis of the vehicle trajectory control method, correspondingly, as shown in fig. 6, an embodiment of the present invention further provides a vehicle trajectory control device 600, configured to control trajectories of vehicles in a hybrid fleet, where the hybrid fleet includes a plurality of intelligent networked vehicles and a plurality of fully manually driven vehicles, and the vehicle trajectory control device 600 includes:
the hybrid fleet dividing unit 601 is configured to divide the hybrid fleet into a plurality of sub-fleets by using the intelligent networked vehicle as a head vehicle, where each sub-fleet includes one intelligent networked vehicle and at least one full-man driven vehicle; selecting the position and the speed of the vehicle as state variables, and establishing a state vector of the hybrid fleet according to the state variables;
the time domain state transfer equation establishing unit 602 is used for selecting the acceleration of the intelligent networked vehicle as a control variable and establishing a fleet continuous time domain state transfer equation based on the control variable, the vehicle kinematics model and the speed difference stress-response model;
the augmented form state equation establishing unit 603 is configured to discretize the continuous time domain state transition equation to obtain an augmented form state equation;
and the vehicle track control unit 604 is used for establishing an optimization objective function aiming at the minimum difference between the motion state and the ideal state of the intelligent internet vehicle at the stop line of the intersection and the minimum accumulated oil consumption of the hybrid fleet, determining a constraint condition of the optimization objective function, and obtaining the vehicle tracks of the intelligent internet vehicle and the fully-manually driven vehicle in the hybrid fleet based on the state equation of the augmented form, the optimization objective function and the constraint condition.
The vehicle trajectory control device 600 provided in the foregoing embodiment may implement the technical solutions described in the foregoing vehicle trajectory control method embodiments, and the specific implementation principles of the modules or units may refer to the corresponding contents in the foregoing vehicle trajectory control method embodiments, and are not described herein again.
As shown in fig. 7, the present invention further provides an electronic device 700. The electronic device 700 includes a processor 701, a memory 702, and a display 703. Fig. 7 shows only some of the components of the electronic device 700, but it is to be understood that not all of the shown components are required to be implemented, and that more or fewer components may be implemented instead.
The storage 702 may in some embodiments be an internal storage unit of the electronic device 700, such as a hard disk or a memory of the electronic device 700. The memory 702 may also be an external storage device of the electronic device 700 in other embodiments, such as a plug-in hard disk, a Smart Media Card (SMC), a Secure Digital (SD) Card, a Flash memory Card (Flash Card), etc., provided on the electronic device 700.
Further, the memory 702 may also include both internal storage units and external storage devices of the electronic device 700. The memory 702 is used for storing application software and various types of data for installing the electronic apparatus 700.
The processor 701 may be, in some embodiments, a Central Processing Unit (CPU), microprocessor or other data Processing chip for executing program codes stored in the memory 702 or Processing data, such as the vehicle trajectory control method of the present invention.
The display 703 may be an LED display, a liquid crystal display, a touch-sensitive liquid crystal display, an OLED (Organic Light-Emitting Diode) touch panel, or the like in some embodiments. The display 703 is used for displaying information at the electronic device 700 and for displaying a visual user interface. The components 701 and 703 of the electronic device 700 communicate with each other via a system bus.
In one embodiment, when the processor 701 executes the vehicle trajectory control program in the memory 702, the following steps may be implemented:
dividing the mixed fleet into a plurality of sub fleets by taking the intelligent networked vehicles as head vehicles, wherein each sub fleet comprises one intelligent networked vehicle and at least one full-manual driving vehicle; selecting the vehicle position and the vehicle speed as state variables, and establishing a state vector of the hybrid fleet according to the state variables;
selecting the acceleration of the intelligent networked vehicle as a control variable, and establishing a fleet continuous time domain state transfer equation based on the control variable, a vehicle kinematics model and a speed difference stress-response model;
discretizing the continuous time domain state transition equation to obtain an augmented form state equation;
the method comprises the steps of establishing an optimization objective function with the aim of minimizing the difference between the motion state and the ideal state of the intelligent networked vehicle at a stop line of an intersection and minimizing the accumulated oil consumption of a hybrid vehicle fleet, determining a constraint condition of the optimization objective function, and obtaining vehicle tracks of the intelligent networked vehicle and the fully-manually-driven vehicle in the hybrid vehicle fleet based on an augmentation form state equation, the optimization objective function and the constraint condition.
It should be understood that: when the processor 701 executes the vehicle trajectory control program in the memory 702, other functions may be implemented besides the above functions, which may be specifically referred to the description of the corresponding method embodiments above.
Further, the type of the electronic device 700 is not particularly limited in the embodiments of the present invention, and the electronic device 700 may be a portable electronic device such as a mobile phone, a tablet computer, a Personal Digital Assistant (PDA), a wearable device, and a laptop computer (laptop). Exemplary embodiments of portable electronic devices include, but are not limited to, portable electronic devices that carry an IOS, android, microsoft, or other operating system. The portable electronic device may also be other portable electronic devices such as laptop computers (laptop) with touch sensitive surfaces (e.g., touch panels) and the like. It should also be understood that in other embodiments of the present invention, the electronic device 700 may not be a portable electronic device, but may be a desktop computer having a touch-sensitive surface (e.g., a touch panel).
Accordingly, the present application further provides a computer-readable storage medium, which is used for storing a computer-readable program or instruction, and when the program or instruction is executed by a processor, the steps or functions of the vehicle trajectory control method provided by the above method embodiments can be implemented.
Those skilled in the art will appreciate that all or part of the flow of the method implementing the above embodiments may be implemented by a computer program, which may be stored in a computer-readable storage medium, to instruct associated hardware. The computer readable storage medium is a magnetic disk, an optical disk, a read-only memory or a random access memory.
The vehicle track control method, apparatus, electronic device and storage medium provided by the present invention are described in detail above, and specific examples are applied herein to explain the principles and embodiments of the present invention, and the descriptions of the above embodiments are only used to help understanding the method and its core idea of the present invention; meanwhile, for those skilled in the art, according to the idea of the present invention, the specific embodiments and the application range may be changed, and in summary, the content of the present specification should not be construed as limiting the present invention.

Claims (9)

1. A vehicle trajectory control method for controlling trajectories of vehicles in a hybrid fleet of vehicles, the hybrid fleet comprising a plurality of intelligent networked vehicles and a plurality of fully human driven vehicles, the vehicle trajectory control method comprising:
dividing the mixed fleet into a plurality of sub fleets by taking the intelligent networked vehicle as a head vehicle, wherein each sub fleet comprises one intelligent networked vehicle and at least one full-manual driving vehicle; selecting the vehicle position and the vehicle speed of the intelligent networked vehicle and the vehicle position, the vehicle speed and the vehicle acceleration of the fully-manually-driven vehicle as state variables, and establishing a state vector of the hybrid fleet according to the state variables;
selecting the acceleration of the intelligent networked vehicle as a control variable, and establishing a fleet continuous time domain state transfer equation based on the control variable, a vehicle kinematics model and a speed difference stress-response model;
discretizing the continuous time domain state transition equation to obtain an augmented form state equation;
establishing an optimization objective function with the purpose of minimizing the difference between the motion state and the ideal state of the intelligent networked vehicle at a stop line of an intersection and minimizing the accumulated oil consumption of the hybrid vehicle fleet, determining a constraint condition of the optimization objective function, and obtaining vehicle tracks of the intelligent networked vehicle and the fully-manually-driven vehicle in the hybrid vehicle fleet based on the state equation of the augmented form, the optimization objective function and the constraint condition;
the establishing of the fleet continuous time domain state transfer equation based on the control variables, the vehicle kinematics model and the speed difference stress-response model comprises the following steps:
establishing a head-vehicle state equation of the intelligent networked vehicle based on the control variables and the vehicle kinematics model;
establishing a following vehicle linear time-varying state equation of the fully manually driven vehicle based on the control variables and the speed difference stress-response model;
and establishing a fleet continuous time domain state transfer equation of the sub fleet based on the head vehicle state equation and the following vehicle state equation.
2. The vehicle trajectory control method of claim 1, wherein the fleet continuous time domain state transition equation is:
Figure 508271DEST_PATH_IMAGE001
Figure 931162DEST_PATH_IMAGE002
Figure 396910DEST_PATH_IMAGE003
Figure 235553DEST_PATH_IMAGE004
Figure 454044DEST_PATH_IMAGE005
Figure 719941DEST_PATH_IMAGE006
Figure 404475DEST_PATH_IMAGE007
in the formula (I), the compound is shown in the specification,
Figure 905864DEST_PATH_IMAGE008
is composed of
Figure 995174DEST_PATH_IMAGE009
The position of the intelligent networked vehicle of the mth sub-fleet at the moment;
Figure 166392DEST_PATH_IMAGE010
is composed of
Figure 590420DEST_PATH_IMAGE009
The speed of the intelligent networked vehicle of the mth sub-fleet at the moment;
Figure 380653DEST_PATH_IMAGE011
the position of the intelligent networked vehicle of the mth sub-fleet at the moment t;
Figure 980261DEST_PATH_IMAGE012
the speed of the intelligent networked vehicle of the mth sub-fleet at the moment t;
Figure 844750DEST_PATH_IMAGE013
the acceleration of the intelligent networked vehicle of the mth sub-fleet at the moment t;
Figure 756074DEST_PATH_IMAGE014
instantaneous acceleration of the nth fully manually driven vehicle in any mth sub-fleet;
Figure 84419DEST_PATH_IMAGE015
the driver sensitivity coefficient is used for representing the stress response speed of the fully-manually driven vehicle along with the change of the speed difference and is a constant;
Figure 538534DEST_PATH_IMAGE016
the real-time distance difference between the current vehicle and the preceding vehicle,
Figure 441768DEST_PATH_IMAGE017
an optimal speed model is obtained;
Figure 981334DEST_PATH_IMAGE018
is the first derivative;
Figure 381878DEST_PATH_IMAGE019
for mth sub-fleet
Figure 690499DEST_PATH_IMAGE020
A state vector of a time;
Figure 30214DEST_PATH_IMAGE021
the state transition matrix is the state transition matrix of the mth sub-fleet in the continuous time domain;
Figure 791496DEST_PATH_IMAGE022
the mth sub-fleet is
Figure 383015DEST_PATH_IMAGE023
A state vector of a time;
Figure 421509DEST_PATH_IMAGE024
an input matrix of the mth sub-fleet in a continuous time domain;
Figure 135387DEST_PATH_IMAGE025
is the input vector of the mth sub-fleet.
3. The vehicle trajectory control method of claim 1, wherein discretizing the continuous time domain state transition equation to obtain an augmented form state equation comprises:
discretizing the continuous time domain state transition equation based on discrete sampling step length, and establishing a state transition and state output equation in a discrete time domain;
obtaining an incremental form state equation based on the state transition equation and the state output equation in the discrete time domain;
and obtaining an augmented form state equation in the prediction time domain based on the incremental form state equation.
4. The vehicle trajectory control method according to claim 3, characterized in that the augmented form state equation includes an augmented state transition equation and an augmented state output equation;
the augmented state transition equation is:
Figure 915124DEST_PATH_IMAGE026
Figure 388962DEST_PATH_IMAGE027
Figure 406597DEST_PATH_IMAGE028
the output equation of the augmentation state is as follows:
Figure 88114DEST_PATH_IMAGE029
Figure 823988DEST_PATH_IMAGE030
Figure 632676DEST_PATH_IMAGE031
Figure 504817DEST_PATH_IMAGE032
Figure 357235DEST_PATH_IMAGE033
Figure 580406DEST_PATH_IMAGE034
Figure 393117DEST_PATH_IMAGE035
Figure 385343DEST_PATH_IMAGE036
Figure 143084DEST_PATH_IMAGE037
Figure 197759DEST_PATH_IMAGE038
Figure 800778DEST_PATH_IMAGE039
Figure 178670DEST_PATH_IMAGE040
in the formula (I), the compound is shown in the specification,
Figure 858044DEST_PATH_IMAGE041
to be composed of
Figure 321387DEST_PATH_IMAGE042
Augmented state vector prediction of time of day
Figure 869043DEST_PATH_IMAGE043
An augmented state vector of time;
Figure 960495DEST_PATH_IMAGE044
is composed of
Figure 935405DEST_PATH_IMAGE042
An augmented state vector of time;
Figure 761409DEST_PATH_IMAGE045
a state transition matrix in an augmented form for the mth sub-fleet within the prediction horizon;
Figure 112756DEST_PATH_IMAGE046
a state transition matrix in an augmented form within a prediction horizon;
Figure 199661DEST_PATH_IMAGE047
an input matrix in an augmented form for the mth sub-fleet;
Figure 735685DEST_PATH_IMAGE048
the change value of the control vector at the k moment;
Figure 642461DEST_PATH_IMAGE049
to be composed of
Figure 421934DEST_PATH_IMAGE042
Output vector prediction of time of day
Figure 363345DEST_PATH_IMAGE043
An output vector of time;
Figure 70270DEST_PATH_IMAGE050
a state transition matrix in a discrete time domain;
Figure 464342DEST_PATH_IMAGE051
as a discrete time domainAn input matrix within;
Figure 423071DEST_PATH_IMAGE021
the state transition matrix is the state transition matrix of the mth sub-fleet in the continuous time domain;
Figure 94355DEST_PATH_IMAGE024
the input matrix is the input matrix of the mth sub-fleet in the continuous time domain; ca is a preset matrix in an augmented form; e is a natural constant, and tau is a discretized control matrix; i is an identity matrix; o is a zero matrix.
5. The vehicle trajectory control method of claim 1, wherein the establishing an optimization objective function with the objective of minimizing the difference between the motion state and the ideal state of the intelligent networked vehicle at the intersection stop line and minimizing the cumulative fuel consumption of the hybrid fleet comprises:
acquiring a motion state vector difference between a motion state of the intelligent networked vehicle at a stop line of an intersection and an ideal state in a prediction time domain;
acquiring a control vector difference of the intelligent networked vehicle in a control time domain;
acquiring the instantaneous oil consumption of the intelligent networked vehicles and the full-manual driving vehicles in each sub-fleet;
and establishing the optimization objective function based on the motion state vector difference, the control vector difference and the instantaneous fuel consumption.
6. The vehicle trajectory control method according to claim 5, characterized in that the optimization objective function is:
Figure 706602DEST_PATH_IMAGE052
Figure 853549DEST_PATH_IMAGE053
Figure 84810DEST_PATH_IMAGE054
Figure 876180DEST_PATH_IMAGE055
in the formula (I), the compound is shown in the specification,
Figure 800274DEST_PATH_IMAGE056
is the optimization objective function;
Figure 434517DEST_PATH_IMAGE057
actual output vectors in the ith prediction step length of the intelligent networked vehicles of the mth sub-fleet are obtained;
Figure 594103DEST_PATH_IMAGE058
a reference output vector in the ith prediction step length of the intelligent networked vehicle of the mth sub-fleet is obtained;
Figure 708821DEST_PATH_IMAGE059
the actual control vector is in the ith control step length of the intelligent networked vehicle of the mth sub-fleet;
Figure 803816DEST_PATH_IMAGE060
the reference control vector is a reference control vector in the ith control step length of the intelligent networked vehicle of the mth sub-fleet; q is a weight factor matrix of the output vector; r is a weight factor matrix of the control vector;
Figure 518831DEST_PATH_IMAGE061
instantaneous fuel consumption of intelligent networked vehicles in each sub-fleet;
Figure 698752DEST_PATH_IMAGE062
instantaneous fuel consumption for all manually driven vehicles in each sub-vehicle; and | | is a norm.
7. A vehicle trajectory control device for controlling trajectories of vehicles in a hybrid fleet of vehicles, the hybrid fleet comprising a plurality of intelligent networked vehicles and a plurality of fully human driven vehicles, the vehicle trajectory control device comprising:
the hybrid fleet division unit is used for dividing the hybrid fleet into a plurality of sub-fleets by taking the intelligent networked vehicles as head vehicles, and each sub-fleet comprises one intelligent networked vehicle and at least one full-manual driving vehicle; selecting the vehicle position and the vehicle speed of the intelligent networked vehicle and the vehicle position, the vehicle speed and the vehicle acceleration of the full-manual driving vehicle as state variables, and establishing a state vector of the hybrid fleet according to the state variables;
the time domain state transfer equation establishing unit is used for selecting the acceleration of the intelligent networked vehicle as a control variable and establishing a continuous time domain state transfer equation of the fleet based on the control variable, a vehicle kinematics model and a speed difference stress-response model;
the augmented form state equation establishing unit is used for discretizing the continuous time domain state transfer equation to obtain an augmented form state equation;
the vehicle track control unit is used for establishing an optimization objective function with the purposes of minimizing the difference between the motion state and the ideal state of the intelligent networked vehicle at a stop line of an intersection and minimizing the accumulated oil consumption of the hybrid vehicle fleet, determining the constraint condition of the optimization objective function, and obtaining the vehicle tracks of the intelligent networked vehicle and the fully-manually-driven vehicle in the hybrid vehicle fleet based on the state equation of the augmented form, the optimization objective function and the constraint condition;
the establishing of the fleet continuous time domain state transfer equation based on the control variables, the vehicle kinematics model and the speed difference stress-response model comprises the following steps:
establishing a head-vehicle state equation of the intelligent networked vehicle based on the control variables and the vehicle kinematics model;
establishing a following vehicle linear time-varying state equation of the fully manually driven vehicle based on the control variables and the speed difference stress-response model;
and establishing a fleet continuous time domain state transfer equation of the sub fleet based on the head vehicle state equation and the following vehicle state equation.
8. An electronic device comprising a memory and a processor, wherein,
the memory is used for storing programs;
the processor, coupled with the memory, is configured to execute the program stored in the memory to implement the steps of the vehicle trajectory control method of any one of the preceding claims 1 to 6.
9. A computer-readable storage medium storing a computer-readable program or instructions, which when executed by a processor, implement the steps of the vehicle trajectory control method of any one of claims 1 to 6.
CN202210293317.3A 2022-03-24 2022-03-24 Vehicle track control method and device, electronic equipment and storage medium Active CN114387787B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210293317.3A CN114387787B (en) 2022-03-24 2022-03-24 Vehicle track control method and device, electronic equipment and storage medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210293317.3A CN114387787B (en) 2022-03-24 2022-03-24 Vehicle track control method and device, electronic equipment and storage medium

Publications (2)

Publication Number Publication Date
CN114387787A CN114387787A (en) 2022-04-22
CN114387787B true CN114387787B (en) 2022-08-23

Family

ID=81205258

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210293317.3A Active CN114387787B (en) 2022-03-24 2022-03-24 Vehicle track control method and device, electronic equipment and storage medium

Country Status (1)

Country Link
CN (1) CN114387787B (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116386387B (en) * 2023-04-19 2024-03-08 长安大学 Method and device for predicting following behavior of driving vehicle of hybrid queue person
CN116804852B (en) * 2023-06-25 2024-03-22 北京交通大学 Mixed motorcade ecological driving track optimization method

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108877256A (en) * 2018-06-27 2018-11-23 南京邮电大学 Intersection based on wireless communication nearby disperses cooperative self-adapted cruise control method
DE102017011694A1 (en) * 2017-12-18 2019-06-19 Audi Ag Transport system and method for operating a transport system
CN110942645A (en) * 2019-11-06 2020-03-31 清华大学 Vehicle control method for hybrid traffic intersection
CN113096402A (en) * 2021-04-12 2021-07-09 中南大学 Dynamic speed limit control method, system, terminal and readable storage medium based on intelligent networked vehicle
CN113299107A (en) * 2021-05-08 2021-08-24 东南大学 Multi-target fusion intersection dynamic vehicle internet speed guiding control method
CN113335277A (en) * 2021-04-27 2021-09-03 北京工业大学 Intelligent cruise control method and device, electronic equipment and storage medium
CN113763742A (en) * 2020-06-01 2021-12-07 大唐移动通信设备有限公司 Method, device and storage medium for assisting driving of fleet based on MEC
CN113791615A (en) * 2021-08-20 2021-12-14 北京工业大学 Hybrid vehicle queue distributed model prediction control method

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10288439B2 (en) * 2017-02-22 2019-05-14 Robert D. Pedersen Systems and methods using artificial intelligence for routing electric vehicles
CN107628029B (en) * 2017-08-22 2019-06-18 清华大学 A kind of energy-saving stability motion control method of net connection automobile queue
EP3790295B1 (en) * 2019-09-09 2024-05-29 Volkswagen AG Method, computer program, and apparatus for determining a minimum inter-vehicular distance for a platoon, vehicle, traffic control entity

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102017011694A1 (en) * 2017-12-18 2019-06-19 Audi Ag Transport system and method for operating a transport system
CN108877256A (en) * 2018-06-27 2018-11-23 南京邮电大学 Intersection based on wireless communication nearby disperses cooperative self-adapted cruise control method
CN110942645A (en) * 2019-11-06 2020-03-31 清华大学 Vehicle control method for hybrid traffic intersection
CN113763742A (en) * 2020-06-01 2021-12-07 大唐移动通信设备有限公司 Method, device and storage medium for assisting driving of fleet based on MEC
CN113096402A (en) * 2021-04-12 2021-07-09 中南大学 Dynamic speed limit control method, system, terminal and readable storage medium based on intelligent networked vehicle
CN113335277A (en) * 2021-04-27 2021-09-03 北京工业大学 Intelligent cruise control method and device, electronic equipment and storage medium
CN113299107A (en) * 2021-05-08 2021-08-24 东南大学 Multi-target fusion intersection dynamic vehicle internet speed guiding control method
CN113791615A (en) * 2021-08-20 2021-12-14 北京工业大学 Hybrid vehicle queue distributed model prediction control method

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
Jiangchen Li 等.Dynamic Traffic Shockwave Speed Estimation in Connected Vehicle Environment.《2017 4th International Conference on Transportation Onformation and Safety》.2017, *
李玉莹.车路协同环境下交叉路口自动驾驶车辆智能调度机制.《中国优秀博硕士学位论文全文数据库(硕士)工程科技Ⅱ辑》.2022,(第03期), *
马瀚森.基于MPC与预瞄理论的自动驾驶车辆轨迹跟随控制研究.《浙江科技学院2021学位授予》.2021, *

Also Published As

Publication number Publication date
CN114387787A (en) 2022-04-22

Similar Documents

Publication Publication Date Title
CN114387787B (en) Vehicle track control method and device, electronic equipment and storage medium
WO2021238303A1 (en) Motion planning method and apparatus
Feng et al. Spatiotemporal intersection control in a connected and automated vehicle environment
US9002612B2 (en) Prediction of driver-specific cruise speed using dynamic modeling
Pan et al. Integrated optimal control strategies for freeway traffic mixed with connected automated vehicles: A model-based reinforcement learning approach
Hu et al. Cut through traffic to catch green light: Eco approach with overtaking capability
CN108073076B (en) Vehicle control method and device
CN113312752B (en) Traffic simulation method and device for main road priority control intersection
KR101945103B1 (en) An apparatus for controlling drive mode of plug-in hybrid electric vehicle and method thereof
KR102247168B1 (en) Obstacle filtering method of non-avoidance planning system in autonomous vehicle
CN113963564B (en) Method, system and medium for planning optimal passing speed of continuous signal lamp road vehicle
CN113008253A (en) Hybrid vehicle running method, device and storage medium
CN113628459B (en) Bus priority method for reserved intersection facing intermittent bus lane
Zhao et al. Path-forecasting for HEV optimal energy management (POEM)
CN114766022A (en) Vehicle dynamics and powertrain control system and method using multi-time domain optimization
Li et al. Simulation-based optimization of maximum green setting under retrospective approximation framework
KR20210059493A (en) Lane information generation system by lane
CN113635900B (en) Channel switching decision control method based on energy management in predicted cruising process
CN115469669A (en) Narrow road meeting method, device, equipment and storage medium
CN115454082A (en) Vehicle obstacle avoidance method and system, computer readable storage medium and electronic device
Held et al. Optimal speed control of a heavy-duty vehicle in the presence of traffic lights
CN112463353A (en) Method for calculating a function for a vehicle
KR102634255B1 (en) Dynamic adaptive buffer for distributed simulation and method controlling thereof
Caligaris et al. Model predictive control for multiclass freeway traffic
CN113805485B (en) Warm start C/GMRES method, system, equipment and medium

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
PE01 Entry into force of the registration of the contract for pledge of patent right

Denomination of invention: Vehicle trajectory control methods, devices, electronic devices, and storage media

Effective date of registration: 20231010

Granted publication date: 20220823

Pledgee: Bank of China Limited Wuhan Economic and Technological Development Zone sub branch

Pledgor: ISMARTWAYS (WUHAN) TECHNOLOGY Co.,Ltd.

Registration number: Y2023980060478

PE01 Entry into force of the registration of the contract for pledge of patent right