[go: up one dir, main page]
More Web Proxy on the site http://driver.im/

CN116798232B - A multi-vehicle collaborative decision-making system that combines vehicle priority and artificial fish schools - Google Patents

A multi-vehicle collaborative decision-making system that combines vehicle priority and artificial fish schools Download PDF

Info

Publication number
CN116798232B
CN116798232B CN202310998816.7A CN202310998816A CN116798232B CN 116798232 B CN116798232 B CN 116798232B CN 202310998816 A CN202310998816 A CN 202310998816A CN 116798232 B CN116798232 B CN 116798232B
Authority
CN
China
Prior art keywords
vehicle
vehicles
force
priority
distance
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
CN202310998816.7A
Other languages
Chinese (zh)
Other versions
CN116798232A (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.)
Chongqing University of Post and Telecommunications
Original Assignee
Chongqing University of Post and Telecommunications
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 Chongqing University of Post and Telecommunications filed Critical Chongqing University of Post and Telecommunications
Priority to CN202310998816.7A priority Critical patent/CN116798232B/en
Publication of CN116798232A publication Critical patent/CN116798232A/en
Application granted granted Critical
Publication of CN116798232B publication Critical patent/CN116798232B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Traffic Control Systems (AREA)

Abstract

The invention relates to a multi-vehicle collaborative decision-making system combining vehicle priority and artificial fish shoals, and belongs to the field of traffic informatization. The system is divided into three parts: the workshop force field analysis subsystem, the vehicle-vehicle cooperative relation analysis subsystem and the multi-vehicle cooperative planning decision-making subsystem. Aiming at the problem of poor modeling effect of the traditional dynamic environment of force field processing, a potential field model considering the vehicle speed is designed, the workshop acting force based on the distance relation and the interaction force in the vehicle speed change process are considered, and the modeling accuracy of the interaction force between the vehicle groups in the dynamic environment is improved. A priority algorithm is designed in the single vehicle processing, and three cooperative schemes are designed aiming at the multi-vehicle situation. According to the invention, the intelligent road side sensing and V2X communication technology at the road end is fully utilized to acquire real-time traffic data, the data processing is mainly concentrated in the high-performance computing equipment at the road side, and the multi-vehicle collaborative decision model at the road side is optimized, so that the traffic efficiency of the road junction can be effectively improved, and the road junction congestion is reduced.

Description

