multi-level planning for semi-autonomous vehicles in traffic scenarios based on separation...

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