Upload
rahul-kala
View
217
Download
1
Embed Size (px)
Citation preview
PGRC 2011 rkala.99k.org3 May 2023
Spline-Based Multi-Level Planning for Autonomous VehiclesRahul Kala
The paper was extended and published as: R. Kala, K. Warwick (2013) Multi-Level Planning for Semi-Autonomous Vehicles in Traffic Scenarios based on Separation Maximization, Journal of Intelligent and Robotic Systems, 2013,DOI:10.1007/s10846-013-9817-7
PGR-2011, 4th April, 2011 2
Autonomous Vehicles
Safety
Efficient Driving
Jam Avoidance
Coordination
Comfort
PGR-2011, 4th April, 2011 3
Conventional Model
Planning
PGR-2011, 4th April, 2011 4
Why not speed lanes?
Highly Diverse Sizes
Highly Diverse Speeds
Coordination
PGR-2011, 4th April, 2011 5
Why not speed lanes?
Single lanes
And if highly crowded
PGR-2011, 4th April, 2011 6
Why not speed lanes?“Our model assumes that vehicles travel only along lanes or on certain lane-change path. In California, the practice of “lane-splitting” is legal — motorcycles are free to travel in between cars in adjacent lanes. This occurs in the I-80 dataset, and presents a challenge for our method, which must try to find a path around such obstacles and force each vehicle to precisely follow a single lane.” –Sewall et al. (2011)
J. Sewall, J. van den Berg, M. C. Lin, D. Manocha, D, “Virtualized Traffic: Reconstructing Traffic Flows from Discrete Spatiotemporal Data”, IEEE Transaction on Visualization Computer Graphics, 17(1), 26-37 (2011).
PGR-2011, 4th April, 2011 7
Why not conventional Path Planning?
• Pre-known/same time of emergence• Wide spaces around• High mobility/Low Speeds
PGR-2011, 4th April, 2011 8
From Literature
Source: R. Kala, et al., Robotic path planning in static environment using hierarchical multi-neuron heuristic search and probability based fitness, Neurocomputing (2011), doi:10.1016/j.neucom.2011.03.006
PGR-2011, 4th April, 2011 9
From Literature
Source: R. Kala, et al., Fusion of probabilistic A* algorithm and fuzzy inference system for robotic path planning, Artificial Intelligence Review, Vol. 33, No. 4, pp 275-306
Map
Level 1
Level 2
PGR-2011, 4th April, 2011 10
MULTI-LEVEL PLANNING
PGR-2011, 4th April, 2011 11
Results
PGR-2011, 4th April, 2011 12
Results – Single Vehicle Scenarios
PGR-2011, 4th April, 2011 13
Results – 2 Vehicle Scenarios
PGR-2011, 4th April, 2011 14
Results – Multi- Vehicle Scenarios
PGR-2011, 4th April, 2011 15
Results - Overtaking
PGR-2011, 4th April, 2011 16
Results – Path Following
PGR-2011, 4th April, 2011 17
Solution
Road Selection
Pathway Selection
Pathway Distribution
Trajectory Generation
Vehicle to be planned
Road/Crossing MapPath
Pathway
Distributed Pathway
Trajectory
ReplanAll Vehicle Pathways
All Vehicle Trajectories
Controller
Replan
PGR-2011, 4th April, 2011 18
Road Selection
PGR-2011, 4th April, 2011 19
Separation Maximization
Separation
PathwaysHypothesis from: J. R. Alvarez-Sanchez, F. de la Paz Lopez, J. M. C. Troncoso, D. de Santos Sierra, “Reactive navigation in real environments using partial center of area method”, Robotic and Autonomous Systems, 58(12), 1231-1237 (2010).
PGR-2011, 4th April, 2011 20
Pathway Selection
PGR-2011, 4th April, 2011 21
Pathway SelectionDijkstra’s algorithm cost
• ds(Pajk(m2)) = ds(Paj
k(m1)) + || end(Pajk(m2)) –
end(Pajk(m1)) ||
• min_width(Pajk(m2)) = min(width(Paj
k(m2)), min_width(Paj
k(m1)),wmax)• cost(Paj
k(m2)) = ds(Pajk(m2)) + α min_width(Paj
k(m2))
PGR-2011, 4th April, 2011 22
Coordination and Re-planningRi is said to have a higher priority compared to Rr
if
• Ri and Rr are driving in same direction of road and Ri lies ahead of Rr.
Or• Ri and Rr are driving in opposite directions of
road and point of collision lies in left side of complete road.
PGR-2011, 4th April, 2011 23
Pathway Distribution
Separation
Pathways
PGR-2011, 4th April, 2011 24
Pathway Distribution
Vehicle 1(Speed=5)
Vehicle 2(Speed=5)
Overtake
Pre-preparation
Vehicle 3(Speed=15)
Pathway Distribution
PGR-2011, 4th April, 2011 25
Pathway Distribution• Prepare yourself early for distribution change
- Pre-preparation
• Late change of distribution - Post-preparation
PGR-2011, 4th April, 2011 26
Coordination and Re-planningRi has a higher priority if
• It lies ahead of Rr with Ri and Rr going in same direction
Or • Rr and Ri have different directions.
PGR-2011, 4th April, 2011 27
Trajectory Generation
PGR-2011, 4th April, 2011 28
Trajectory Generation
PGR-2011, 4th April, 2011 29
Trajectory Generation
Vehicle 1(Speed=5)
Vehicle 3(Speed=15)
Vehicle 2(Speed=5)
PGR-2011, 4th April, 2011 30
THANK YOU