Multi-vehicle collaborative decision-making system combining vehicle priority and artificial fish shoal
Technical Field
The invention belongs to the field of traffic informatization, and relates to a multi-vehicle collaborative decision-making system combining vehicle priority and artificial fish shoals.
Background
In recent years, with the increasing prominence of traffic jam problems and the increasing traffic safety requirements, vehicle group collaborative planning becomes one of research hotspots in the intelligent traffic field. The cooperative planning of the vehicle group aims at improving the running efficiency of the road and the throughput capacity of traffic flow by optimizing the running strategy of the vehicle, thereby reducing traffic jam and providing safer and more efficient traffic environment.
The current research methods focus mainly on the following aspects: sensor technology, communication technology, traffic models, and cooperative control strategies. These methods attempt to achieve synergistic travel and mitigation of traffic congestion between clusters of vehicles by collecting and analyzing data of vehicles and roads. However, these methods also have some important research drawbacks.
First, current research methods tend to ignore the effect of priority differences between vehicles and the manner of manual intervention on efficiency. In actual traffic, different types of vehicles (such as emergency vehicles, public transportation vehicles, large and medium-sized vehicles) have different priorities and need to be specially treated. However, most research methods employ the same rules and strategies for all vehicles, and do not take into account well the individual characteristics of the vehicle and the behavior habits of humans. This results in that the planning result may not be flexible and reliable enough to meet the changes of the actual traffic situation.
Secondly, the existing research method lacks a unified optimization framework in the vehicle group collaborative planning. The driving strategies between vehicles are often independently formulated and adjusted, and the behaviors of the vehicles cannot be well coordinated and integrated. This results in an inability to maximize traffic flow efficiency and throughput, with problems of traffic congestion and delays.
In addition, the existing methods have some limitations in terms of traffic information acquisition and processing. Although sensor technology and communication technology are evolving and abundant traffic data is available, how to efficiently process and utilize such data remains a challenge. The current research method only considers static traffic model and historical data, and lacks full utilization of dynamic traffic condition and real-time data. This limits the adaptability and responsiveness of the research methods so that the traffic system cannot cope with complex traffic environments and emergencies in time.
Therefore, in order to solve the insufficient multi-vehicle cooperation and the need of vehicle-road cooperation, a safe and efficient multi-vehicle cooperation decision service is provided, travel safety and propulsion cooperation development are guaranteed, and a unidirectional multi-lane vehicle group cooperation planning method combining vehicle priority and group intelligence is needed, so that a safe and reliable multi-vehicle cooperation driving scheme is provided for a smart traffic scene under the internet of vehicles, and vehicle-road cooperation and subsequent unmanned driving are realized.
Disclosure of Invention
In view of the above, the present invention is directed to a multi-vehicle collaborative decision-making system combining vehicle priority and artificial fish school.
In order to achieve the above purpose, the present invention provides the following technical solutions:
a multi-vehicle collaborative decision-making system combining vehicle priority and artificial fish shoals comprises a workshop force field analysis subsystem, a vehicle-vehicle collaborative relation analysis subsystem and a multi-vehicle collaborative planning decision-making subsystem.
The vehicle-to-vehicle virtual action force field is constructed according to the position and speed change based on the relation between vehicles analyzed by the workshop force field analysis subsystem;
the vehicle-vehicle cooperative relationship analysis subsystem adopts an artificial fish swarm algorithm to carry out multi-vehicle cooperative planning, and in the searching process of the fish swarm, the mutual attraction and repulsion between individuals are calculated through the potential field relationship between vehicles to simulate the fish swarm behavior; carrying out iterative computation by considering the specificities of different vehicle types in an artificial fish swarm algorithm to obtain an optimal result;
the multi-vehicle collaborative planning decision making subsystem combines the results obtained by the fish swarm algorithm and designs three multi-vehicle collaborative planning decision schemes of vehicle formation control, vehicle obstacle avoidance control and vehicle formation transformation control according to the common situations of traffic roads.
Optionally, the workshop force field analysis subsystem acquires vehicle information from the RSU, including position, speed and acceleration information of the vehicle and the obstacle, extracts the vehicle information, sets a virtual force field for the vehicle group, and performs force field modeling according to the position information and the speed information between the vehicles to obtain a relative acting force relationship between the vehicles; wherein, the gravitational field formula is:k in the formula a 、K av For the position gain coefficient and the speed gain coefficient, q and v are the current position and speed of the individual, q g 、v g For the position and velocity of the target point, the attraction force is calculated as: f (F) a =-grad|U a (q)|=-K a |q-q g |-K av V-vg |; the repulsive field is: />K in the formula r 、K rv For the position gain coefficient and the velocity gain coefficient, ρ (q, q g ) For the distance of the individual from the obstacle ρ 0 To calculate the influence distance of the repulsive force potential field, the repulsive force is calculated as: />
Optionally, in the process of searching the artificial fish shoal, calculating mutual attraction force and repulsive force among individuals by using a formula obtained by the workshop force field analysis subsystem to simulate the fish shoal behavior, and performing specific treatment on the fish shoal according to the types of different vehicles when calculating the fitness evaluation of each fish, wherein the specific treatment comprises the following steps: when calculating the fitness evaluation of each fish, the volume parameters of different vehicle types are included into calculation; meanwhile, a priority mechanism is introduced for improving the response speed of the algorithm to the emergency vehicle, and three priorities of high, medium and low are set for vehicles of different vehicle types; the gravitation formula and the repulsion formula of the vehicle volume are respectively:and->Wherein V represents the volume of the vehicle, V g Representing the volume of another vehicle; if the vehicle body exceeds a certain volume, the attraction force between the two vehicles becomes smaller, and the repulsive force becomes larger; comprehensively setting priority according to the influence degree of vehicles on traffic jam and the passing priority of vehicles, setting emergency vehicles of emergency ambulances or police vehicles as high priority, setting buses or buses of schools as medium priority, and setting the emergency vehicles or emergency vehicles as medium priorityThe medium-sized vehicle or truck dangerous vehicle is set as a secondary medium priority, and the common sedan is set as a low priority for processing; and finally, carrying out multiple iterations on the artificial fish swarm algorithm to obtain the calculated optimal result.
Optionally, the vehicle formation control simulates a fish swarm model to establish a vehicle induction area, analyzes the resultant force between vehicles to reach an equilibrium state, adjusts the movement direction of the vehicles and the distance between the vehicles according to a potential force field formula, and obtains the optimal holding speed of the vehicles based on a headway formula and combining the optimal holding distance between the vehicles;
the vehicle obstacle avoidance control requires that the relative distance between vehicles is not changed as much as possible so as to ensure the balance state between the vehicles; meanwhile, the obstacle is regarded as a repulsive field, and under the action of the target vehicle and the obstacle, the obstacle avoidance effect is realized by performing angle offset in the vertical direction;
the vehicle formation transformation control realizes transformation of the triangular vehicle formation into a linear formation by carrying out cooperative lane change so as to ensure the safety among vehicle groups; during running, the vehicle groups are uniformly distributed on a plurality of lanes and are expressed as triangular formations; when encountering an obstacle or avoiding a lane for a high-priority vehicle, the vehicle team is changed into a straight line formation through cooperative lane changing.
Optionally, after the vehicle formation control meeting, a vehicle maintenance control scheme is proposed; the vehicle formation control firstly calculates the magnitudes of two forces according to an attraction force calculation formula and a repulsion force calculation formula respectively, and the vehicle F a =F r Calculating an optimal holding distance between vehicles by stress balance, and then calculating a formula s=t according to a headstock distance formula h * v calculating an optimal holding speed of the vehicle; wherein S is the longitudinal distance between two vehicle heads, v is the real-time speed of the vehicle, T h The time interval is the time interval of the head of two continuous vehicles passing through a certain section time interval in a vehicle queue running on the same lane; the vehicle formation retention is achieved when the vehicle formation is not subjected to external forces but only internal forces.
Optionally, in the vehicle obstacle avoidance control, in order to ensure the stress balance in the fleet, it is required to keep the vehicleThe resultant force of the distance and the speed of the vehicle group of the vehicle and the nearby vehicle counteracts to zero, meanwhile, the obstacle is regarded as a repulsive field, and the repulsive force and the obstacle avoidance rotation angle of the vehicle are calculated according to the distance between the vehicle and the obstacle; the vehicle can move to the inner lane when avoiding the obstacle, so that the distance between vehicles is reduced, and the speed of the vehicles is changed according to a resultant force formula to ensure the stress balance; between the vehicle and the obstacle, the relative components of the X and Y axes of the repulsive force between the vehicle and the obstacle are calculated according to the GPS positioning information of the vehicle and the obstacle: (F) r .x,F r Y) = (x_car-x_obstacle, y_car-y_obstacle), the obstacle avoidance rotation angle of the vehicle is obtained by the following formula: θ=atan2 (F) r .y,F r X); finally, the vehicle rotates according to the calculated angle theta to achieve the obstacle avoidance effect.
Optionally, in the vehicle formation transformation control, the control is set at time t 1 The real-time speed of the time neighbor vehicle is v 0 A term is additionally introduced into the calculation of the repulsive force to characterize the influence of the speed of the neighbor lane on the repulsive force: f (F) rnew =F r *(1/dis tan ce)*(1+v 0 ) Wherein distance represents the distance between the vehicle and the vehicle behind the adjacent vehicle, and then the formula of the rotation angle of the updated vehicle to the adjacent lane is as follows: θ avoid =atan2(F rnew .y,F rnew X); and the vehicles change lanes to the neighbor lanes according to the rotation angle, and finally, the formation change of the vehicles is realized.
The invention has the beneficial effects that: according to the invention, the intelligent road side sensing and V2X communication technology at the road end is fully utilized to acquire real-time traffic data, the data processing is mainly concentrated in the high-performance computing equipment at the road side, and the multi-vehicle collaborative decision model at the road side is optimized, so that the traffic efficiency of the road junction can be effectively improved, and the road junction congestion is reduced.
Additional advantages, objects, and features of the invention will be set forth in part in the description which follows and in part will become apparent to those having ordinary skill in the art upon examination of the following or may be learned from practice of the invention. The objects and other advantages of the invention may be realized and obtained by means of the instrumentalities and combinations particularly pointed out in the specification.
Drawings
For the purpose of making the objects, technical solutions and advantages of the present invention more apparent, the present invention will be described in the following preferred detail with reference to the accompanying drawings, in which:
FIG. 1 is a system frame diagram of the present invention;
FIG. 2 is a flow chart of the multi-vehicle collaborative planning scheme formulation of the present invention;
FIG. 3 is a schematic view of a multi-vehicle cooperative obstacle avoidance system according to the present invention;
FIG. 4 is a schematic diagram of a vehicle formation transformation of the present invention.
Detailed Description
Other advantages and effects of the present invention will become apparent to those skilled in the art from the following disclosure, which describes the embodiments of the present invention with reference to specific examples. The invention may be practiced or carried out in other embodiments that depart from the specific details, and the details of the present description may be modified or varied from the spirit and scope of the present invention. It should be noted that the illustrations provided in the following embodiments merely illustrate the basic idea of the present invention by way of illustration, and the following embodiments and features in the embodiments may be combined with each other without conflict.
Wherein the drawings are for illustrative purposes only and are shown in schematic, non-physical, and not intended to limit the invention; for the purpose of better illustrating embodiments of the invention, certain elements of the drawings may be omitted, enlarged or reduced and do not represent the size of the actual product; it will be appreciated by those skilled in the art that certain well-known structures in the drawings and descriptions thereof may be omitted.
The same or similar reference numbers in the drawings of embodiments of the invention correspond to the same or similar components; in the description of the present invention, it should be understood that, if there are terms such as "upper", "lower", "left", "right", "front", "rear", etc., that indicate an azimuth or a positional relationship based on the azimuth or the positional relationship shown in the drawings, it is only for convenience of describing the present invention and simplifying the description, but not for indicating or suggesting that the referred device or element must have a specific azimuth, be constructed and operated in a specific azimuth, so that the terms describing the positional relationship in the drawings are merely for exemplary illustration and should not be construed as limiting the present invention, and that the specific meaning of the above terms may be understood by those of ordinary skill in the art according to the specific circumstances.
The method comprises the steps of firstly acquiring vehicle information from an RSU, including information such as positions, speeds, accelerations, course angles, road conditions and the like of vehicles and obstacles, extracting relevant information of the vehicles, setting a virtual force field for a vehicle group, and carrying out force field modeling according to the position information and the speed information among the vehicles to obtain a relative acting force relation among the vehicles. According to the actual road condition, constructing a potential field of a workshop by combining a distance relation and a speed change relation between vehicles, wherein the formula of the potential field is as follows:
k in the formula a 、K av For the position gain coefficient and the speed gain coefficient, q and v are the current position and speed of the individual, q g 、v g For the position and velocity of the target point, the attraction force is calculated as:
F a =-grad|U a (q)|=-K a |q-q g |-K av |v-v g |
similarly, the resulting repulsive force field formula is:
k in the formula r 、K rv For the position gain coefficient and the velocity gain coefficient, ρ (q, q g ) For the distance of the individual from the obstacle ρ 0 As the influence distance of the repulsive force potential field, the repulsive force is calculated as:
and the vehicle-vehicle cooperative relationship analysis subsystem is combined with an artificial fish swarm algorithm to carry out multi-vehicle cooperative planning decision. Referring to the flow chart of the multi-vehicle collaborative planning scheme of fig. 2, the influence of the volumes and the urgency of different vehicles on the multi-vehicle collaborative planning is considered in the initialization of individual parameters of the fish shoal. In calculating the fitness evaluation for each fish, the volume parameters for the different vehicle classes are included in the calculation. Meanwhile, in order to improve the response speed of the algorithm to the emergency vehicle, a priority mechanism is introduced, and three priorities of high, medium and low are set for vehicles of different vehicle types. In addition, in the searching process of the shoal of fish, the mutual attraction force and the repulsive force among individuals are calculated through the workshop potential force field obtained by the workshop force field analysis subsystem so as to simulate the shoal of fish.
The vehicle priority weight is calculated by adding a value representing the priority of the vehicle to the basic safety information of the vehicle, the priority being set according to the influence of the vehicle on the road traffic jam and the degree of urgency of the vehicle. Emergency vehicles such as emergency vehicles, police vehicles and the like are generally set to be high in priority, and the priority weight is recorded as 4; vehicles with more passengers, such as buses, buses in schools and the like, are medium priority, and the priority weight is recorded as 3; the large-volume dangerous vehicles such as medium-sized vehicles, trucks and the like are secondary medium priority, and the priority weight is recorded as 2; the ordinary car is marked as low priority, and the priority weight is marked as 1. The own vehicle message filling module of the OBU recognizes the vehicle type and sets the corresponding priority weight, and then fills the BSM message to send to the roadside device and other vehicles.
The multi-vehicle cooperative control algorithm flow based on the fish swarm effect is as follows:
first, initializing a vehicle group system to use a vehicle Car leaders Centrally, a vehicle group instruction is issued according to the same destination conditions. In the initialization of the vehicle information, the corresponding priority is also set according to the kind of the vehicle.
Second, if the individual vehicle Car followers(i) Meets the group conditions by Car leaders To get the dynamic target point close to it, car leaders Detecting vehicles in the perception range, and according to the number of detected vehiclesThe road environment conditions determine the vehicle sports formation. The force of the force field between vehicles is considered in the formation setting. Meanwhile, through vehicle-to-vehicle communication and vehicle-to-road communication, if vehicles with high and medium priority are found in the vehicle group, the vehicles are avoided and pass preferentially.
And thirdly, if the vehicle group reaches the destination, finishing the multi-vehicle collaborative planning control, otherwise, turning to a fourth step.
And fourthly, the motorcade vehicle advances towards the destination, and if the motorcade vehicle encounters an obstacle, the motorcade enters an obstacle avoidance state, and an obstacle avoidance control method is adopted.
Fifth step, if Car leaders The obstacle is met, and the overall obstacle avoidance of the vehicle group is considered under two conditions. Car when the vehicle is in the form of a line followers(i) Will keep the formation unchanged, follow Car leaders Exercise, car leaders The method comprises the steps that an obstacle is avoided in a lane changing mode, and a rear slave vehicle follows a front vehicle to cooperatively avoid the obstacle; when the vehicles are in a nonlinear queue, the neighboring lanes have vehicles to run at the moment, and Car leaders Requesting merging travel from a neighboring lane, if the number of vehicles in the lane where the obstacle is located is small, the following slave vehicle follows Car leaders Motion; if the number of vehicles in the lane where the obstacle is located is large, the rear sub-vehicle is decomposed into a plurality of small vehicle queues, and the vehicle queues apply for the merging driving to the adjacent lanes at proper time respectively. Referring to the multi-vehicle collaborative obstacle avoidance schematic diagram of fig. 3, when applying for merging traveling to a neighboring vehicle, the steering angle and the time for merging steering into the neighboring lane are obtained by calculating the potential occasion force of the vehicle and the vehicle behind the neighboring lane and combining the current speed.
If only Car followers(i) When encountering an obstacle, car followers(i) The obstacle avoidance breaks away from the motorcade and enters an individual obstacle avoidance state.
And (3) finishing obstacle avoidance of the obstacle avoidance vehicle, finishing an obstacle avoidance state by the vehicle team, entering a third step if the formation is unchanged, otherwise, recovering the original formation to enter the third step.
In the process of the movement of the vehicle, three movement cooperative control methods among the vehicles are defined:
vehicle formation control: knot(s)Establishing a sensing area of the vehicle by combining with an artificial fish swarm algorithm model, specifically, establishing a sensing range L of the periphery of the vehicle according to the vehicle info Influence distance L of repulsive force potential field between vehicles safe And a vehicle sensing area is jointly formed. Wherein the distance between the balance points of the two vehicles is represented by r, the distance between the two vehicles is represented by L, and when s is more than or equal to 0 and less than or equal to L safe When the two vehicles are in collision, the two vehicles are gradually far away until reaching the balance distance under the action of repulsive force; when L safe When s is more than or equal to r, the resultant force born by the two vehicles is counteracted, and the two vehicles are kept relatively balanced; when r is not less than s is not less than L info When the two vehicles are under the action of the force of attraction, the two vehicles are gradually close, and the closing speed is in direct proportion to the magnitude of the resultant force.
The fleet obstacle avoidance control refers to a multi-vehicle collaborative obstacle avoidance schematic diagram of fig. 3. When Car i Car when the distance between the vehicle and the obstacle is smaller than the range of the repulsive force of the obstacle when the obstacle is hit during movement i Will move away from the obstacle under the action of the repulsive force, provided however that Car i And Car j The distance between the two vehicles remains unchanged, and the distance refers to the balance distance between the two vehicles. Under this condition, the resultant force between the vehicles is unchanged, and the vehicle Car i Is affected only by the obstacle.
Formation change control referring to the vehicle formation change schematic of fig. 4. When a vehicle team encounters the conditions of obstacles, narrowing of a road surface and the like, the original vehicle team cannot pass through the road surface, and the vehicle team needs to be changed, so that the vehicles can pass smoothly. The transformation of the linear queue formation and the nonlinear queue formation is a lane change decision taking into account the balance of force fields between vehicles. In general, a part of the shop force is derived from the interaction force generated by the distance between vehicles, and the other part of the force is derived from the force generated by the change in the vehicle speed. When the host vehicle considers the neighboring lane, the relative distance between the host vehicle and the neighboring vehicle is shortened, and in order to ensure reasonable balance, the vehicle speed needs to be increased, and the specific calculation is referred to the potential force field calculation formula. When the rectangular team changes the line shape, the Car leaders Planning individual vehicle online formationsThe location is based on the principle of shortest arrival time. After the position of the vehicle is determined, the distance L between the vehicles is kept unchanged, the angle between the two vehicles is gradually reduced, and the distance L is formed by alpha 1 Becomes alpha 2 And when the angles of the multiple workshops are the same, finishing transformation, and when the line type rectangle is changed, reversing.
And the multi-vehicle collaborative planning based on the fish swarm algorithm establishes the motion planning of the vehicle swarm on the basis of overall optimization, and broadcasts through RSU road side equipment. The intelligent network-connected automobile plans the local path of the automobile according to the received broadcast signals. And determining a reference track or path according to the result of the global path planning or the current target. And setting reasonable maximum acceleration, maximum rotation angle and other parameters according to the dynamics constraint of the vehicle. Based on these parameters, a drivable region in the vicinity of the vehicle is generated for describing a possible range of motion of the vehicle. In this area, a local path satisfying the condition is searched based on evaluation indexes such as a distance to a target, a distance to an obstacle, and a limit of the maximum value of the speed and the acceleration of the vehicle. And selecting the optimal path as a local path planning result by comparing the evaluation index scores of different paths. And generating corresponding vehicle control instructions including steering angles, accelerations and the like according to the optimal local path planning result so as to realize motion control of the vehicle.
Finally, it is noted that the above embodiments are only for illustrating the technical solution of the present invention and not for limiting the same, and although the present invention has been described in detail with reference to the preferred embodiments, it should be understood by those skilled in the art that modifications and equivalents may be made thereto without departing from the spirit and scope of the present invention, which is intended to be covered by the claims of the present invention.

