22
* Both authors contributed equally Sampling-based Approximation Algorithms for Reachability Analysis with Provable Guarantees Lucas Liebenwein*, Cenk Baykal*, Igor Gilitschenski, Sertac Karaman, Daniela Rus Distributed Robotics Lab, CSAIL, MIT 1

Sampling-based Approximation Algorithms for Reachability

  • Upload
    others

  • View
    1

  • Download
    0

Embed Size (px)

Citation preview

Page 1: Sampling-based Approximation Algorithms for Reachability

* Both authors contributed equally

Sampling-based Approximation Algorithms for Reachability Analysis with Provable Guarantees

Lucas Liebenwein*, Cenk Baykal*, Igor Gilitschenski, Sertac Karaman, Daniela Rus

Distributed Robotics Lab, CSAIL, MIT

1

Page 2: Sampling-based Approximation Algorithms for Reachability

Motion Planning – What We Wish For

Karaman, Sertac, et al. "Sampling-based algorithms for optimal motion planning." IJRR 2011.

Murray, Sean, et al. "Robot Motion Planning on a Chip." RSS. 2016.

2

Page 3: Sampling-based Approximation Algorithms for Reachability

Motion Planning – What We Have

The New Nation, 06/28/2015 http://www.squirrel-project.eu/objectives.html

3

Page 4: Sampling-based Approximation Algorithms for Reachability

Reachability Analysis for Online Verification

Infeasible Plan Feasible Plan

4

Page 5: Sampling-based Approximation Algorithms for Reachability

Objective

For given timestep 𝑇, initial set 𝒳, dynamics ℎ(𝑥, 𝑢)find reachable set 𝐹(𝒳; 𝑇)

Initial set 𝒳 Reachable set F(𝒳;𝑇)

F(⋅ ; 𝑇)

5

Page 6: Sampling-based Approximation Algorithms for Reachability

Objective

For a reachable set 𝐹(𝒳; 𝑇), generate a subset 𝒮 ⊂ 𝒳 such that

1 − 휀 𝜇 𝐹 𝒳; 𝑇 ≤ 𝜇 𝐹 𝑆; 𝑇 ≤ 𝜇 𝐹 𝒳; 𝑇

Subset 𝒮 Underapproximation F(𝒮; 𝑇)

F(⋅ ; 𝑇)

6

Page 7: Sampling-based Approximation Algorithms for Reachability

Main Challenge

Evaluating reachability involves reasoning about

• Initial sets and how they evolve with respect to 𝐹(⋅; 𝑇)

• State space and curse of dimensionality

• Trade-off between computation time and accuracy

In general, reachable sets cannot be evaluated (exactly) within a feasible amount of time

7

Page 8: Sampling-based Approximation Algorithms for Reachability

Related Work

Porges, O., et al. (2015) Althoff, M., et al. (2014)

Liu, S.B., et al. (2017)Chen, M., et al. (2017) Erlien, S.M., et al. (2016)

Mitchell, I.M., et al. (2005)

8

Page 9: Sampling-based Approximation Algorithms for Reachability

Method

Initial set 𝒳

F(⋅ ; 𝑇)

Reachable set F(𝒳;𝑇)

9

Page 10: Sampling-based Approximation Algorithms for Reachability

Method

Initial set 𝒳

F(⋅ ; 𝑇)

Reachable set F(𝒳;𝑇)

10

Page 11: Sampling-based Approximation Algorithms for Reachability

Method

Initial set 𝒳

F(⋅ ; 𝑇)

Reachable set F(𝒳;𝑇)

11

Page 12: Sampling-based Approximation Algorithms for Reachability

Method

Initial set 𝒳

F(⋅ ; 𝑇)

Reachable set F(𝒳;𝑇)

12

Page 13: Sampling-based Approximation Algorithms for Reachability

Method

Initial set 𝒳

F(⋅ ; 𝑇)

Reachable set F(𝒳;𝑇)

13

Page 14: Sampling-based Approximation Algorithms for Reachability

Method

Initial set 𝒳

F(⋅ ; 𝑇)

Reachable set F(𝒳;𝑇)

14

Page 15: Sampling-based Approximation Algorithms for Reachability

𝛿-Packing

𝛿

15

Page 16: Sampling-based Approximation Algorithms for Reachability

𝛿

𝛿-Packing

16

Page 17: Sampling-based Approximation Algorithms for Reachability

𝛿

𝛿-Packing

17

Page 18: Sampling-based Approximation Algorithms for Reachability

𝛿-Packing

18

Page 19: Sampling-based Approximation Algorithms for Reachability

Reachable Set from 𝛿-Packing

Initial set 𝒳 Reachable set F(𝒳;𝑇)

F(⋅ ; 𝑇)𝛿

𝑥1

𝑥2

𝐹(𝑥1; 𝑇)

𝐹(𝑥2; 𝑇)

19

Page 20: Sampling-based Approximation Algorithms for Reachability

Reachable Set from 𝛿-Packing

Initial set 𝒳 Reachable set F(𝒳;𝑇)

F(⋅ ; 𝑇)𝛿

𝑥1

𝑥2

𝐹 𝑥1; 𝑇 ∩ 𝐹(𝑥2; 𝑇)

For a given 𝛿-packing, there is an upper bound on volume of 𝐹 𝑥1; 𝑇 ∩ 𝐹(𝑥2; 𝑇)

Guaranteed underapproximation for user-specified 휀 (see paper for formal proof)

20

Page 21: Sampling-based Approximation Algorithms for Reachability

Results: Dubin’s Car with Various Initial Sets

21

Dumbbell Lollipop Hedgehog

Page 22: Sampling-based Approximation Algorithms for Reachability

* Both authors contributed equally

Sampling-based Approximation Algorithms for Reachability Analysis with Provable Guarantees

Lucas Liebenwein*, Cenk Baykal*, Igor Gilitschenski, Sertac Karaman, Daniela Rus

Distributed Robotics Lab, CSAIL, MIT

22