SLIDE 1
Fast Solution of Optimal Control Problems with L1 Cost
Simon Le Cleac'h and Zac Manchester Robotjc Exploratjon Lab
SLIDE 2 Motivation
Why L1-norm cost?
- Minimum-fuel, minimum-tjme
- Bang-ofg-bang control
SLIDE 3 Contribution
Solver:
- Fast
- Low-memory footprint
- Nonlinear dynamics
- State and control constraints
Enables:
- In fmight sofuware implementatjon
- Embedded trajectory optjmizatjon
SLIDE 4
Trajectory Optimization
SLIDE 5
Trajectory Optimization
SLIDE 6
Trajectory Optimization
SLIDE 7
Trajectory Optimization
Nonsmooth cost functjon
SLIDE 8
ADMM
Problem form: f, g are convex Augmented Lagrangian:
SLIDE 9
ADMM
Augmented Lagrangian: 3 optjmizatjon steps:
SLIDE 10
ADMM
Augmented Lagrangian: 3 optjmizatjon steps: Minimizatjon Minimizatjon Dual ascent
SLIDE 11
Trajectory Optimization
SLIDE 12
Method
SLIDE 13
Method
SLIDE 14
Method
Augmented Lagrangian:
SLIDE 15
Method
Augmented Lagrangian: Cost
SLIDE 16
Method
Augmented Lagrangian: Penalty
SLIDE 17
Method
Augmented Lagrangian: Alternatjng Directjon Method of Multjpliers (ADMM)
1. 2. 3.
SLIDE 18
Method
Alternatjng Directjon Method of Multjpliers (ADMM)
1.
Optjmal control step <=> LQR, closed-form solutjon
SLIDE 19
Method
Alternatjng Directjon Method of Multjpliers (ADMM)
2.
Sofu-threhold step <=> closed-form solutjon
SLIDE 20
Method
Alternatjng Directjon Method of Multjpliers (ADMM)
3.
Dual ascent step <=> closed-form solutjon
SLIDE 21
Method
Alternatjng Directjon Method of Multjpliers (ADMM)
1. 2. 3.
Optjmal control step <=> LQR, closed-form solutjon Sofu-threhold step <=> closed-form solutjon Dual ascent step <=> closed-form solutjon
SLIDE 22 Application
Spacecrafu rendezvous problem
- Minimum-fuel
- Small satellite
- Pathfjnder for Autonomous Navigatjon (PAN)
SLIDE 23 Application
Spacecrafu rendezvous problem
- Nonlinear dynamics (drag etc.)
- Unbounded control
SLIDE 24 Results
- Nonlinear dynamics (drag etc.)
- Unbounded control
SLIDE 25 Results
- Nonlinear dynamics (drag etc.)
- Unbounded control
- Impulse control
SLIDE 26 Results
- Nonlinear dynamics (drag etc.)
- Bounded control
SLIDE 27 Results
- Nonlinear dynamics (drag etc.)
- Bounded control
- Bang-ofg-bang
SLIDE 28
Results
SLIDE 29
Spacecraft Rendezvous
L1 cost: Bang-ofg-bang
SLIDE 30
Spacecraft Rendezvous
Quadratjc cost: smooth control
SLIDE 31 Conclusions
Solver: for L1 control cost problem.
- Fast and low-memory footprint
- Broad range of applicatjons in astrodynamics
Enables:
- In fmight sofuware implementatjon
- Small satellite rendezvous maneuver
SLIDE 32
Questions?
simonlc@stanford.edu rexlab.stanford.edu
SLIDE 33
Algorithm