Claims (2)

1.一种联合车辆优先级和人工鱼群的多车协同决策系统,其特征在于:该系统包括车间力场分析子系统、车车协同关系分析子系统和多车协同规划决策制定子系统;1. A multi-vehicle collaborative decision-making system that combines vehicle priority and artificial fish swarms, characterized in that: the system includes a workshop force field analysis subsystem, a vehicle-vehicle collaborative relationship analysis subsystem, and a multi-vehicle collaborative planning decision-making subsystem; 其中,基于车间力场分析子系统分析车辆之间的关系,根据位置和速度变化构建车辆间虚拟作用力场;Among them, the relationship between vehicles is analyzed based on the workshop force field analysis subsystem, and a virtual force field between vehicles is constructed based on changes in position and speed; 车车协同关系分析子系统采用人工鱼群算法进行多车协同规划,在鱼群的搜索过程中通过车辆之间的势力场关系计算个体间的相互吸引力和排斥力来模拟鱼群行为;在人工鱼群算法中考虑不同车辆种类的特异性来进行迭代计算,得到最优结果;The vehicle-vehicle collaborative relationship analysis subsystem uses the artificial fish swarm algorithm for multi-vehicle collaborative planning. During the search process of the fish swarm, the mutual attraction and repulsion between individuals are calculated through the force field relationship between vehicles to simulate the behavior of the fish swarm; in The artificial fish swarm algorithm considers the specificity of different vehicle types to perform iterative calculations and obtain the optimal results; 多车协同规划决策制定子系统结合人工鱼群算法得到的结果并根据交通道路常见的情形,设计了车辆队形控制、车辆避障控制和车辆队形变换控制三种多车协同规划决策方案;The multi-vehicle collaborative planning decision-making subsystem combines the results obtained by the artificial fish swarm algorithm and designs three multi-vehicle collaborative planning decision-making schemes: vehicle formation control, vehicle obstacle avoidance control and vehicle formation change control according to common traffic situations; 所述车间力场分析子系统从RSU中获取车辆信息,包含车辆和障碍物的位置、速度和加速度信息,提取车辆信息,为车群设置虚拟势力场,根据车辆间的位置信息和速度信息进行力场建模,得到车辆之间的相对作用力关系;其中,引力场公式为:式中Ka、Kav分别为位置增益系数和速度增益系数,q、v分别为个体的当前位置和速度,qg、vg分别为目标点的位置和速度,由此计算出引力为:Fa=-grad|Ua(q)|=-Ka|q-qg|-Kav|v-vg|;The workshop force field analysis subsystem obtains vehicle information from the RSU, including the position, speed and acceleration information of the vehicle and obstacles, extracts the vehicle information, sets up a virtual force field for the vehicle group, and performs operations based on the position information and speed information between vehicles. Force field modeling is used to obtain the relative force relationship between vehicles; among them, the gravitational field formula is: In the formula, K a and K av are the position gain coefficient and velocity gain coefficient respectively, q and v are the current position and velocity of the individual respectively, q g and v g are the position and velocity of the target point respectively, from which the gravity is calculated as: F a =-grad|U a (q)|=-K a |qq g |-K av |vv g |; 斥力场为:The repulsion field is: 式中Kr、Krv分别为位置增益系数和速度增益系数,ρ(q,qg)为个体与障碍物的距离,ρ0为斥力势场的影响距离; In the formula, K r and K rv are the position gain coefficient and velocity gain coefficient respectively, ρ (q, q g ) is the distance between the individual and the obstacle, and ρ 0 is the influence distance of the repulsive potential field; 计算出斥力为:The repulsive force is calculated as: 在人工鱼群的搜索过程中使用所述车间力场分析子系统得到的公式计算个体间的相互吸引力和排斥力来模拟鱼群行为,同时在计算每条鱼的适应度评估时,根据不同车辆的种类对鱼群做特异化处理,具体为:在计算每条鱼的适应度评估时,将不同车辆种类的体积参数纳入计算;同时为提高算法对紧急车辆的响应速度,引入优先级机制,对不同车辆种类的车辆设置高中低三种优先级;车辆体积的引力公式和斥力公式分别为:和/>其中V表示本车的体积,Vg表示另一辆车的体积;如果本车体超过一定体积时,两车之间的引力作用变小,同时斥力作用变大;根据车辆对交通拥堵的影响程度和车辆的通行优先级来综合设置优先级,将急救车或警车的紧急车辆设置为高优先级,将公交车辆或学校巴士设置为中优先级,将中型车或卡车危险车辆设置为次中优先级,将普通轿车设置为低优先级来进行处理;最后人工鱼群算法进行多次迭代,得到计算后的最优结果;During the search process of the artificial fish swarm, the formula obtained by the workshop force field analysis subsystem is used to calculate the mutual attraction and repulsion between individuals to simulate the behavior of the fish swarm. At the same time, when calculating the fitness evaluation of each fish, according to different The type of vehicle specializes in fish schools, specifically: when calculating the fitness evaluation of each fish, the volume parameters of different vehicle types are included in the calculation; at the same time, in order to improve the response speed of the algorithm to emergency vehicles, a priority mechanism is introduced , three priorities are set for vehicles of different types: high, medium and low; the gravity formula and repulsion formula of the vehicle volume are respectively: and/> Where V represents the volume of the vehicle, and V g represents the volume of another vehicle; if the vehicle body exceeds a certain volume, the gravitational force between the two vehicles becomes smaller and the repulsive force becomes larger; according to the impact of the vehicle on traffic congestion The priority is set comprehensively according to the degree and traffic priority of the vehicle. Emergency vehicles such as ambulances or police cars are set as high priority, public transportation vehicles or school buses are set as medium priority, and medium-sized cars or dangerous trucks are set as secondary priority. Priority, ordinary cars are set to low priority for processing; finally, the artificial fish swarm algorithm performs multiple iterations to obtain the optimal result after calculation; 所述车辆队形控制中,提出车辆保持控制方案;车辆队形控制先根据引力计算公式和斥力计算公式分别计算两种力的大小,车辆Fa=Fr受力平衡时计算车辆之间的最佳保持距离,然后根据车头间距公式S=Th*v来计算车辆的最佳保持速度;式中S为两车头部纵向的距离,v为车辆实时速度,Th为车头时距,是指在同一车道上行驶的车辆队列中,两连续车辆车头端部通过某一断面时间间隔;当车队不受外力作用仅在内部作用力的情况下实现车辆队形保持;In the vehicle formation control, a vehicle maintenance control scheme is proposed; the vehicle formation control first calculates the magnitude of the two forces according to the gravity calculation formula and the repulsion calculation formula. When the vehicle F a = F r is balanced, the force between the vehicles is calculated. The optimal maintaining distance is then calculated according to the head distance formula S = T h *v; where S is the longitudinal distance between the heads of the two vehicles, v is the real-time speed of the vehicle, and T h is the headway. It refers to the time interval between the front ends of two consecutive vehicles passing through a certain cross-section in a queue of vehicles traveling on the same lane; when the fleet is not affected by external forces, the vehicle formation is maintained only under the condition of internal forces; 所述车辆避障控制中,为保证车队内的受力平衡,要求保持车辆与附近车辆的车群基于距离和速度的合力抵消为零,同时将障碍物视为斥力场,根据车辆与障碍物之间的距离来计算斥力及车辆的避障转动角度;本车为避障就会向内侧车道移动,从而使得车辆之间的距离变小,根据合力公式改变车辆的速度来保证受力平衡;在车辆和障碍物之间,根据车辆和障碍物的GPS定位信息来计算车辆与障碍物之间斥力的X和Y轴相对分量:(Fr.x,Fr.y)=(x_car-x_obstacle,y_car-y_obstacle),车辆的避障转动角度通过以下公式来得到:θ=atan2(Fr.y,Fr.x);最后,车辆根据计算得到的角度θ进行转动,以实现避障效果;In the vehicle obstacle avoidance control, in order to ensure the balance of forces in the fleet, it is required to keep the total force offset between the vehicle and nearby vehicles based on distance and speed to zero. At the same time, obstacles are regarded as repulsive fields. According to the distance between the vehicle and the obstacle, The distance between them is used to calculate the repulsive force and the vehicle's obstacle avoidance rotation angle; in order to avoid obstacles, the vehicle will move to the inside lane, thus making the distance between vehicles smaller, and changing the vehicle's speed according to the resultant force formula to ensure force balance; Between the vehicle and the obstacle, the relative components of the X and Y axes of the repulsion between the vehicle and the obstacle are calculated based on the GPS positioning information of the vehicle and the obstacle: (F r .x, F r .y) = (x_car-x_obstacle , y_car-y_obstacle), the vehicle's obstacle avoidance rotation angle is obtained by the following formula: θ = atan2 (F r .y, F r .x); finally, the vehicle rotates according to the calculated angle θ to achieve the obstacle avoidance effect ; 所述车辆队形变换控制中,设在时间t1时刻邻居车辆的实时速度为v0,在斥力的计算中额外引入一个项来表征邻居车道的车速对斥力的影响:Frnew=Fr*(1/distance)*(1+v0),其中distance表示车辆与邻车后方车辆之间的距离,然后更新车辆向邻居车道的转动角度公式为:θavoid=atan2(Frnew.y,Frnew.x);车辆根据该转动角度向邻居车道换道,最终实现车辆队形变换。In the vehicle formation change control, the real-time speed of the neighbor vehicle at time t 1 is v 0 , and an additional term is introduced in the calculation of the repulsion force to represent the impact of the speed of the neighbor lane on the repulsion force: Frnew = Fr * (1/distance)*(1+v 0 ), where distance represents the distance between the vehicle and the vehicle behind the adjacent vehicle, and then the formula for updating the vehicle's rotation angle to the adjacent lane is: θ avoid =atan2(F rnew .y, F rnew .x); the vehicle changes lanes to the neighbor lane according to this rotation angle, and finally realizes the vehicle formation change. 2.根据权利要求1所述的一种联合车辆优先级和人工鱼群的多车协同决策系统,其特征在于:所述车辆队形变换控制通过进行协同换道实现将三角形车队队形变换为直线队形来保证车群之间的安全;行驶中,车群均匀分布在多个车道上,表现为三角形队形;当遇到障碍物或者为高优先级车辆避让车道时,通过协同换道来变换车队为直线队形。2. A multi-vehicle collaborative decision-making system that combines vehicle priority and artificial fish swarms according to claim 1, characterized in that: the vehicle formation transformation control realizes transformation of the triangular fleet formation into a collaborative lane change. Linear formation to ensure safety between vehicle groups; during driving, the vehicle group is evenly distributed on multiple lanes, showing a triangular formation; when encountering obstacles or avoiding lanes for high-priority vehicles, collaborative lane changes are performed to transform the convoy into a straight line formation.
CN202310998816.7A 2023-08-09 2023-08-09 A multi-vehicle collaborative decision-making system that combines vehicle priority and artificial fish schools Active CN116798232B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202310998816.7A CN116798232B (en) 2023-08-09 2023-08-09 A multi-vehicle collaborative decision-making system that combines vehicle priority and artificial fish schools

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202310998816.7A CN116798232B (en) 2023-08-09 2023-08-09 A multi-vehicle collaborative decision-making system that combines vehicle priority and artificial fish schools

