Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

27
Verifying Stochastic Systems Jacob Steinhardt and Russ Tedrake Massachusetts Institute of Technology

Transcript of Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

Page 1: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

Verifying Stochastic SystemsJacob Steinhardt and Russ Tedrake

Massachusetts Institute of Technology

Page 2: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

Motivation

• Robots are often subject to large uncertainties

• dynamical: wind gusts

• perceptual: stereo vision

• To maximize performance, want to plan against typical case (99%) rather than worst case (100%)

Page 3: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

Lyapunov equations

Page 4: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

• Sufficient condition for stability: non-negative function V such that

Lyapunov equations

V̇ (x) ≤ 0

Page 5: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

Martingale condition

Page 6: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

Martingale condition

E[V̇ (x)] ≤ 0

Page 7: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

Martingale condition

E[V̇ (x)]� �� � ≤ 0� �� �

lim∆t→0+

E[V (x(t+∆t)) | x(t)]− V (x(t))

∆t

Page 8: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

Martingale condition

Page 9: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

Martingale condition

• Too strong!

E[V̇ (x)] ≤ 0

Page 10: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

Martingale condition

• Too strong!

• Consider the system

E[V̇ (x)] ≤ 0

Page 11: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

Martingale condition

• Too strong!

• Consider the system

E[V̇ (x)] ≤ 0

Page 12: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

Martingale condition

• Too strong!

• Consider the system

• What is ?

E[V̇ (x)] ≤ 0

dx(t) = −xdt+ dw(t)

E[V̇ (0)]

Page 13: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

Martingale condition

Page 14: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

• Instead consider the relaxed condition

Martingale condition

E[V̇ (x)] ≤ c

Page 15: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

• Instead consider the relaxed condition

• theorems giving finite-time guarantees (Kushner 1965)

Martingale condition

E[V̇ (x)] ≤ c

Page 16: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

• Instead consider the relaxed condition

• theorems giving finite-time guarantees (Kushner 1965)

• todo: choose and optimize over a family of functions V

Martingale condition

E[V̇ (x)] ≤ c

Page 17: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

Choosing V

Page 18: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

Choosing V

• V(x) = exp(xTJx)

Page 19: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

Choosing V

• V(x) = exp(xTJx)

• NB: using xTJx instead has poor results (no bound at all after a few seconds)

Page 20: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

Choosing V

• V(x) = exp(xTJx)

• NB: using xTJx instead has poor results (no bound at all after a few seconds)

• E[dV/dt] = p(x)exp(xTJx)

Page 21: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

Verifying the Martingale Condition

Page 22: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

• from previous slide:

Verifying the Martingale Condition

E[V̇ (x)] = p(x)exT Jx

Page 23: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

• from previous slide:

Verifying the Martingale Condition

E[V̇ (x)] = p(x)exT Jx

p(x)exT Jx ≤ c

⇐⇒ p(x) ≤ ce−xT Jx

⇐= p(x) ≤ c(1− xTJx)

Page 24: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

• from previous slide:

• polynomial condition: optimize with SOS programming

Verifying the Martingale Condition

E[V̇ (x)] = p(x)exT Jx

p(x)exT Jx ≤ c

⇐⇒ p(x) ≤ ce−xT Jx

⇐= p(x) ≤ c(1− xTJx)

Page 25: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

Results: Quadrotor

Page 26: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

Results: UAV

Page 27: Jacob Steinhardt and Russ Tedrake Massachusetts Institute ...

Further reading

• http://groups.csail.mit.edu/locomotion/

• LQR-trees tutorial on Friday in the “Integrated Planning and Control” workshop