CN115083139A - Multi-vehicle scheduling method - Google Patents
Multi-vehicle scheduling method Download PDFInfo
- Publication number
- CN115083139A CN115083139A CN202110268430.1A CN202110268430A CN115083139A CN 115083139 A CN115083139 A CN 115083139A CN 202110268430 A CN202110268430 A CN 202110268430A CN 115083139 A CN115083139 A CN 115083139A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- node
- vehicles
- path
- child
- 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
- 238000000034 method Methods 0.000 title claims abstract description 26
- 238000010586 diagram Methods 0.000 claims abstract description 21
- 239000002131 composite material Substances 0.000 claims description 4
- 230000004888 barrier function Effects 0.000 claims description 2
- 238000004364 calculation method Methods 0.000 claims description 2
- 238000012423 maintenance Methods 0.000 claims description 2
- 230000003068 static effect Effects 0.000 claims description 2
- 230000006399 behavior Effects 0.000 description 3
- 238000002156 mixing Methods 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/20—Monitoring the location of vehicles belonging to a group, e.g. fleet of vehicles, countable or determined number of vehicles
- G08G1/202—Dispatching vehicles on the basis of a location, e.g. taxi dispatching
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06Q—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES; SYSTEMS OR METHODS SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES, NOT OTHERWISE PROVIDED FOR
- G06Q10/00—Administration; Management
- G06Q10/04—Forecasting or optimisation specially adapted for administrative or management purposes, e.g. linear programming or "cutting stock problem"
- G06Q10/047—Optimisation of routes or paths, e.g. travelling salesman problem
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06Q—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES; SYSTEMS OR METHODS SPECIALLY ADAPTED FOR ADMINISTRATIVE, COMMERCIAL, FINANCIAL, MANAGERIAL OR SUPERVISORY PURPOSES, NOT OTHERWISE PROVIDED FOR
- G06Q10/00—Administration; Management
- G06Q10/06—Resources, workflows, human or project management; Enterprise or organisation planning; Enterprise or organisation modelling
- G06Q10/063—Operations research, analysis or management
- G06Q10/0631—Resource planning, allocation, distributing or scheduling for enterprises or organisations
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Business, Economics & Management (AREA)
- Human Resources & Organizations (AREA)
- Engineering & Computer Science (AREA)
- Economics (AREA)
- Strategic Management (AREA)
- Entrepreneurship & Innovation (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Operations Research (AREA)
- Game Theory and Decision Science (AREA)
- Marketing (AREA)
- Development Economics (AREA)
- Quality & Reliability (AREA)
- Tourism & Hospitality (AREA)
- General Business, Economics & Management (AREA)
- Theoretical Computer Science (AREA)
- Educational Administration (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Traffic Control Systems (AREA)
Abstract
A multi-vehicle scheduling method includes the steps of constructing a layout map of vehicles and a closed space according to parameter information of current vehicles and layout information of parking environments, designing priority rules, calculating priorities of the vehicles according to the rules, and selecting the vehicles needing to be taken out of a warehouse. Planning a collision-free path which accords with kinematic constraint of each vehicle by adopting a punitive mixed A-algorithm; and according to the vehicle priority, sequentially adopting an s-t diagram strategy to obtain the conflict-free tracks of the multiple vehicles in space-time, and finishing the dispatching of the multiple vehicles for going out of the garage. The invention plans the path of the vehicle, and configures the speed by using the S-T chart strategy, thereby avoiding other vehicles, completing the integral dispatching of a plurality of vehicles and realizing the high-efficiency delivery without collision.
Description
Technical Field
The invention relates to a technology in the field of multi-vehicle control, in particular to a punishment-based hybrid A * An algorithm and an S-T diagram strategy multi-vehicle scheduling method.
Background
The existing multi-vehicle scheduling problem can be divided into two aspects of single-vehicle path planning and multi-vehicle scheduling. The path planning problem can be described as: on the premise that the environment is known or partially known, given the starting point and the target end point, a collision-free shortest path from the starting point to the end point is found. The multi-vehicle scheduling aims to solve the problem that the multiple vehicles move simultaneously and interfere with each other when leaving the garage simultaneously, ensure that all vehicles leave the garage orderly and rapidly, reduce the total time of leaving the garage and improve the efficiency. The path planning in the current scheduling method often does not meet the kinematics characteristics of the vehicles, or the phenomenon that the path is not smooth and reasonable enough exists, and the scheduling of multiple vehicles is not rapid enough.
Disclosure of Invention
Aiming at the defects in the prior art, the invention provides a multi-vehicle scheduling method, which is used for planning the path of a vehicle, configuring the speed by using an S-T chart strategy, avoiding other vehicles, completing the overall scheduling of a plurality of vehicles and realizing the efficient delivery without collision.
The invention is realized by the following technical scheme:
the invention relates to a punishment-based hybrid A * The multi-vehicle scheduling method based on the algorithm and the S-T chart strategy comprises the steps of constructing a layout map of vehicles and a closed space according to parameter information of the current vehicles and layout information of parking environments, designing priority rules, calculating the priority of each vehicle according to the rules, and selecting the vehicles needing to be delivered. With punishment of mixing A * An algorithm, planning a collision-free path of each vehicle according with kinematic constraints; and according to the vehicle priority, sequentially adopting an s-t diagram strategy to obtain the conflict-free tracks of the multiple vehicles in space-time, and finishing the dispatching of the multiple vehicles for going out of the garage.
The invention relates to a system for realizing the method, which comprises the following steps: priority computational element, route planning unit and speed planning unit, wherein: the priority calculating unit is connected with the path planning unit and transmits vehicle priority information and information of vehicles needing to go out of the garage, and the path planning unit is connected with the speed planning unit and transmits the path information of the vehicles.
Technical effects
The invention integrally solves the problems that the planned vehicle running path is not smooth enough and the speed in the running process in the prior artToo frequent switching. The present invention utilizes improved A compared to the prior art * The speed of the vehicle is planned by the algorithm and the S-T diagram, so that the switching of the driving states of the vehicle is reduced under the condition that the overall time is not influenced, the vehicle is more suitable for the actual situation, the speed planning which can not be realized physically is not generated, and the overall speed of multiple vehicles leaving the garage is improved.
Drawings
FIG. 1 is a schematic flow diagram of the present invention;
FIG. 2 is a layout map of a plurality of vehicles of the embodiment;
FIG. 3 is a schematic diagram of an S-T diagram of an embodiment;
FIG. 4 is a schematic illustration of a single vehicle path plan of an embodiment;
FIG. 5 is a schematic diagram of an embodiment of speed configuration using an S-T diagram.
Detailed Description
As shown in FIG. 1, the embodiment relates to a penalty-based blending A * The multi-vehicle scheduling method based on the algorithm and the S-T graph strategy specifically comprises the following steps:
and step S1, acquiring the parameter information of the current vehicle and the layout information of the parking environment, and constructing a layout map of the vehicle and the closed space.
As shown in fig. 2, the map of the present embodiment has a length and a width of 54m and 24m, respectively, and 6 vehicles are parked in the map space, and the vehicles are represented by rectangles, and other obstacles are represented by the smallest polygons that can include the obstacles: the vehicle is represented by a rectangle 10m long and 3.5m wide, which is numbered A, B, C, D, E, F from top to bottom and from left to right, and the enclosed space has only a single exit.
And step S2, designing corresponding priority rules according to the task requirements, the parking positions of the vehicles and the performances of the vehicles, calculating the priority of each vehicle according to the rules, and selecting the vehicles needing to be taken out of the warehouse.
The task requirements in this embodiment refer to: and (5) taking the four vehicles out of the garage.
The parking position of the vehicle is as follows: arranged with the vehicle heads facing outward in parallel, as shown in fig. 2, the vehicles are at varying distances from a single exit.
The performance of the vehicle comprises: maintenance condition of the vehicle, equipment assembly condition, and mileage.
The design principle is that vehicles with good state performance meeting the task requirement number are driven out of the garage as soon as possible, namely the overall vehicle out-of-garage time is the minimum, and the obtained priority rule is as follows: e i =b 1 P i +b 2 C i Wherein: e i Is the final composite index, C, of each vehicle i The position index of the vehicle is obtained according to P by comprehensively evaluating the performance of the vehicle i =(|x i (t fi )-x i (0)|+|y i (t fi )-y i (0) I))/2, wherein: | x i (t fi )-x i (0)|、|y i (t fi )-y i (0) L is the distance of the midpoint of the rear axle of each vehicle relative to the exit midpoint, b 1 ,b 2 Is a weight coefficient representing a tradeoff between vehicle performance and vehicle position.
In the present embodiment, the start and end positions and performance indexes of 6 vehicles are shown in table 1:
TABLE 1 vehicle parameter table
The weight coefficient is set as b 1 =0.4,b 2 At 0.6, the composite index of each vehicle is obtained, and the four vehicles A, E, C, F with the highest composite index are selected for delivery, and their priorities are assigned, as shown in table 2:
TABLE 2 vehicle combination index and priority
Step S3, punitive mixing A * And (4) an algorithm is used for planning a collision-free path of each vehicle, which meets the requirements of the position and attitude angle of the terminal point.
The kinematic constraint comprises: |a i (t)|≤a maxi ,|ν i (t)|≤ν maxi ,|ω i (t)|≤ω maxi wherein: (x) i (t),y i (t)) is the midpoint coordinate of the rear axle of the vehicle at time t, θ i (t) is the attitude angle of the vehicle in the XOY coordinate system, v i (t) and a i (t) velocity and acceleration of the vehicle along the longitudinal axis of the body,for the front wheel yaw angle of the vehicle, in the positive counter-clockwise direction, correspondingly, ω i (t) is the front wheel yaw angular velocity, L is the front and rear wheel wheelbase.
The requirement for meeting the position and attitude angle of the terminal point is as follows: satisfy (x) i (t fi ),y i (t fi ),θ i (t fi ))=(x * ,y * ,θ * )。
The punitive mixture A * The algorithm specifically comprises the following steps:
step S3-1: discretizing the map constructed in the step S1, adding the initial pose of the vehicle to be planned at this time as an initial node into an open list, and calculating the heuristic value of the current node.
The discretization treatment refers to the following steps: the map is converted into a plurality of discrete nodes by dividing the map x, y and the vehicle longitudinal axis direction angle theta at minute intervals Δ x, Δ y and Δ theta, respectively.
The open list refers to: for storing a list of nodes that have been sought on a map
The lower priority vehicles are considered static obstacles and the path plan of the vehicle may not reach the nodes occupied by the obstacles.
The calculation of the heuristic value specifically comprises: n is a radical of child .f=N child .g+N child .h,N child· g=N current· g+length+penalty,N child .h=|N child .S-S end L, wherein: the heuristic value f consists of a g function value and an h function value, and the h function value is only the distance between the s value of the node and the s value of the terminal point; the function value of g is the total path length from the starting point to the current node, N current· g is a g function value of a father node, length is the length from the father node to a child node, and penalty value penalty is the penalty of reversing in the S-T graph path searching process.
Step S3-2: selecting the node with the minimum heuristic value from the open list as a current node, removing the open list, adding a close list, and when the current node is a target node, turning to the step S3-5, otherwise, continuing to the step S3-3;
step S3-3: generating a shortest path which is in accordance with kinematic constraint from the current node to the target node by using a Reeds-Shepp curve, and turning to the step S3-5 when the Reeds-Shepp curve can just avoid all barriers; otherwise, continuing to expand the current node into 6 child nodes according to a preset node expansion mode.
The Reeds-Shepp curve refers to: all the arrangement and combination modes of the circular arcs and the straight line segments are summarized into 48 types, so that connection of any starting point and end point poses on a plane can be realized, the shortest pose can be guaranteed in the meaning of vehicle kinematics, and the obstacle avoidance requirement cannot be guaranteed.
The preset node expansion mode is as follows: the vehicle driving system corresponds to two forward and backward moving directions and three steering directions of left turning, right turning and straight going in the moving process of the vehicle, and corresponds to 6 expansion nodes in 6 driving states.
Step S3-4: when the expanded child node collides with the obstacle, namely the expanded child node is overlapped with the node occupied by the obstacle or the child node is already in the close table, ignoring the child node; when the child node is not in the open table, adding the open table, and calculating and recording the heuristic value and the father node of the child node; when the extended child node is already in the open table, the heuristic value of the node in the original open table is compared, and if the current heuristic value is smaller, the node is updated, and then the process goes to step S3-2.
Step S3-5: and (5) successfully searching the path and outputting a collision-free path.
As shown in fig. 4, after the target pose nodes are searched, a path plan satisfying the vehicle kinematic constraint from the starting point to the end point is obtained by backtracking in a mode of taking father nodes one by one.
Step S4: after the path planning is completed, sequentially adopting an s-t diagram strategy to obtain the conflict-free tracks of a plurality of vehicles in space and time according to the vehicle priority, and completing the dispatching of a plurality of vehicles out of the garage, which specifically comprises the following steps:
step S4-1: regarding the vehicle with the speed to be planned at present, according to the collision-free path obtained in the step S3, the vehicle with higher priority is regarded as a moving obstacle, and the path and the time are discretized to obtain an S-T graph in combination with other moving obstacles, wherein S is the set path planned by the vehicle step S3, the path is discretized by a small mileage interval Δ S, the same T is the driving time of the vehicle, and the time is discretized by a small time interval Δ T to obtain an S-T grid graph with T as a horizontal axis and S as a vertical axis. Starting the track of the vehicle with higher priority from the time t equal to 0 to the final time t equal to t end And judging whether the position of the vehicle with high priority at the moment is overlapped with the position of the currently planned vehicle or not at a tiny time interval delta T, combining the overlapped moment and the corresponding driving mileage S into coordinates (S, T) when the overlapping occurs, and marking the coordinates in an S-T diagram to indicate that other vehicles occupy the path at the moment.
Step S4-2: an open list and a close list are first created, and the origin (0, 0) in the S-T graph is added to the open list.
Step S4-3: from modified A * Extracting the node with the minimum heuristic value at the moment from an open list of the algorithm, selecting the node with the minimum heuristic value from the open list as the current node and moving out an open columnTable, adding close list when S ═ S of current node at the moment end Go to step S4-6, otherwise continue to step S4-4;
step S4-4: expanding the current node according to an improved node expansion mode, expanding 3 child nodes and calculating corresponding heuristic values: comparison with conventional A * In the eight-neighborhood expansion mode of the algorithm, because the time can not be backed and the driving speed can not tend to be infinite, three neighborhoods of the upper right, the upper right and the lower right are selected to expand child nodes, and the child nodes correspond to forward driving, parking and backing in the actual driving condition.
Step S4-5: for each child node, when the child node exists in a close table or belongs to an obstacle node in an S-T graph, the child node is ignored; when the child node is not in the open table, adding the open table, and recording the heuristic value and the father node of the child node; when the extension child node is already in the open table, comparing the heuristic value of the node in the original open table, and when the current heuristic value is smaller, updating the node. The iteration continues, proceeding to step S4-3.
Step S4-6: and successfully searching the path in the S-T diagram, and configuring the speed for the vehicle according to the path searched in the S-T diagram.
As shown in fig. 5, a speed configuration is planned for the vehicle using the S-T diagram, and the vehicle can travel along the route planned in step S3 to the destination without collision depending on the result of the speed configuration.
Through specific practical experiments, when the method is operated according to the vehicle parking condition shown in fig. 2 and the parameters in table 1, the vehicle path is smoother under the condition of ensuring the whole time, the switching times of the driving state of the vehicle can be reduced by half, and no reversing behavior occurs.
Compared with the prior art, the method considers the kinematic constraint of the vehicle, can complete path planning for the vehicle with incomplete constraint, has smooth path, and does not frequently have reversing and steering behaviors. The speed configuration of the vehicle of the path meeting the pose requirement of the vehicle leaving warehouse is more reasonable by considering the pose requirement of the vehicle, and the braking and backing behaviors can be reduced under the condition of ensuring the minimum overall time.
The foregoing embodiments may be modified in many different ways by one skilled in the art without departing from the spirit and scope of the invention, which is defined by the appended claims and not by the preceding embodiments, and all embodiments within their scope are intended to be limited by the scope of the invention.
Claims (9)
1. A multi-vehicle scheduling method based on a punishment type mixed A-algorithm and an S-T map strategy is characterized in that a layout map of vehicles and a closed space is constructed according to parameter information of current vehicles and layout information of parking environments, priority rules are designed, the priority of each vehicle is calculated according to the rules, vehicles needing to be delivered out of a warehouse are selected, and a collision-free path which accords with kinematic constraints of each vehicle is planned by adopting the punishment type mixed A-algorithm; and according to the vehicle priority, sequentially adopting an s-t diagram strategy to obtain the conflict-free tracks of the multiple vehicles in space-time, and finishing the dispatching of the multiple vehicles for going out of the garage.
2. The multi-vehicle scheduling method based on the penalty hybrid a-algorithm and S-T graph strategy according to claim 1, which specifically comprises:
step S1: acquiring parameter information of a current vehicle and layout information of a parking environment, and constructing a layout map of the vehicle and a closed space;
step S2: designing a corresponding priority rule according to the task requirement, the parking position of the vehicle and the performance of the vehicle, calculating the priority of each vehicle according to the rule, and selecting the vehicle needing to be taken out of the warehouse;
step S3: a punishment type mixed A-x algorithm is adopted to plan a collision-free path which accords with kinematic constraint of each vehicle, namely the requirements of the position and the attitude angle of a terminal point are met;
step S4: after the path planning is finished, sequentially adopting an s-t diagram strategy to obtain the conflict-free tracks of a plurality of vehicles in space and time according to the vehicle priority, and finishing the dispatching of a plurality of vehicles to leave the garage.
3. The method of claim 1, wherein the parking position is selected from the group consisting of: the vehicle heads are arranged in parallel outwards, as shown in fig. 2, the distances of the vehicles relative to a single outlet are different; the performance of the vehicle comprises: maintenance condition of the vehicle, equipment assembly condition, and mileage;
the design principle is that vehicles with good state performance meeting the task requirement number are driven out of the garage as soon as possible, namely the overall vehicle out-of-garage time is the minimum, and the obtained priority rule is as follows: e i =b 1 P i +b 2 C i Wherein: e i Is the final composite index, C, of each vehicle i The position index of the vehicle is obtained according to P by comprehensively evaluating the performance of the vehicle i =(|x i (t fi )-x i (0)|+|y i (t fi )-y i (0) I))/2, wherein: | x i (t fi )-x i (0)|、|y i (t fi )-y i (0) L is the distance of the midpoint of the rear axle of each vehicle relative to the exit midpoint, b 1 ,b 2 Is a weight coefficient representing a tradeoff between vehicle performance and vehicle position.
4. A method for multi-vehicle scheduling based on a penalized hybrid a-x algorithm and S-T graph strategy according to claim 1 or 2, wherein said kinematic constraints comprise: |a i (t)|≤a maxi ,|ν i (t)|≤ν maxi ,|ω i (t)|≤ω maxi wherein: (x) i (t),y i (t)) is the midpoint coordinate of the rear axle of the vehicle at time t, θ i (t) is the attitude angle of the vehicle in the XOY coordinate system, v i (t) and a i (t) speed of the vehicle along the longitudinal axis of the body and the sumThe speed of the motor is controlled by the speed of the motor,for the front wheel yaw angle of the vehicle, in the positive counter-clockwise direction, correspondingly, ω i (t) is the front wheel deflection angle speed, L is the front and rear wheel wheelbase;
the requirement for meeting the position and attitude angle of the terminal point is as follows: satisfies (x) i (t fi ),y i (t fi ),θ i (t fi ))=(x*,y*,θ*)。
5. The method for dispatching multiple vehicles based on penalty hybrid a-algorithm and S-T graph strategy according to any one of claims 1 to 4, wherein the penalty hybrid a-algorithm specifically comprises:
step S3-1: discretizing the map constructed in the step S1, adding the initial pose of the vehicle to be planned as an initial node into an open list, and calculating the heuristic value of the current node;
step S3-2: selecting the node with the minimum heuristic value from the open list as a current node, removing the open list, adding a close list, and when the current node is a target node, turning to the step S3-5, otherwise, continuing to the step S3-3;
step S3-3: generating a shortest path which accords with the kinematic constraint and is from the current node to the target node by using the Reeds-Shepp curve, and turning to the step S3-5 when the Reeds-Shepp curve can just avoid all barriers; otherwise, continuing to expand the current node into 6 child nodes according to a preset node expansion mode;
step S3-4: when the expanded child node collides with the obstacle, namely the expanded child node is overlapped with the node occupied by the obstacle or the child node is already in a close table, ignoring the child node; when the child node is not in the open table, adding the open table, and calculating and recording the heuristic value and the father node of the child node; when the extended child node is already in the open table, comparing the heuristic value of the node in the original open table, if the current heuristic value is smaller, updating the node, and then going to step S3-2;
step S3-5: and (5) successfully searching the path and outputting a collision-free path.
6. The method of claim 5, wherein the discretization process is selected from the group consisting of: dividing the map in the x direction and the y direction and the angle theta of the longitudinal axis direction of the vehicle at intervals of delta x, delta y and delta theta respectively, and converting the map into a plurality of discrete nodes; the lower priority vehicles are considered static obstacles and the path plan of the vehicle may not reach the nodes occupied by the obstacles.
7. The method of claim 5, wherein the heuristic value calculation specifically comprises: n is a radical of child· f=N child· g+N child· h,N child· g=N current· g+length+penalty,N child· h=|N child· S-S end L, wherein: the heuristic value f consists of a g function value and an h function value, and the h function value is only the distance between the s value of the node and the s value of the terminal point; the function value of g is the total path length from the starting point to the current node, N current· g is a g function value of a father node, length is the length from the father node to a child node, and penalty value penalty is the penalty of reversing in the S-T graph path searching process.
8. The method for multi-vehicle scheduling based on the penalty hybrid a-algorithm and S-T graph strategy according to claim 5, wherein the step 4 specifically comprises:
step S4-1: regarding the vehicle with the current speed to be planned, according to the collision-free path obtained in the step S3, regarding the vehicle with higher priority as a moving obstacle, and combining other moving obstacles to discretize the path and time to obtain an S-T diagram, wherein S is the determined path planned by the vehicle step S3, the path is discretized by a minute mileage interval Δ S, the same T is the vehicle travel time, the time is discretized by a minute time interval Δ T to obtain the path with T as the horizontal axis, and S is the horizontal axisAn S-T grid plot of the vertical axis; starting the track of the vehicle with higher priority from the time t equal to 0 to the final time t equal to t end Judging whether the position of the vehicle with high priority at the moment is overlapped with the position of the vehicle planned at present or not at a tiny time interval delta T, combining the overlapped moment and the corresponding driving mileage S into a coordinate (S, T) when the overlapping occurs, and marking the coordinate (S, T) in an S-T diagram to indicate that other vehicles occupy the path at the moment;
step S4-2: firstly, creating an open list and a close list, and adding an origin (0, 0) in an S-T diagram into the open list;
step S4-3: extracting the node with the minimum heuristic value at the moment from an open list of the improved A-star algorithm, selecting the node with the minimum heuristic value from the open list as the current node, removing the open list, adding a close list, and adding S-S of the current node at the moment end Go to step S4-6, otherwise continue to step S4-4;
step S4-4: expanding the current node according to an improved node expansion mode, expanding 3 child nodes and calculating corresponding heuristic values: compared with an eight-neighborhood expansion mode of a common A-star algorithm, due to the characteristic that time cannot be backed off and the driving speed cannot tend to infinity, three neighborhoods of the upper right, the upper right and the lower right are selected to expand child nodes, and the child nodes correspond to forward driving, parking and backing in the actual driving condition;
step S4-5: for each child node, when the child node exists in a close table or belongs to an obstacle node in an S-T graph, the child node is ignored; when the child node is not in the open table, adding the open table, and recording the heuristic value and the father node of the child node; when the expansion child node is already in the open table, comparing the heuristic value of the node in the original open table, and when the current heuristic value is smaller, updating the node; continuing iteration, and turning to the step S4-3;
step S4-6: and successfully searching the path in the S-T diagram, and configuring the speed for the vehicle according to the path searched in the S-T diagram.
9. A system for implementing the method of any preceding claim, comprising: priority computational element, route planning unit and speed planning unit, wherein: the priority calculating unit is connected with the path planning unit and transmits vehicle priority information and information of vehicles needing to go out of the garage, and the path planning unit is connected with the speed planning unit and transmits the path information of the vehicles.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110268430.1A CN115083139B (en) | 2021-03-12 | 2021-03-12 | Multi-vehicle scheduling method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110268430.1A CN115083139B (en) | 2021-03-12 | 2021-03-12 | Multi-vehicle scheduling method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115083139A true CN115083139A (en) | 2022-09-20 |
CN115083139B CN115083139B (en) | 2023-11-24 |
Family
ID=83240782
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110268430.1A Active CN115083139B (en) | 2021-03-12 | 2021-03-12 | Multi-vehicle scheduling method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115083139B (en) |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109764886A (en) * | 2019-01-15 | 2019-05-17 | 成都信息工程大学 | A kind of paths planning method |
CN110081894A (en) * | 2019-04-25 | 2019-08-02 | 同济大学 | A kind of real-time planing method of unmanned wheel paths based on the fusion of road structure weight |
CN110174111A (en) * | 2019-05-31 | 2019-08-27 | 山东华锐智能技术有限公司 | More AGV path planning algorithms of task segmented based on time window |
CN110487295A (en) * | 2019-09-06 | 2019-11-22 | 中国计量大学 | A kind of time-optimized smooth A* algorithm |
CN110806218A (en) * | 2019-11-29 | 2020-02-18 | 北京京东乾石科技有限公司 | Parking path planning method, device and system |
CN110836671A (en) * | 2019-11-14 | 2020-02-25 | 北京京邦达贸易有限公司 | Trajectory planning method, trajectory planning device, storage medium, and electronic apparatus |
CN110962847A (en) * | 2019-11-26 | 2020-04-07 | 清华大学苏州汽车研究院(吴江) | Lane centering auxiliary self-adaptive cruise trajectory planning method and system |
CN111123952A (en) * | 2019-12-31 | 2020-05-08 | 华为技术有限公司 | Trajectory planning method and device |
US20200264002A1 (en) * | 2019-02-14 | 2020-08-20 | New Jersey Institute Of Technology | Method For Computing Fastest Route On Road Networks With Dynamic Traffic Information |
CN112068545A (en) * | 2020-07-23 | 2020-12-11 | 哈尔滨工业大学(深圳) | Method and system for planning driving track of unmanned vehicle at crossroad and storage medium |
CN112455445A (en) * | 2020-12-04 | 2021-03-09 | 苏州挚途科技有限公司 | Automatic driving lane change decision method and device and vehicle |
-
2021
- 2021-03-12 CN CN202110268430.1A patent/CN115083139B/en active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109764886A (en) * | 2019-01-15 | 2019-05-17 | 成都信息工程大学 | A kind of paths planning method |
US20200264002A1 (en) * | 2019-02-14 | 2020-08-20 | New Jersey Institute Of Technology | Method For Computing Fastest Route On Road Networks With Dynamic Traffic Information |
CN110081894A (en) * | 2019-04-25 | 2019-08-02 | 同济大学 | A kind of real-time planing method of unmanned wheel paths based on the fusion of road structure weight |
CN110174111A (en) * | 2019-05-31 | 2019-08-27 | 山东华锐智能技术有限公司 | More AGV path planning algorithms of task segmented based on time window |
CN110487295A (en) * | 2019-09-06 | 2019-11-22 | 中国计量大学 | A kind of time-optimized smooth A* algorithm |
CN110836671A (en) * | 2019-11-14 | 2020-02-25 | 北京京邦达贸易有限公司 | Trajectory planning method, trajectory planning device, storage medium, and electronic apparatus |
CN110962847A (en) * | 2019-11-26 | 2020-04-07 | 清华大学苏州汽车研究院(吴江) | Lane centering auxiliary self-adaptive cruise trajectory planning method and system |
CN110806218A (en) * | 2019-11-29 | 2020-02-18 | 北京京东乾石科技有限公司 | Parking path planning method, device and system |
CN111123952A (en) * | 2019-12-31 | 2020-05-08 | 华为技术有限公司 | Trajectory planning method and device |
CN112068545A (en) * | 2020-07-23 | 2020-12-11 | 哈尔滨工业大学(深圳) | Method and system for planning driving track of unmanned vehicle at crossroad and storage medium |
CN112455445A (en) * | 2020-12-04 | 2021-03-09 | 苏州挚途科技有限公司 | Automatic driving lane change decision method and device and vehicle |
Non-Patent Citations (3)
Title |
---|
赵卫东: "两阶段搜索的A* 全局路径规划算法", 《计算机应用与软件》, vol. 37, no. 12, pages 249 - 253 * |
钱燮晖: "基于二次A* 算法的复杂环境下车辆导航路径规划方法", 《甘肃科学学报》, vol. 32, no. 2, pages 7 - 15 * |
陈荣军: "基于改进A~*算法的无人配送车避障最优路径规划", 《广东技术师范大学学报》, pages 1 - 7 * |
Also Published As
Publication number | Publication date |
---|---|
CN115083139B (en) | 2023-11-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Li et al. | An optimization-based path planning approach for autonomous vehicles using the DynEFWA-artificial potential field | |
Wei et al. | A behavioral planning framework for autonomous driving | |
CN112378408A (en) | Path planning method for realizing real-time obstacle avoidance of wheeled mobile robot | |
Chen et al. | Path planning with orientation-aware space exploration guided heuristic search for autonomous parking and maneuvering | |
Yoon et al. | Spline-based RRT∗ using piecewise continuous collision-checking algorithm for Car-like vehicles | |
CN111007862B (en) | Path planning method for cooperative work of multiple AGVs | |
CN113895463B (en) | Path planning method suitable for turning around of automatic driving vehicle | |
CN114898564B (en) | Intersection multi-vehicle cooperative passing method and system under unstructured scene | |
CN112606830A (en) | Two-section type autonomous parking path planning method based on mixed A-star algorithm | |
CN115309161B (en) | Mobile robot path planning method, electronic equipment and storage medium | |
CN114281084B (en) | Intelligent vehicle global path planning method based on improved A-algorithm | |
CN113978452B (en) | Automatic parallel parking path planning method | |
CN113608531A (en) | Unmanned vehicle real-time global path planning method based on dynamic window of safety A-guiding point | |
Zhang et al. | Hybrid A-based curvature continuous path planning in complex dynamic environments | |
Yi et al. | Smooth path planning for autonomous parking system | |
WO2024088068A1 (en) | Automatic parking decision making method based on fusion of model predictive control and reinforcement learning | |
CN115116220A (en) | Unmanned multi-vehicle cooperative control method for loading and unloading scene of mining area | |
CN114840001A (en) | Multi-vehicle collaborative track planning method in closed environment | |
Chen et al. | Combining space exploration and heuristic search in online motion planning for nonholonomic vehicles | |
Cheng et al. | Hierarchical MPC-based motion planning for automated vehicles in parallel autonomy | |
CN115083139B (en) | Multi-vehicle scheduling method | |
CN115817455A (en) | Automatic parking path planning method oriented to multiple parking space scenes | |
Huang et al. | Search-Based Path Planning Algorithm for Autonomous Parking: Multi-Heuristic Hybrid A | |
Rebollo et al. | Collision avoidance among multiple aerial robots and other non-cooperative aircraft based on velocity planning | |
CN114537435A (en) | Real-time whole vehicle track planning method in automatic driving |
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 |