Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and...
-
date post
22-Dec-2015 -
Category
Documents
-
view
228 -
download
0
Transcript of Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and...
![Page 1: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/1.jpg)
Discrete Variational Mechanics
Benjamin Stephens
J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp. 357-514, 2001
M. West “Variational Integrators,” PhD Thesis, Caltech, 2004
1
![Page 2: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/2.jpg)
About My Research
• Humanoid balance using simple models
• Compliant floating body force control
• Dynamic push recovery planning by trajectory optimization
)(tC
)(tLP
C
LP
RP
F̂
2http://www.cs.cmu.edu/~bstephe1
![Page 3: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/3.jpg)
3http://www.cs.cmu.edu/~bstephe1
![Page 4: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/4.jpg)
But this talk is not about that…
![Page 5: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/5.jpg)
The Principle of Least Action
The spectacle of the universe seems all the more grand and beautiful and worthy of its Author, when one considers that it is all derived from a small number of laws laid down most wisely.
-Maupertuis, 1746
5
![Page 6: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/6.jpg)
The Main Idea
• Equations of motion are derived from a variational principle
• Traditional integrators discretize the equations of motion
• Variational integrators discretize the variational principle
6
![Page 7: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/7.jpg)
• Physically meaningful dynamics simulation
Motivation
Stein A., Desbrun M. “Discrete geometric mechanics for variational time integrators” in Discrete Differential Geometry. ACM SIGGRAPH Course Notes, 2006
7
![Page 8: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/8.jpg)
Goals for the Talk
• Fundamentals (and a little History)
• Simple Examples/Comparisons
• Related Work and Applications
• Discussion
8
![Page 9: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/9.jpg)
The Continuous Lagrangian
• Q – configuration space• TQ – tangent (velocity) space• L:TQ→R
)(),(),( qUqqTqqL
Kinetic Energy Potential EnergyLagrangian
9
![Page 10: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/10.jpg)
Variation of the Lagrangian
• Principle of Least Action = the function, q*(t), minimizes the integral of the Lagrangian
TT
dttqtqtqtqLdttqtqL00
))()(*),()(*())(*),(*(
0))(),((0
T
dttqtqL Variation of trajectory with endpoints fixed
“Hamilton’s Principle” ~183510
“Calculus of Variations” ~ Lagrange, 1760
![Page 11: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/11.jpg)
Continuous Lagrangian
0
q
L
dt
d
q
L
“Euler-Lagrange Equations”11
![Page 12: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/12.jpg)
Continuous Mechanics)(),())(),(( qUqqTtqtqL
)( UTqdt
d
L
dt
d
q
L
q
T
dt
d
q
U
q
T
qqq
Tqqq
T
q
U
q
T
22
0)(),()( qGqqCqqM 12
![Page 13: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/13.jpg)
The Discrete Lagrangian
• L:QxQ→R
13
hqqLdttqtqL kkd
hT
T
,,)(),( 1
L
kqh
1kq
hh
qqqLhqqL kkkkkd
11 ,,,
![Page 14: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/14.jpg)
Variation of Discrete Lagrangian
0,,,, 1112 tqqLDtqqLD kkdkkd
“Discrete Euler-Lagrange Equations” 14
![Page 15: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/15.jpg)
Variational Integrator
• Solve for :
0,,,, 1112 hqqLDhqqLD kkdkkd
0,, 111
hh
qqqL
qh
h
qqqL
qkk
kk
kkk
k
0,,,, 1111
11
h
qqq
q
Lh
h
qqq
q
L
h
qqq
q
Lh
h
qqq
q
L kkk
kkk
kkk
kkk
1kq
15
![Page 16: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/16.jpg)
Solution: Nonlinear Root Finder
)(
)(
1
11
11 i
k
iki
kik qDf
qfqq
0,,,,)( 11121 hqqLDhqqLDqf kkdkkdk
16
![Page 17: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/17.jpg)
Simple Example: Spring-Mass
• Continuous Lagrangian:
• Euler-Lagrange Equations:
• Simple Integration Scheme:
22
2
1
2
1, kxxmqqL
0
xmkxq
L
dt
d
q
L
kkk
kkkk
xm
khxx
xm
khxhxx
1
21 2
1
17
![Page 18: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/18.jpg)
Simple Example: Spring-Mass
• Discrete Lagrangian:
• Discrete Euler-Lagrange Equations:
• Integration:
18
22
11 2
1
2
1,, k
kkkkd kx
h
xxmhxxL
0,,,, 1112 hxxLDhxxLD kkdkkd
02 112 kkkk kxxxx
h
m
1
2
1 2
kkk xxm
khx
![Page 19: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/19.jpg)
Comparison: 3 Types of Integrators
• Euler – easiest, least accurate
• Runge-Kutta – more complicated, more accurate
• Variational – EASY & ACCURATE!
19
![Page 20: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/20.jpg)
0.97 0.98 0.99 1 1.01 1.02 1.03 1.04 1.05 1.06
-0.08
-0.06
-0.04
-0.02
0
0.02
0.04
position
velo
city
Euler h=0.001
Runge-Kutta (ode45)Variational h=0.001
20
![Page 21: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/21.jpg)
Notice:
•Energy does not dissipate over time
•Energy error is bounded
0 10 20 30 40 50 60 70 80 90 100
0.498
0.5
0.502
0.504
0.506
0.508
0.51
time (s)
Ene
rgy
Euler h=0.001
Runge-Kutta (ode45)Variational h=0.001
21
![Page 22: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/22.jpg)
Stein A., Desbrun M. “Discrete geometric mechanics for variational time integrators” in Discrete Differential Geometry. ACM SIGGRAPH Course Notes, 2006
Variational Integrators are “Symplectic”
• Simple explanation: area of the cat head remains constant over time
22
![Page 23: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/23.jpg)
Forcing Functions
• Discretization of Lagrange–d’Alembert principle
23
![Page 24: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/24.jpg)
Constraints
)(
)(
1
11
11 i
k
iki
kik zDf
zfzz
0
)(
)(,,,,)(
1
11121
k
kT
kkkdkkdk
qg
qghqqLDhqqLDzf
k
kk
qz
1
1
24
![Page 25: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/25.jpg)
Example: Constrained Double Pendulum w/ Damping
1
2
),( yx
0)(
y
xqg
2
1
0
0
)(
K
KqF
2
1
y
x
q
25
![Page 26: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/26.jpg)
Example: Constrained Double Pendulum w/ Damping
• Constraints strictly enforced, h=0.1
26No stabilization heuristics required!
![Page 27: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/27.jpg)
Complex Examples From Literature
E. Johnson, T. Murphey, “Scalable Variational Integrators for Constrained Mechanical Systems in Generalized Coordinates,”
IEEE Transactions on Robotics, 2009
a.k.a “Beware of ODE”
27
![Page 28: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/28.jpg)
Complex Examples From Literature
Variational Integrator
ODE
28
![Page 29: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/29.jpg)
Complex Examples From Literature
29
![Page 30: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/30.jpg)
Complex Examples From Literaturelo
g
Timestep was decreased until error was below threshold, leading to longer runtimes. 30
![Page 31: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/31.jpg)
Applications
• Marionette Robots
E. Johnson and T. Murphey, “Discrete and Continuous Mechanics for Tree Represenatations of Mechanical Systems,” ICRA 2008
31
![Page 32: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/32.jpg)
Applications
• Hand modeling
E. Johnson, K. Morris and T. Murphey, “A Variational Approach to Stand-Based Modeling of the Human Hand,” Algorithmic Foundations of Robotics VII, 2009
32
![Page 33: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/33.jpg)
Applications
• Non-smooth dynamics
Fetecau, R. C. and Marsden, J. E. and Ortiz, M. and West, M. (2003) Nonsmooth Lagrangian mechanics and variational collision integrators. SIAM Journal on Applied Dynamical Systems 33
![Page 34: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/34.jpg)
Applications
• Structural Mechanics
Kedar G. Kale and Adrian J. Lew, “Parallel asynchronous variational integrators,” International Journal for Numerical Methods in Engineering, 2007
34
![Page 35: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/35.jpg)
• Trajectory optimization
Applications
O. Junge, J.E. Marsden, S. Ober-Blöbaum, “Discrete Mechanics and Optimal Control”, in Proccedings of the 16th IFAC World Congress, 2005 35
![Page 36: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/36.jpg)
Summary
• Discretization of the variational principle results in symplectic discrete equations of motion
• Variational integrators perform better than almost all other integrators.
• This work is being applied to the analysis of robotic systems
36
![Page 37: Discrete Variational Mechanics Benjamin Stephens J.E. Marsden and M. West, “Discrete mechanics and variational integrators,” Acta Numerica, No. 10, pp.](https://reader030.fdocuments.in/reader030/viewer/2022033100/56649d805503460f94a6517b/html5/thumbnails/37.jpg)
Discussion
• What else can this idea be applied to?– Optimal Control is also derived from a variational
principle (“Pontryagin’s Minimum Principle”).
• This idea should be taught in calculus and/or dynamics courses.
• We don’t need accurate simulation because real systems never agree.
37