Publications (2)

Publication Number Publication Date
CN116798232A CN116798232A (en) 2023-09-22
CN116798232B true CN116798232B (en) 2024-03-26

Family

ID=88038641

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202310998816.7A Active CN116798232B (en) 2023-08-09 2023-08-09 A multi-vehicle collaborative decision-making system that combines vehicle priority and artificial fish schools

Country Status (1)

Country Link
CN (1) CN116798232B (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN118736881B (en) * 2024-08-30 2024-11-29 大连理工大学 Dynamic cooperative control method of connected vehicles based on A-star algorithm and gravitational field model

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108216236A (en) * 2017-12-25 2018-06-29 东软集团股份有限公司 Control method for vehicle, device, vehicle and storage medium
CN109903551A (en) * 2019-04-12 2019-06-18 北京航空航天大学 A method, storage medium and device for driving and formation control of unmanned vehicles on expressway ramps based on artificial fish school
CN112026786A (en) * 2020-09-09 2020-12-04 深圳技术大学 Cooperative driving control system of intelligent car and multi-vehicle cooperative driving control system

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106114507B (en) * 2016-06-21 2018-04-03 百度在线网络技术(北京)有限公司 Local path planning method and device for intelligent vehicle
CN111735466B (en) * 2020-01-02 2021-11-12 北京京东乾石科技有限公司 A multi-vehicle cooperative trajectory planning method, device, equipment and storage medium

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108216236A (en) * 2017-12-25 2018-06-29 东软集团股份有限公司 Control method for vehicle, device, vehicle and storage medium
CN109903551A (en) * 2019-04-12 2019-06-18 北京航空航天大学 A method, storage medium and device for driving and formation control of unmanned vehicles on expressway ramps based on artificial fish school
CN112026786A (en) * 2020-09-09 2020-12-04 深圳技术大学 Cooperative driving control system of intelligent car and multi-vehicle cooperative driving control system

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
基于鱼群效应的多车协同行驶控制方法;来磊 等;《西北工业大学学报》;20120630;第30卷(第3期);第373-377页 *

Also Published As

Publication number Publication date
CN116798232A (en) 2023-09-22

Similar Documents

Publication Publication Date Title
US11651240B2 (en) Object association for autonomous vehicles
CN112789481B (en) Trajectory prediction for top-down scenarios
CN112242069B (en) A method and device for determining vehicle speed
US20210094539A1 (en) Blocking object avoidance
JP2022163098A (en) Operation management of autonomous traveling vehicle
US12296849B2 (en) Method and system for feasibility-based operation of an autonomous agent
EP3814867A1 (en) Orientation-adjust actions for autonomous vehicle operational management
US11801864B1 (en) Cost-based action determination
CN109727490B (en) Peripheral vehicle behavior self-adaptive correction prediction method based on driving prediction field
CN112577506B (en) Automatic driving local path planning method and system
CN110288835A (en) A Real-time Recognition Method of Surrounding Vehicle Behavior Based on Kinematics Prediction and Compensation Mechanism
CN104732066B (en) The modeling method of vehicle behavior temporal-spatial evolution and its application under path constraints
CN116798232B (en) A multi-vehicle collaborative decision-making system that combines vehicle priority and artificial fish schools
CN114043984A (en) Intelligent automobile lane change control system and method based on Internet of vehicles environment
Ren et al. Self-learned intelligence for integrated decision and control of automated vehicles at signalized intersections
WO2024006115A1 (en) Determining right of way
Guo et al. Self-defensive coordinated maneuvering of an intelligent vehicle platoon in mixed traffic
CN118212808A (en) Method, system and equipment for planning traffic decision of signalless intersection
US20240067195A1 (en) Transfer Learning with Experience Filter for Vehicle Operation
Delp et al. Classifying and passing 3d obstacles for autonomous driving
Tsu-Tian Research on intelligent transportation systems in Taiwan
Zheng et al. Traffic-aware autonomous driving with differentiable traffic simulation
Yoneda et al. Supervised vehicle trajectory prediction using orthogonal image map for urban automated driving
Santana et al. Platoon driving intelligence. A survey
Wei et al. A lane changing model based on imitation learning and Gaussian velocity Fields

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