CN118243132A - Dynamic path planning method based on Astar algorithm and non-zero and game - Google Patents
Dynamic path planning method based on Astar algorithm and non-zero and game Download PDFInfo
- Publication number
- CN118243132A CN118243132A CN202410666244.7A CN202410666244A CN118243132A CN 118243132 A CN118243132 A CN 118243132A CN 202410666244 A CN202410666244 A CN 202410666244A CN 118243132 A CN118243132 A CN 118243132A
- Authority
- CN
- China
- Prior art keywords
- road
- construction
- vehicle
- vehicles
- accident
- 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.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/3407—Route searching; Route guidance specially adapted for specific applications
- G01C21/3415—Dynamic re-routing, e.g. recalculating the route when the user deviates from calculated route or after detecting real-time traffic data or accidents
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/3446—Details of route searching algorithms, e.g. Dijkstra, A*, arc-flags or using precalculated routes
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/3453—Special cost functions, i.e. other than distance or default speed limit of road segments
- G01C21/3492—Special cost functions, i.e. other than distance or default speed limit of road segments employing speed data or traffic data, e.g. real-time or historical
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Traffic Control Systems (AREA)
Abstract
Description
技术领域Technical Field
本发明属于路径规划技术领域,具体涉及基于Astar算法与非零和博弈的动态路径规划方法。The invention belongs to the technical field of path planning, and in particular relates to a dynamic path planning method based on an Astar algorithm and a non-zero-sum game.
背景技术Background technique
近年来,随着道路车辆的持续增多,交通拥堵时常发生,为应对加剧的交通拥堵情况,许多研究人员开始研究解决方法。现阶段部分道路规划算法已十分出色,能够表现出较好的性能,例如通过联网获取红绿灯的剩余时长、同步道路拥堵情况等方法,规划出较为合理的行车路径并估算出行时间,但对于道路突发情况的感知和躲避依旧有所欠缺。In recent years, with the continuous increase in the number of vehicles on the road, traffic congestion often occurs. In order to cope with the worsening traffic congestion, many researchers have begun to study solutions. At present, some road planning algorithms are very good and can show good performance. For example, by obtaining the remaining time of traffic lights through networking and synchronizing road congestion conditions, a more reasonable driving route can be planned and the travel time can be estimated. However, the perception and avoidance of sudden road situations are still lacking.
路径规划算法是用于寻找从起点到终点的最佳路径的算法,被广泛应用于各种领域,如交通运输、物流、机器人导航等。通过考虑不同路径的成本或权重来确定最优路径,以便在特定条件下最大化效率或最小化成本。Path planning algorithms are algorithms used to find the best path from a starting point to a destination, and are widely used in various fields such as transportation, logistics, robot navigation, etc. The optimal path is determined by considering the cost or weight of different paths in order to maximize efficiency or minimize cost under certain conditions.
在路径规划的应用过程中,智能路侧终端RSU(Road Side Unit)是部署在道路边缘或交通设施上的设备,可以收集和处理交通数据,包括道路流量、拥堵情况、交通事故、车辆速度等信息,并进行实时分析和处理,以生成交通报告、统计分析结果,为交通管理和规划提供决策支持。在交通事故或紧急情况下,RSU可以向车辆发送紧急服务信息。无人机UAV(Unmanned Aerial Vehicle)功能多种多样、可创造性强,能够在没有人操控的情况下进行飞行任务,通过预先设定的航线、遥控器或者自主飞行来完成各种任务,如监视、勘察、货物运输等。现阶段也被用于道路安全、交通监控和公路基础设施管理等方面。In the application process of path planning, the intelligent roadside terminal RSU (Road Side Unit) is a device deployed on the edge of the road or on traffic facilities. It can collect and process traffic data, including road flow, congestion, traffic accidents, vehicle speed and other information, and conduct real-time analysis and processing to generate traffic reports and statistical analysis results to provide decision support for traffic management and planning. In the event of a traffic accident or emergency, the RSU can send emergency service information to the vehicle. UAV (Unmanned Aerial Vehicle) has a variety of functions and strong creativity. It can perform flight missions without human control and complete various tasks such as monitoring, surveying, and cargo transportation through pre-set routes, remote controls or autonomous flights. At this stage, it is also used in road safety, traffic monitoring, and highway infrastructure management.
现有路径规划算法的缺陷与不足主要有:现阶段路径规划算法多为静态,即通过指定最短时间或最短路径只返回一次最优行驶路径;道路规划算法基于最短时间或最短路径,可能导致车辆集中驶向最优路段,致使最优路段道路拥堵;行驶中车辆信息传输存在延迟,存在安全隐患;面对车流、人流呈几何倍增长的闹市区,如果突发交通事故,路径规划系统不能实时同步信息,这种信息时延将导致车辆按原规划驶向事故路段,造成事故路段及附近路段的拥堵。The defects and shortcomings of existing path planning algorithms are mainly as follows: at present, path planning algorithms are mostly static, that is, the optimal driving path is only returned once by specifying the shortest time or shortest path; the road planning algorithm is based on the shortest time or shortest path, which may cause vehicles to concentrate on the optimal section, causing traffic congestion on the optimal section; there is a delay in the transmission of vehicle information during driving, which poses a safety hazard; in the face of downtown areas where the flow of vehicles and people is growing exponentially, if a traffic accident occurs, the path planning system cannot synchronize information in real time. This information delay will cause vehicles to drive to the accident section as originally planned, causing congestion on the accident section and nearby sections.
发明内容Summary of the invention
根据以上现有技术中的不足,本发明的目的在于,提供基于Astar算法与非零和博弈的动态路径规划方法,能够实现对事故路段的合理利用,实现车辆分流,最大化车辆群体效益,使得车辆合理行驶,保证行车安全,减少出行车辆的拥堵。In view of the above deficiencies in the prior art, the purpose of the present invention is to provide a dynamic path planning method based on the Astar algorithm and non-zero-sum game, which can achieve rational utilization of accident sections, realize vehicle diversion, maximize the benefits of vehicle groups, enable vehicles to travel reasonably, ensure driving safety, and reduce congestion of traveling vehicles.
为达到以上目的,本发明提供了基于Astar算法与非零和博弈的动态路径规划方法,包括以下步骤:To achieve the above objectives, the present invention provides a dynamic path planning method based on the Astar algorithm and non-zero-sum game, comprising the following steps:
S1、组建包含无人机、车辆、智能路侧终端RSU和核心控制器(采用公知的核心控制器即可)的路径规划框架,其中:S1. Build a path planning framework including drones, vehicles, intelligent roadside terminals RSU and core controllers (a well-known core controller can be used), where:
无人机用于监管道路情况,当利用无人机观测到出现道路状况时,无人机立即向核心控制器返回道路信息;Drones are used to monitor road conditions. When a road condition is observed by a drone, the drone immediately returns the road information to the core controller.
车辆在行驶过程中,当自身所在道路发生改变时,向核心控制器返回自身信息;When the vehicle is driving and the road it is on changes, it returns its information to the core controller;
RSU部署在每条道路上,用于计算所在道路的规划因子;RSU is deployed on each road to calculate the planning factors of the road;
核心控制器将接收到的各个信息所对应的位置信息划分到各条道路,计算汇总每条道路的事故规模、施工规模和车辆面积,下发给对应道路的RSU,由RSU对每条道路的规划因子进行计算;The core controller divides the location information corresponding to each piece of information received into each road, calculates and summarizes the accident scale, construction scale and vehicle area of each road, and sends it to the RSU of the corresponding road, which calculates the planning factor of each road;
对全部道路所在的区域建立笛卡尔坐标系,i代表横轴,j代表纵轴;A Cartesian coordinate system is established for the area where all roads are located, i represents the horizontal axis and j represents the vertical axis;
S2、核心控制器接收来自车辆的路径规划请求,该请求包括起始位置、终点位置;S2. The core controller receives a path planning request from the vehicle, which includes a starting position and an end position;
S3、使用Astar算法,基于规划因子利用Astar算法进行路径规划,向车辆返回推荐行驶路径;此处,采用公知的Astar算法(一种常用的路径查找和图形遍历算法)进行路径规划即可;S3. Use the Astar algorithm to perform path planning based on the planning factors and return a recommended driving path to the vehicle. Here, the well-known Astar algorithm (a commonly used path finding and graph traversal algorithm) can be used for path planning.
S4、核心控制器实时接收来自无人机的道路状况,将出现状况的道路下发至全体车辆,车辆收到信息后,检测自身行驶路径,如包含出现状况的道路,则向核心控制器返回重新路径规划请求,包括当前位置与终点位置;否则忽略按原推荐行驶路径继续行驶;S4. The core controller receives the road conditions from the drone in real time and sends the road conditions to all vehicles. After receiving the information, the vehicle detects its own driving path. If it includes the road conditions, it returns a request for re-route planning to the core controller, including the current position and the end position; otherwise, it ignores it and continues to drive along the original recommended driving path;
S5、等待一个单位时间后,将所有返回重新路径规划请求的车辆组成博弈模型,博弈模型中,博弈参与者为请求重新路径规划的n个车辆,策略集合为核心控制器返回给每个参与者的推荐行驶路径的集合,依据非零和博弈,向车辆返回新的推荐行驶路径;S5. After waiting for a unit time, all vehicles that return re-route planning requests are combined into a game model. In the game model, the game participants are n vehicles that request re-route planning, and the strategy set is the set of recommended driving routes returned by the core controller to each participant. Based on the non-zero-sum game, a new recommended driving route is returned to the vehicle.
S6、车辆到达终点位置,结束路径规划。S6: The vehicle arrives at the destination, and the path planning ends.
所述的S1中,道路状况包括发生事故和修路情况,其中:In S1, the road conditions include accidents and road repairs, where:
无人机发现事故时,向核心控制器返回事故位置和与事故相关的车辆数量/>,随后关注事故发生的位置点,事故处理完成后向核心控制器返回信息,由核心控制器将事故信息删除;When the drone finds an accident, it returns the accident location to the core controller and the number of vehicles involved in the accident/> , and then pay attention to the location where the accident occurred. After the accident is handled, the information is returned to the core controller, and the core controller deletes the accident information;
无人机发现修路情况时,通过观察施工围栏,返回给核心控制器施工信号,并返回施工起点、施工终点/>及施工所占道路宽度/>,核心控制器接收到施工信息后,对施工影响进行判断。When the drone finds road construction, it observes the construction fence, sends a construction signal to the core controller, and returns to the construction starting point. , Construction end/> And the width of the road occupied by the construction/> ,After receiving the construction information, the core controller makes a judgment on the ,impact of the construction.
无人机发现事故时,还向核心控制器返回事故规模,其定义为:When the drone detects an accident, it also reports the accident scale to the core controller. , which is defined as:
(1); (1);
式中,S为事故车辆投影面积;Where S is the projection area of the accident vehicle;
无人机发现修路情况时,对施工影响进行判断的方式为:When the drone discovers road construction, it determines the impact of the construction in the following ways:
设定为施工所在道路宽度、/>为小型车辆宽度、/>为中型车辆宽度、/>为大型车辆宽度,若/>,则将该条道路标记为全型号车辆不可走;若,则将该条道路标记为中、大型车辆不可走;若/>,则将该条道路标记为大型车辆不可走;若/>,则计算施工规模/>、施工起始路段施工规模/>和施工结束路段施工规模/>,计算公式分别为:set up is the width of the road where the construction is taking place,/> For small vehicle width, /> For medium-sized vehicle width, /> is the width of a large vehicle, if/> , then mark the road as inaccessible to all types of vehicles; if , then mark the road as not passable for medium and large vehicles; if/> , then mark the road as not passable by large vehicles; if/> , then calculate the construction scale/> , Construction scale of the starting section of construction/> and the construction scale of the section where construction is completed/> , the calculation formulas are:
(2); (2);
(3); (3);
(4); (4);
式中,k是施工范围内拐点个数,为施工范围内从施工起点起第1个拐点坐标,/>为施工范围内从施工起点起最后一个拐点坐标,/>为施工范围内从施工起点起第u个拐点坐标,/>为施工范围内从施工起点起第u+1个拐点坐标。Where k is the number of inflection points within the construction range, is the coordinate of the first turning point within the construction range from the construction starting point,/> is the coordinate of the last turning point within the construction range from the construction starting point,/> is the coordinate of the uth turning point within the construction range from the construction starting point,/> It is the coordinate of the u+1th turning point within the construction range from the construction starting point.
所述的S1中,、/>、/>取值分别为1.75、1.9、2.5,其中,对于宽度大于等于1.6米且小于等于1.75米的车辆,设定其为小型车辆;对于宽度大于1.75米且小于2.5米的车辆,设定其为中型车辆;对于宽度大于等于2.5米且小于等于3米的车辆,设定其为大型车辆。本部分是基于《GB1589-2016汽车、挂车及汽车列车外廓尺寸、轴荷及质量限值》设定的宽度范围,并为了简化计算设定了/>、/>、/>的取值。In the S1, 、/> 、/> The values are 1.75, 1.9, and 2.5 respectively. For vehicles with a width greater than or equal to 1.6 meters and less than or equal to 1.75 meters, they are set as small vehicles; for vehicles with a width greater than or equal to 1.75 meters and less than 2.5 meters, they are set as medium-sized vehicles; for vehicles with a width greater than or equal to 2.5 meters and less than or equal to 3 meters, they are set as large vehicles. This section is based on the width range set in "GB1589-2016 External dimensions, axle loads and mass limits for automobiles, trailers and automobile trains", and is set to simplify the calculation./> 、/> 、/> The value of .
所述的S1中,自身信息包括车辆的自身位置及自身投影面积/>。In S1, the vehicle's own information includes the vehicle's own position and its own projection area/> .
所述的S1中,设定每条道路的事故规模为,施工规模为/>,行驶车辆投影面积为/>,表示为:In S1, the accident scale of each road is set to The construction scale is/> , the projection area of the moving vehicle is/> ,Expressed as:
(5); (5);
(6); (6);
(7); (7);
式中,为道路中心点(此处即代表某一条道路的中心点),/>为以/>为中心点的道路上的所有点的集合,/>为以/>为中心点的道路上的事故点,代表该道路上各个事故点的事故规模;/>为以/>为中心点的道路上的修路点,/>代表该道路上各个修路点的施工规模;/>为以/>为中心点的道路上的车辆位置,/>代表该道路上各个行驶车辆的投影面积;n1、n2、n3分别为以为中心点的道路上的事故点数量、修路点数量和行驶车辆数量。In the formula, is the center point of the road (here it represents the center point of a certain road), /> For/> The set of all points on the road with the center point as the center point, /> For/> The accident point on the road with the center point as the Represents the accident scale of each accident point on the road;/> For/> A road repair point on a road with a central point, /> Represents the construction scale of each road repair point on the road;/> For/> is the vehicle position on the road at the center point, /> represents the projection area of each vehicle on the road; n 1 , n 2 , n 3 are respectively The number of accidents, road repairs, and vehicles on the road with the center point as the center point.
所述的S1中,规划因子的计算方式为:In S1, the planning factor is calculated as follows:
对于发生事故的道路:For roads where accidents occurred:
(8); (8);
对于正在施工的道路:For roads under construction:
(9); (9);
对于发生事故且正在施工的道路:For roads where accidents have occurred and where construction is ongoing:
(10); (10);
式中,为以/>为中心点的道路的规划因子,/>为以/>为中心点的道路的总面积,/>为系数且加和为1。In the formula, For/> is the planning factor of the road at the center point,/> For/> is the total area of the road at the center point,/> are coefficients and sum to 1.
所述的S1中,对于整体施工路段,也会涉及到事故点和行驶车辆(主要针对施工车辆等),其规划因子表示为:In S1, for the entire construction section, there will also be accident points and moving vehicles (mainly construction vehicles, etc.), and the planning factors are expressed as:
(11); (11);
其中:in:
(12); (12);
(13); (13);
(14); (14);
式中,为以/>为中心点的道路的规划因子,/>为该施工路段的总面积;/>为施工路段中心点,/>为以/>为中心点的道路上的所有点的集合;为以/>为中心点的施工路段上的事故点,/>代表该道路上各个事故点的事故规模;/>为以/>为中心点的施工路段上的修路点,/>代表该道路上各个修路点的施工规模;/>为以/>为中心点的施工路段上的车辆位置,/>代表该道路上各个行驶车辆的投影面积;n4、n5、n6分别为以/>为中心点的道路上的事故点数量、修路点数量和行驶车辆数量。In the formula, For/> is the planning factor of the road at the center point,/> is the total area of the construction section;/> is the center point of the construction section,/> For/> The set of all points on the road with the center point as the center point; For/> The accident point on the construction section with the center point as the center point,/> Represents the accident scale of each accident point on the road;/> For/> The road repair point on the construction section with the center point as the center point,/> Represents the construction scale of each road repair point on the road;/> For/> is the vehicle position on the construction section at the center point, /> represents the projection area of each vehicle on the road; n 4 , n 5 , n 6 are respectively / > The number of accidents, road repairs, and vehicles on the road with the center point as the center point.
所述的S5中,依据非零和博弈,向车辆返回新的推荐行驶路径的过程为:In S5, the process of returning a new recommended driving route to the vehicle based on the non-zero-sum game is as follows:
S51、对于策略集合,第1辆车的策略集合表示为,第d辆车的策略集合表示为/>,总策略集合表示为;S51. For the strategy set, the strategy set of the first vehicle is expressed as , the strategy set of the d-th vehicle is expressed as/> , the total strategy set is expressed as ;
S52、博弈模型的总体收益函数表示为:S52. The overall profit function of the game model is expressed as:
(15); (15);
式中,表示每辆车的行驶时间;In the formula, represents the travel time of each vehicle;
S53、博弈模型的拥堵模型表示为:S53. The congestion model of the game model is expressed as:
(16); (16);
式中,是在时刻t的拥堵指数,/>是在时刻t的交通速度,/>是在时刻t-1的交通速度,/>是最大允许速度,/>是在时刻t的交通密度,/>是在时刻t-1的交通密度,/>是最大允许密度,/>是在时刻t的事故发生情况,/>是在时刻t的其他影响因素(例如天气情况,早晚高峰,交通管理情况等),/>为t时刻交通速度的权重系数,/>为t-1时刻交通速度的权重系数,/>为t时刻交通密度的权重系数,/>为t-1时刻交通密度的权重系数,/>为t时刻交通密度的影响函数的权重系数,/>为t-1时刻交通密度的影响函数的权重系数,/>为t时刻事故情况的权重系数,/>为t时刻其他影响因素的权重系数;In the formula, is the congestion index at time t, /> is the traffic speed at time t, /> is the traffic speed at time t-1, /> is the maximum permissible speed, /> is the traffic density at time t, /> is the traffic density at time t-1, /> is the maximum allowed density, /> is the accident situation at time t, /> Other factors affecting time t (such as weather conditions, morning and evening rush hours, traffic management conditions, etc.), /> is the weight coefficient of traffic speed at time t, /> is the weight coefficient of traffic speed at time t-1,/> is the weight coefficient of traffic density at time t,/> is the weight coefficient of traffic density at time t-1,/> is the weight coefficient of the influence function of traffic density at time t,/> is the weight coefficient of the influence function of traffic density at time t-1,/> is the weight coefficient of the accident situation at time t, /> is the weight coefficient of other influencing factors at time t;
博弈模型中,每个车辆的决策可以通过最小化自身行驶时间来表示,假设车辆y选择的行驶路径为,而其他车辆选择的行驶路径集合为/>,那么车辆y的最优决策表示为:In the game model, the decision of each vehicle can be expressed by minimizing its own driving time. Assume that the driving path selected by vehicle y is , and the set of driving paths selected by other vehicles is/> , then the optimal decision of vehicle y is expressed as:
(17); (17);
式中,表示给定其他车辆行驶路径选择/>的情况下,车辆y通过拥堵模型计算得到的行驶时间;argmin表示使得/>最小化的行驶路径选择。In the formula, Indicates the given other vehicle's driving path selection/> In the case of , the travel time of vehicle y is calculated by the congestion model; argmin represents the time that makes/> Minimize the driving route selection.
本发明涉及的算法可以通过电子设备执行,电子设备包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,通过处理器执行软件实现上述的算法。The algorithm involved in the present invention can be executed by an electronic device, which includes a memory, a processor, and a computer program stored in the memory and executable on the processor, and the algorithm is implemented by executing software through the processor.
本发明所具有的有益效果是:The beneficial effects of the present invention are:
本发明通过核心控制器进行全局规划控制,通过部署RSU传递交通事故信息,进行道路信息收集和传递,同时利用其计算能力分摊计算,进行规划因子的计算;规划因子的设计,能够使车辆分散在道路上,实现车辆合理分流,避免最优路段的集中选择。The present invention performs global planning and control through a core controller, transmits traffic accident information by deploying RSU, collects and transmits road information, and uses its computing power to share calculations and calculate planning factors. The design of planning factors can disperse vehicles on the road, realize reasonable vehicle diversion, and avoid concentrated selection of optimal road sections.
本发明选取UAV对事故信息和路况进行监控和同步,使用UAV进行道路监控,缩短同步事故信息时间,进一步缩短因事故信息延迟所造成的交通拥堵。The present invention selects UAV to monitor and synchronize accident information and road conditions, uses UAV to monitor roads, shortens the time for synchronizing accident information, and further shortens traffic congestion caused by accident information delay.
本发明在车辆群体重新规划路径时设计非零和博弈模型,使车辆选择的路径组合效益最优且相互协调稳定,确保每辆车得到合理路径,减少损耗,提高效率。通过博弈模型实现对事故路段的合理利用,并且实现车辆分流,最大化车辆群体效益;通过整体合作运行,实现车辆合理行驶,保证行车安全,减少出行车辆的拥堵。The present invention designs a non-zero-sum game model when the vehicle group replans the route, so that the route combination selected by the vehicle is optimal and coordinated and stable, ensuring that each vehicle gets a reasonable route, reducing losses and improving efficiency. The game model is used to achieve reasonable utilization of the accident section, and vehicle diversion is achieved to maximize the benefits of the vehicle group; through overall cooperative operation, vehicles are driven reasonably, driving safety is guaranteed, and congestion of traveling vehicles is reduced.
附图说明BRIEF DESCRIPTION OF THE DRAWINGS
图1是本发明的流程原理图;Fig. 1 is a schematic diagram of a process of the present invention;
图2为本发明实施例中路径规划框架的示意图。FIG. 2 is a schematic diagram of a path planning framework in an embodiment of the present invention.
具体实施方式Detailed ways
下面结合附图对本发明的实施例做进一步描述:The embodiments of the present invention are further described below in conjunction with the accompanying drawings:
如图1所示,基于Astar算法与非零和博弈的动态路径规划方法,包括以下步骤:As shown in FIG1 , the dynamic path planning method based on the Astar algorithm and non-zero-sum game includes the following steps:
S1、组建包含无人机、车辆、智能路侧终端RSU和核心控制器的路径规划框架,其中:S1. Build a path planning framework including drones, vehicles, intelligent roadside terminals RSU and core controllers, where:
无人机用于监管道路情况,当利用无人机观测到出现道路状况时,无人机立即向核心控制器返回道路信息;Drones are used to monitor road conditions. When a road condition is observed by a drone, the drone immediately returns the road information to the core controller.
车辆在行驶过程中,当自身所在道路发生改变时,向核心控制器返回自身信息;When the vehicle is driving and the road it is on changes, it returns its information to the core controller;
RSU部署在每条道路上,用于计算所在道路的规划因子;RSU is deployed on each road to calculate the planning factors of the road;
核心控制器将接收到的各个信息所对应的位置信息划分到各条道路,计算汇总每条道路的事故规模、施工规模和车辆面积,下发给对应道路的RSU,由RSU对每条道路的规划因子进行计算;The core controller divides the location information corresponding to each piece of information received into each road, calculates and summarizes the accident scale, construction scale and vehicle area of each road, and sends it to the RSU of the corresponding road, which calculates the planning factor of each road;
对全部道路所在的区域建立笛卡尔坐标系,i代表横轴,j代表纵轴;A Cartesian coordinate system is established for the area where all roads are located, i represents the horizontal axis and j represents the vertical axis;
S2、核心控制器接收来自车辆的路径规划请求,该请求包括起始位置、终点位置;S2. The core controller receives a path planning request from the vehicle, which includes a starting position and an end position;
S3、使用Astar算法,基于规划因子利用Astar算法进行路径规划,向车辆返回推荐行驶路径;S3, using the Astar algorithm to perform path planning based on the planning factors, and returning a recommended driving path to the vehicle;
S4、核心控制器实时接收来自无人机的道路状况,将出现状况的道路下发至全体车辆,车辆收到信息后,检测自身行驶路径,如包含出现状况的道路,则向核心控制器返回重新路径规划请求,包括当前位置与终点位置;否则忽略按原推荐行驶路径继续行驶;S4. The core controller receives the road conditions from the drone in real time and sends the road conditions to all vehicles. After receiving the information, the vehicle detects its own driving path. If it includes the road conditions, it returns a request for re-route planning to the core controller, including the current position and the end position; otherwise, it ignores it and continues to drive along the original recommended driving path;
S5、等待一个单位时间后,将所有返回重新路径规划请求的车辆组成博弈模型,博弈模型中,博弈参与者为请求重新路径规划的n个车辆,策略集合为核心控制器返回给每个参与者的推荐行驶路径的集合,依据非零和博弈,向车辆返回新的推荐行驶路径;S5. After waiting for a unit time, all vehicles that return re-route planning requests are combined into a game model. In the game model, the game participants are n vehicles that request re-route planning, and the strategy set is the set of recommended driving routes returned by the core controller to each participant. Based on the non-zero-sum game, a new recommended driving route is returned to the vehicle.
S6、车辆到达终点位置,结束路径规划。S6: The vehicle arrives at the destination, and the path planning ends.
本实施例中,将核心控制器作为整个路径规划框架的处理中心,对整个场景进行宏观调控,保证车辆正常行驶,确保出行安全。In this embodiment, the core controller is used as the processing center of the entire path planning framework to perform macro-control of the entire scene to ensure the normal driving of the vehicle and ensure travel safety.
其中,路径规划框架内的信息传递方式分为:Among them, the information transmission methods within the path planning framework are divided into:
Ⅰ类:RSU与核心控制器间的信息传递;Category I: Information transmission between RSU and core controller;
Ⅱ类:UAV(无人机)与RSU间的信息传递;Category II: Information transmission between UAV (unmanned aerial vehicle) and RSU;
Ⅲ类:RSU与车辆间的信息传递;Category III: Information transmission between RSU and vehicles;
Ⅳ类:UAV与车辆间的信息传递;Category IV: Information transmission between UAV and vehicle;
Ⅴ类:车辆与车辆间的信息传递。Category V: Information transmission between vehicles.
来自UAV的信息通过RSU传递给核心控制器。车辆自身产生的信息,优先选择RSU进行信息传递;当其与RSU距离较远不满足传递条件时,则先将信息传递给UAV,由其传递给RSU进而传递给核心控制器;当其与RSU和UAV距离均较远时,其信息可以在车辆群体间进行传递,直至中间传递车辆满足上述两种传递方式时,将信息传递给核心控制器。The information from the UAV is transmitted to the core controller through the RSU. The information generated by the vehicle itself is preferentially transmitted to the RSU; when the distance between the vehicle and the RSU is too far and the transmission conditions are not met, the information is first transmitted to the UAV, which then transmits it to the RSU and then to the core controller; when the distance between the vehicle and both the RSU and the UAV is far, the information can be transmitted between the vehicle groups until the intermediate transmission vehicle meets the above two transmission methods, and then the information is transmitted to the core controller.
核心控制器功能包括:负责维护道路拓扑信息,包括RSU、UAV和车辆的位置以及它们之间的传递关系;接收来自RSU、UAV和车辆的各类信息,对事故信息进行处理;对路径规划请求进行响应及处理,包括初次的路径规划以及再次路径规划时博弈模型的建立。The core controller functions include: responsible for maintaining road topology information, including the locations of RSU, UAV and vehicles and the transmission relationship between them; receiving various types of information from RSU, UAV and vehicles, and processing accident information; responding to and processing path planning requests, including the initial path planning and the establishment of a game model during secondary path planning.
图2给出了一个简化的路径规划框架,用不同的线型表明了信息传递方式,并且给出了简化的道路模型,其中包含了一个UAV和一个RSU,核心控制器除了主要的路径规划功能外,还能实现维护道路拓扑信息功能和确保道路安全功能。Figure 2 shows a simplified path planning framework, using different line types to indicate the information transmission method, and gives a simplified road model, which includes a UAV and an RSU. In addition to the main path planning function, the core controller can also maintain road topology information and ensure road safety.
S1中,道路状况包括发生事故和修路情况,其中:In S1, road conditions include accidents and road repairs, among which:
无人机发现事故时,向核心控制器返回事故位置和与事故相关的车辆数量/>,随后关注事故发生的位置点,事故处理完成后向核心控制器返回信息,由核心控制器将事故信息删除;When the drone finds an accident, it returns the accident location to the core controller and the number of vehicles involved in the accident/> , and then pay attention to the location where the accident occurred. After the accident is handled, the information is returned to the core controller, and the core controller deletes the accident information;
无人机发现修路情况时,通过观察施工围栏,返回给核心控制器施工信号,并返回施工起点、施工终点/>及施工所占道路宽度/>,核心控制器接收到施工信息后,对施工影响进行判断。When the drone finds road construction, it observes the construction fence, sends a construction signal to the core controller, and returns to the construction starting point. , Construction end/> And the width of the road occupied by the construction/> ,After receiving the construction information, the core controller makes a judgment on the ,impact of the construction.
无人机发现事故时,还向核心控制器返回事故规模,其定义为:When the drone detects an accident, it also reports the accident scale to the core controller. , which is defined as:
(1); (1);
式中,S为事故车辆投影面积;Where S is the projected area of the accident vehicle;
无人机发现修路情况时,对施工影响进行判断的方式为:When the drone discovers road construction, it determines the impact of the construction in the following ways:
设定为施工所在道路宽度、/>为小型车辆宽度、/>为中型车辆宽度、/>为大型车辆宽度,若/>,则将该条道路标记为全型号车辆不可走;若,则将该条道路标记为中、大型车辆不可走;若/>,则将该条道路标记为大型车辆不可走;若/>,则计算施工规模/>、施工起始路段施工规模/>和施工结束路段施工规模/>,计算公式分别为:set up is the width of the road where the construction is taking place,/> For small vehicle width, /> For medium-sized vehicle width, /> is the width of a large vehicle, if/> , then mark the road as inaccessible to all types of vehicles; if , then mark the road as not passable for medium and large vehicles; if/> , then mark the road as not passable by large vehicles; if/> , then calculate the construction scale/> , Construction scale of the starting section of construction/> and the construction scale of the section where construction is completed/> , the calculation formulas are:
(2); (2);
(3); (3);
(4); (4);
式中,k是施工范围内拐点个数,为施工范围内从施工起点起第1个拐点坐标,/>为施工范围内从施工起点起最后一个拐点坐标,/>为施工范围内从施工起点起第u个拐点坐标,/>为施工范围内从施工起点起第u+1个拐点坐标。Where k is the number of inflection points within the construction range, is the coordinate of the first turning point within the construction range from the construction starting point,/> is the coordinate of the last turning point within the construction range from the construction starting point,/> is the coordinate of the uth turning point within the construction range from the construction starting point,/> It is the coordinate of the u+1th turning point within the construction range from the construction starting point.
S1中,、/>、/>取值分别为1.75、1.9、2.5,其中,对于宽度大于等于1.6米且小于等于1.75米的车辆,设定其为小型车辆;对于宽度大于1.75米且小于2.5米的车辆,设定其为中型车辆;对于宽度大于等于2.5米且小于等于3米的车辆,设定其为大型车辆。In S1, 、/> 、/> The values are 1.75, 1.9, and 2.5, respectively. For vehicles with a width greater than or equal to 1.6 meters and less than or equal to 1.75 meters, they are set as small vehicles; for vehicles with a width greater than or equal to 1.75 meters and less than or equal to 2.5 meters, they are set as medium-sized vehicles; for vehicles with a width greater than or equal to 2.5 meters and less than or equal to 3 meters, they are set as large vehicles.
S1中,自身信息包括车辆的自身位置及自身投影面积/>。In S1, the vehicle’s own information includes the vehicle’s own position and its own projection area/> .
S1中,设定每条道路的事故规模为,施工规模为/>,行驶车辆投影面积为,表示为:In S1, the accident scale of each road is set to The construction scale is/> , the projection area of the moving vehicle is ,Expressed as:
(5); (5);
(6); (6);
(7); (7);
式中,为道路中心点,/>为以/>为中心点的道路上的所有点的集合,为以/>为中心点的道路上的事故点,/>代表该道路上各个事故点的事故规模;/>为以/>为中心点的道路上的修路点,/>代表该道路上各个修路点的施工规模;/>为以/>为中心点的道路上的车辆位置,/>代表该道路上各个行驶车辆的投影面积;n1、n2、n3分别为以/>为中心点的道路上的事故点数量、修路点数量和行驶车辆数量。In the formula, is the center point of the road, /> For/> The set of all points on the road with the center point as the For/> The accident point on the road with the center point as the center point, /> Represents the accident scale of each accident point on the road;/> For/> A road repair point on a road with a central point, /> Represents the construction scale of each road repair point on the road;/> For/> is the vehicle position on the road at the center point, /> represents the projection area of each vehicle on the road; n 1 , n 2 , n 3 are respectively / > The number of accidents, road repairs, and vehicles on the road with the center point as the center point.
S1中,规划因子的计算方式为:In S1, the planning factor is calculated as:
对于发生事故的道路:For roads where accidents occurred:
(8); (8);
对于正在施工的道路:For roads under construction:
(9); (9);
对于发生事故且正在施工的道路:For roads where accidents have occurred and where construction is ongoing:
(10); (10);
式中,为以/>为中心点的道路的规划因子,/>为以/>为中心点的道路的总面积,/>为系数且加和为1。In the formula, For/> is the planning factor of the road at the center point,/> For/> is the total area of the road at the center point,/> are coefficients and sum to 1.
S1中,对于整体施工路段,也会涉及到事故点和行驶车辆,其规划因子表示为:In S1, for the entire construction section, there will also be accident points and moving vehicles involved, and its planning factor is expressed as:
(11); (11);
其中:in:
(12); (12);
(13); (13);
(14); (14);
式中,为以/>为中心点的道路的规划因子,/>为该施工路段的总面积;/>为施工路段中心点,/>为以/>为中心点的道路上的所有点的集合;为以/>为中心点的施工路段上的事故点,/>代表该道路上各个事故点的事故规模;/>为以/>为中心点的施工路段上的修路点,/>代表该道路上各个修路点的施工规模;/>为以/>为中心点的施工路段上的车辆位置,/>代表该道路上各个行驶车辆的投影面积;n4、n5、n6分别为以/>为中心点的道路上的事故点数量、修路点数量和行驶车辆数量。In the formula, For/> is the planning factor of the road at the center point,/> is the total area of the construction section;/> is the center point of the construction section,/> For/> The set of all points on the road with the center point as the center point; For/> The accident point on the construction section with the center point as the center point,/> Represents the accident scale of each accident point on the road;/> For/> The road repair point on the construction section with the center point as the center point,/> Represents the construction scale of each road repair point on the road;/> For/> is the vehicle position on the construction section at the center point, /> represents the projection area of each vehicle on the road; n 4 , n 5 , n 6 are respectively / > The number of accidents, road repairs, and vehicles on the road with the center point as the center point.
S5中,依据非零和博弈,向车辆返回新的推荐行驶路径的过程为:In S5, based on the non-zero-sum game, the process of returning a new recommended driving path to the vehicle is:
S51、对于策略集合,第1辆车的策略集合表示为,第d辆车的策略集合表示为/>,总策略集合表示为;S51. For the strategy set, the strategy set of the first vehicle is expressed as , the strategy set of the d-th vehicle is expressed as/> , the total strategy set is expressed as ;
S52、博弈模型的总体收益函数表示为:S52. The overall profit function of the game model is expressed as:
(15); (15);
式中,表示每辆车的行驶时间;In the formula, represents the travel time of each vehicle;
S53、博弈模型的拥堵模型表示为:S53. The congestion model of the game model is expressed as:
(16); (16);
式中,是在时刻t的拥堵指数,/>是在时刻t的交通速度,/>是在时刻t-1的交通速度,/>是最大允许速度,/>是在时刻t的交通密度,/>是在时刻t-1的交通密度,/>是最大允许密度,/>是在时刻t的事故发生情况,/>是在时刻t的其他影响因素,/>为t时刻交通速度的权重系数,/>为t-1时刻交通速度的权重系数,/>为t时刻交通密度的权重系数,/>为t-1时刻交通密度的权重系数,/>为t时刻交通密度的影响函数的权重系数,/>为t-1时刻交通密度的影响函数的权重系数,/>为t时刻事故情况的权重系数,/>为t时刻其他影响因素的权重系数;In the formula, is the congestion index at time t, /> is the traffic speed at time t, /> is the traffic speed at time t-1, /> is the maximum permissible speed, /> is the traffic density at time t, /> is the traffic density at time t-1, /> is the maximum allowed density, /> is the accident situation at time t, /> are other influencing factors at time t, /> is the weight coefficient of traffic speed at time t, /> is the weight coefficient of traffic speed at time t-1,/> is the weight coefficient of traffic density at time t,/> is the weight coefficient of traffic density at time t-1,/> is the weight coefficient of the influence function of traffic density at time t,/> is the weight coefficient of the influence function of traffic density at time t-1,/> is the weight coefficient of the accident situation at time t, /> is the weight coefficient of other influencing factors at time t;
博弈模型中,每个车辆的决策可以通过最小化自身行驶时间来表示,假设车辆y选择的行驶路径为,而其他车辆选择的行驶路径集合为/>,那么车辆y的最优决策表示为:In the game model, the decision of each vehicle can be expressed by minimizing its own driving time. Assume that the driving path selected by vehicle y is , and the set of driving paths selected by other vehicles is/> , then the optimal decision of vehicle y is expressed as:
(17); (17);
式中,表示给定其他车辆行驶路径选择/>的情况下,车辆y通过拥堵模型计算得到的行驶时间;argmin表示使得/>最小化的行驶路径选择。In the formula, Indicates the given other vehicle's driving path selection/> In the case of , the travel time of vehicle y is calculated by the congestion model; argmin represents the time that makes/> Minimize the driving route selection.
Claims (9)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202410666244.7A CN118243132B (en) | 2024-05-28 | 2024-05-28 | Dynamic path planning method based on Astar algorithm and non-zero and game |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202410666244.7A CN118243132B (en) | 2024-05-28 | 2024-05-28 | Dynamic path planning method based on Astar algorithm and non-zero and game |
Publications (2)
Publication Number | Publication Date |
---|---|
CN118243132A true CN118243132A (en) | 2024-06-25 |
CN118243132B CN118243132B (en) | 2024-07-19 |
Family
ID=91556797
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202410666244.7A Active CN118243132B (en) | 2024-05-28 | 2024-05-28 | Dynamic path planning method based on Astar algorithm and non-zero and game |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN118243132B (en) |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20060108736A1 (en) * | 2000-05-04 | 2006-05-25 | Walker Jay S | Method and apparatus for facilitating game play with a mortgaging option |
US20190377354A1 (en) * | 2017-03-01 | 2019-12-12 | Mobileye Vision Technologies Ltd. | Systems and methods for navigating with sensing uncertainty |
CN110826192A (en) * | 2019-10-15 | 2020-02-21 | 南京航空航天大学 | A Man-Vehicle Cooperative Game Control Method Based on Nash Negotiation Criterion |
CN113094857A (en) * | 2021-04-14 | 2021-07-09 | 沈阳航空航天大学 | Energy-saving controller layout method for software defined vehicle network |
CN113973362A (en) * | 2021-10-08 | 2022-01-25 | 天津大学 | Reinforcement learning non-zero and non-cooperative multi-agent secure communication power control method |
CN115285147A (en) * | 2022-08-31 | 2022-11-04 | 北京百度网讯科技有限公司 | Driving decision-making method, device and unmanned vehicle for unmanned vehicle |
CN115309047A (en) * | 2022-07-29 | 2022-11-08 | 天津大学 | An event-triggered multi-controller system stability control method |
CN115384486A (en) * | 2018-03-20 | 2022-11-25 | 御眼视觉技术有限公司 | Navigation system and method for navigating a host vehicle |
CN115668216A (en) * | 2020-06-04 | 2023-01-31 | 华为技术有限公司 | A framework for non-zero-sum game systems with tractable Nash equilibrium solutions |
CN115877871A (en) * | 2023-03-03 | 2023-03-31 | 北京航空航天大学 | Non-zero and game unmanned aerial vehicle formation control method based on reinforcement learning |
CN116736885A (en) * | 2023-06-15 | 2023-09-12 | 西北工业大学 | Spacecraft guard control method based on zero and differential countermeasures |
CN117235957A (en) * | 2023-04-28 | 2023-12-15 | 中国人民解放军军事科学院战争研究院 | Strategic game stage network diagram construction method, strategic game stage network diagram construction device and storage medium |
-
2024
- 2024-05-28 CN CN202410666244.7A patent/CN118243132B/en active Active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20060108736A1 (en) * | 2000-05-04 | 2006-05-25 | Walker Jay S | Method and apparatus for facilitating game play with a mortgaging option |
US20190377354A1 (en) * | 2017-03-01 | 2019-12-12 | Mobileye Vision Technologies Ltd. | Systems and methods for navigating with sensing uncertainty |
CN115384486A (en) * | 2018-03-20 | 2022-11-25 | 御眼视觉技术有限公司 | Navigation system and method for navigating a host vehicle |
CN110826192A (en) * | 2019-10-15 | 2020-02-21 | 南京航空航天大学 | A Man-Vehicle Cooperative Game Control Method Based on Nash Negotiation Criterion |
CN115668216A (en) * | 2020-06-04 | 2023-01-31 | 华为技术有限公司 | A framework for non-zero-sum game systems with tractable Nash equilibrium solutions |
CN113094857A (en) * | 2021-04-14 | 2021-07-09 | 沈阳航空航天大学 | Energy-saving controller layout method for software defined vehicle network |
CN113973362A (en) * | 2021-10-08 | 2022-01-25 | 天津大学 | Reinforcement learning non-zero and non-cooperative multi-agent secure communication power control method |
CN115309047A (en) * | 2022-07-29 | 2022-11-08 | 天津大学 | An event-triggered multi-controller system stability control method |
CN115285147A (en) * | 2022-08-31 | 2022-11-04 | 北京百度网讯科技有限公司 | Driving decision-making method, device and unmanned vehicle for unmanned vehicle |
CN115877871A (en) * | 2023-03-03 | 2023-03-31 | 北京航空航天大学 | Non-zero and game unmanned aerial vehicle formation control method based on reinforcement learning |
CN117235957A (en) * | 2023-04-28 | 2023-12-15 | 中国人民解放军军事科学院战争研究院 | Strategic game stage network diagram construction method, strategic game stage network diagram construction device and storage medium |
CN116736885A (en) * | 2023-06-15 | 2023-09-12 | 西北工业大学 | Spacecraft guard control method based on zero and differential countermeasures |
Non-Patent Citations (5)
Title |
---|
展邦顺: "欠驱动水下机器人路径规划和 跟踪控制研究", 中国优秀硕士学位论文全文数据库, 15 May 2024 (2024-05-15) * |
李明晨: "基于强化学习的多无人机协同控制研究", 中国优秀硕士学位论文全文数据库, 15 April 2024 (2024-04-15) * |
杨彬: "园区内无人驾驶环卫车轨迹规划及跟踪控制研究", 中国优秀博士论文全文数据库, 15 February 2023 (2023-02-15) * |
段跃飞: "无人机路径规划算法研究", 中国优秀硕士学位论文全文数据库, 30 June 2021 (2021-06-30) * |
罗晋廷: "基于多智能体的自动布线方法的研究", 中国优秀硕士学位论文全文数据库, 15 January 2023 (2023-01-15) * |
Also Published As
Publication number | Publication date |
---|---|
CN118243132B (en) | 2024-07-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112700639B (en) | Intelligent traffic path planning method based on federal learning and digital twins | |
CN107507430B (en) | Urban intersection traffic control method and system | |
CN114283607B (en) | Multi-vehicle collaborative planning method based on distributed crowd-sourcing learning | |
WO2021147748A1 (en) | Self-driving method and related device | |
CN109165902B (en) | A dynamic regional logistics delivery method and system based on intelligent unmanned vehicles | |
WO2021042827A1 (en) | Multi-agv path planning method and system | |
CN110515380B (en) | Shortest path planning method based on turning weight constraints | |
CN109191852B (en) | Vehicle-Road-Cloud Collaborative Traffic Flow Situation Prediction Method | |
CN110471418A (en) | AGV dispatching method in intelligent parking lot | |
US20240227861A9 (en) | Vehicle Control Method, Apparatus, and System | |
CN107490384A (en) | A kind of optimal static path system of selection based on city road network | |
JP2024511928A (en) | Learning in Lane Level Route Planner | |
CN112581747B (en) | Vehicle-road cooperative cargo vehicle fleet organization method, device and system | |
CN105575187A (en) | Description method and description system of air traffic network | |
CN115220461B (en) | Robot single system and multi-robot interaction cooperation method in indoor complex environment | |
CN106683394A (en) | Information processing, Internet-of-vehicles social platform and on-vehicle equipment | |
CN116013101B (en) | System and method for suggesting speed of signal-free intersection based on network environment | |
CN117711173A (en) | Vehicle path planning method and system based on reinforcement learning | |
CN115285148B (en) | Automatic driving vehicle speed planning method, device, electronic device and storage medium | |
CN108592930A (en) | New-energy automobile intelligence auxiliary driving method based on Large system optimization and car networking | |
CN105806355A (en) | Green vehicle path navigation system and method | |
CN116338729A (en) | Three-dimensional laser radar navigation method based on multilayer map | |
CN115035724A (en) | A collaborative management and control method for just-in-time transportation of logistics vehicles based on ecological formation | |
CN118243132B (en) | Dynamic path planning method based on Astar algorithm and non-zero and game | |
CN110211406A (en) | A kind of public transport pulls in speed guidance control method and system |
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 |