Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS...
Transcript of Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS...
![Page 1: Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS 01PEEQW -2014/2015 35 1 1 () ( ) ( ) c c c N N t t t t = = = τ Φ τ θ Φθ τ Φ ⋮](https://reader033.fdocuments.us/reader033/viewer/2022042301/5ecc2edbbe472800794394d2/html5/thumbnails/1.jpg)
20/03/2015
di 23 1
ROBOTICS
01PEEQW
Basilio Bona
DAUIN – Politecnico di Torino
Dynamics
![Page 2: Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS 01PEEQW -2014/2015 35 1 1 () ( ) ( ) c c c N N t t t t = = = τ Φ τ θ Φθ τ Φ ⋮](https://reader033.fdocuments.us/reader033/viewer/2022042301/5ecc2edbbe472800794394d2/html5/thumbnails/2.jpg)
20/03/2015
di 23 2
Dynamics – 1
� Dynamics studies the relations between the task space
forces/torques and the joint forces/torques in non-static
equilibrium, i.e., when the robot moves
� The dynamic model equation can be obtained applying two main
approaches
� Lagrange equations based on energy functions
� Newton-Euler equations based on the equilibrium of the vector forces
� The first approach is conceptually simpler and will be adopted here
� The second approach is more efficient for implementation of
recursive computer algorithms; only a brief review of this approach
will be presented here
Basilio Bona - DAUIN - PoliTo 3ROBOTICS 01PEEQW - 2014/2015
Dynamics – 2
� The dynamic equations of the robot can be obtained adopting the
Lagrange approach
� The derived state-space differential equations represent the robot
dynamical model
� Why state equations are necessary?
� Used for control design
� Used for robot simulation
� Used to implement model identification or parameter estimation
algorithms
Basilio Bona - DAUIN - PoliTo 4ROBOTICS 01PEEQW - 2014/2015
![Page 3: Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS 01PEEQW -2014/2015 35 1 1 () ( ) ( ) c c c N N t t t t = = = τ Φ τ θ Φθ τ Φ ⋮](https://reader033.fdocuments.us/reader033/viewer/2022042301/5ecc2edbbe472800794394d2/html5/thumbnails/3.jpg)
20/03/2015
di 23 3
Newton-Euler approach – 1
Basilio Bona - DAUIN - PoliTo 5ROBOTICS 01PEEQW - 2014/2015
Newton-Euler approach – 2
Basilio Bona - DAUIN - PoliTo 6ROBOTICS 01PEEQW - 2014/2015
![Page 4: Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS 01PEEQW -2014/2015 35 1 1 () ( ) ( ) c c c N N t t t t = = = τ Φ τ θ Φθ τ Φ ⋮](https://reader033.fdocuments.us/reader033/viewer/2022042301/5ecc2edbbe472800794394d2/html5/thumbnails/4.jpg)
20/03/2015
di 23 4
Newton-Euler approach – 3
Basilio Bona - DAUIN - PoliTo 7ROBOTICS 01PEEQW - 2014/2015
Newton-Euler approach – 4
Basilio Bona - DAUIN - PoliTo 8ROBOTICS 01PEEQW - 2014/2015
ib
ic
![Page 5: Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS 01PEEQW -2014/2015 35 1 1 () ( ) ( ) c c c N N t t t t = = = τ Φ τ θ Φθ τ Φ ⋮](https://reader033.fdocuments.us/reader033/viewer/2022042301/5ecc2edbbe472800794394d2/html5/thumbnails/5.jpg)
20/03/2015
di 23 5
Newton-Euler approach – 5
Basilio Bona - DAUIN - PoliTo 9ROBOTICS 01PEEQW - 2014/2015
Newton-Euler approach – 6
Basilio Bona - DAUIN - PoliTo 10ROBOTICS 01PEEQW - 2014/2015
![Page 6: Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS 01PEEQW -2014/2015 35 1 1 () ( ) ( ) c c c N N t t t t = = = τ Φ τ θ Φθ τ Φ ⋮](https://reader033.fdocuments.us/reader033/viewer/2022042301/5ecc2edbbe472800794394d2/html5/thumbnails/6.jpg)
20/03/2015
di 23 6
Newton-Euler approach – 7
Basilio Bona - DAUIN - PoliTo 11ROBOTICS 01PEEQW - 2014/2015
Lagrange equations – 1
Basilio Bona - DAUIN - PoliTo 12ROBOTICS 01PEEQW - 2014/2015
![Page 7: Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS 01PEEQW -2014/2015 35 1 1 () ( ) ( ) c c c N N t t t t = = = τ Φ τ θ Φθ τ Φ ⋮](https://reader033.fdocuments.us/reader033/viewer/2022042301/5ecc2edbbe472800794394d2/html5/thumbnails/7.jpg)
20/03/2015
di 23 7
Lagrange equations – 2
Basilio Bona - DAUIN - PoliTo 13ROBOTICS 01PEEQW - 2014/2015
Lagrange equations – 3
Basilio Bona - DAUIN - PoliTo 14ROBOTICS 01PEEQW - 2014/2015
![Page 8: Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS 01PEEQW -2014/2015 35 1 1 () ( ) ( ) c c c N N t t t t = = = τ Φ τ θ Φθ τ Φ ⋮](https://reader033.fdocuments.us/reader033/viewer/2022042301/5ecc2edbbe472800794394d2/html5/thumbnails/8.jpg)
20/03/2015
di 23 8
Lagrange equations – 4
Basilio Bona - DAUIN - PoliTo 15ROBOTICS 01PEEQW - 2014/2015
Kinetic Energy – 1
Basilio Bona - DAUIN - PoliTo 16ROBOTICS 01PEEQW - 2014/2015
![Page 9: Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS 01PEEQW -2014/2015 35 1 1 () ( ) ( ) c c c N N t t t t = = = τ Φ τ θ Φθ τ Φ ⋮](https://reader033.fdocuments.us/reader033/viewer/2022042301/5ecc2edbbe472800794394d2/html5/thumbnails/9.jpg)
20/03/2015
di 23 9
Kinetic Energy – 2
Basilio Bona - DAUIN - PoliTo 17ROBOTICS 01PEEQW - 2014/2015
Kinetic Energy – 3
Basilio Bona - DAUIN - PoliTo 18ROBOTICS 01PEEQW - 2014/2015
First form for the Kinetic Energy
![Page 10: Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS 01PEEQW -2014/2015 35 1 1 () ( ) ( ) c c c N N t t t t = = = τ Φ τ θ Φθ τ Φ ⋮](https://reader033.fdocuments.us/reader033/viewer/2022042301/5ecc2edbbe472800794394d2/html5/thumbnails/10.jpg)
20/03/2015
di 23 10
Kinetic Energy – 1
Basilio Bona - DAUIN - PoliTo 19ROBOTICS 01PEEQW - 2014/2015
Second form for the Kinetic Energy
Potential Energy – 1
Basilio Bona - DAUIN - PoliTo 20ROBOTICS 01PEEQW - 2014/2015
![Page 11: Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS 01PEEQW -2014/2015 35 1 1 () ( ) ( ) c c c N N t t t t = = = τ Φ τ θ Φθ τ Φ ⋮](https://reader033.fdocuments.us/reader033/viewer/2022042301/5ecc2edbbe472800794394d2/html5/thumbnails/11.jpg)
20/03/2015
di 23 11
Potential Energy – 2
Basilio Bona - DAUIN - PoliTo 21ROBOTICS 01PEEQW - 2014/2015
Potential Energy – 3
Basilio Bona - DAUIN - PoliTo 22ROBOTICS 01PEEQW - 2014/2015
![Page 12: Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS 01PEEQW -2014/2015 35 1 1 () ( ) ( ) c c c N N t t t t = = = τ Φ τ θ Φθ τ Φ ⋮](https://reader033.fdocuments.us/reader033/viewer/2022042301/5ecc2edbbe472800794394d2/html5/thumbnails/12.jpg)
20/03/2015
di 23 12
Generalized forces – 1
Basilio Bona - DAUIN - PoliTo 23ROBOTICS 01PEEQW - 2014/2015
Generalized forces – 2
Basilio Bona - DAUIN - PoliTo 24ROBOTICS 01PEEQW - 2014/2015
![Page 13: Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS 01PEEQW -2014/2015 35 1 1 () ( ) ( ) c c c N N t t t t = = = τ Φ τ θ Φθ τ Φ ⋮](https://reader033.fdocuments.us/reader033/viewer/2022042301/5ecc2edbbe472800794394d2/html5/thumbnails/13.jpg)
20/03/2015
di 23 13
Generalized forces – 3
Basilio Bona - DAUIN - PoliTo 25ROBOTICS 01PEEQW - 2014/2015
Final equations – 1
Basilio Bona - DAUIN - PoliTo 26ROBOTICS 01PEEQW - 2014/2015
![Page 14: Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS 01PEEQW -2014/2015 35 1 1 () ( ) ( ) c c c N N t t t t = = = τ Φ τ θ Φθ τ Φ ⋮](https://reader033.fdocuments.us/reader033/viewer/2022042301/5ecc2edbbe472800794394d2/html5/thumbnails/14.jpg)
20/03/2015
di 23 14
Final equations – 2
Basilio Bona - DAUIN - PoliTo 27ROBOTICS 01PEEQW - 2014/2015
Final equations – 3
Basilio Bona - DAUIN - PoliTo 28ROBOTICS 01PEEQW - 2014/2015
![Page 15: Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS 01PEEQW -2014/2015 35 1 1 () ( ) ( ) c c c N N t t t t = = = τ Φ τ θ Φθ τ Φ ⋮](https://reader033.fdocuments.us/reader033/viewer/2022042301/5ecc2edbbe472800794394d2/html5/thumbnails/15.jpg)
20/03/2015
di 23 15
Physical interpretation – 1
Basilio Bona - DAUIN - PoliTo 29ROBOTICS 01PEEQW - 2014/2015
21 43 5
Physical interpretation – 2
Basilio Bona - DAUIN - PoliTo 30ROBOTICS 01PEEQW - 2014/2015
1
2
3
4
5
![Page 16: Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS 01PEEQW -2014/2015 35 1 1 () ( ) ( ) c c c N N t t t t = = = τ Φ τ θ Φθ τ Φ ⋮](https://reader033.fdocuments.us/reader033/viewer/2022042301/5ecc2edbbe472800794394d2/html5/thumbnails/16.jpg)
20/03/2015
di 23 16
Properties of the Lagrange Equations – 1
Basilio Bona - DAUIN - PoliTo 31ROBOTICS 01PEEQW - 2014/2015
Properties of the Lagrange Equations – 2
Basilio Bona - DAUIN - PoliTo 32ROBOTICS 01PEEQW - 2014/2015
![Page 17: Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS 01PEEQW -2014/2015 35 1 1 () ( ) ( ) c c c N N t t t t = = = τ Φ τ θ Φθ τ Φ ⋮](https://reader033.fdocuments.us/reader033/viewer/2022042301/5ecc2edbbe472800794394d2/html5/thumbnails/17.jpg)
20/03/2015
di 23 17
Properties of the Lagrange Equations – 3
Basilio Bona - DAUIN - PoliTo 33ROBOTICS 01PEEQW - 2014/2015
Dynamic calibration – 1
Basilio Bona - DAUIN - PoliTo 34ROBOTICS 01PEEQW - 2014/2015
![Page 18: Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS 01PEEQW -2014/2015 35 1 1 () ( ) ( ) c c c N N t t t t = = = τ Φ τ θ Φθ τ Φ ⋮](https://reader033.fdocuments.us/reader033/viewer/2022042301/5ecc2edbbe472800794394d2/html5/thumbnails/18.jpg)
20/03/2015
di 23 18
Dynamic calibration – 2
� Collecting all data one obtains
Basilio Bona - DAUIN - PoliTo 35ROBOTICS 01PEEQW - 2014/2015
1 1( ) ( )
( ) ( )
c
c
c N N
t t
t t
= = =
τ Φ
τ θ Φθ
τ Φ
⋮ ⋮
� The linear least square solution is then computed, as
follows
( )1
ˆc
−
=θ Φ Φ Φ τT T
State equations – 1
Basilio Bona - DAUIN - PoliTo 36ROBOTICS 01PEEQW - 2014/2015
![Page 19: Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS 01PEEQW -2014/2015 35 1 1 () ( ) ( ) c c c N N t t t t = = = τ Φ τ θ Φθ τ Φ ⋮](https://reader033.fdocuments.us/reader033/viewer/2022042301/5ecc2edbbe472800794394d2/html5/thumbnails/19.jpg)
20/03/2015
di 23 19
State equations – 2
Basilio Bona - DAUIN - PoliTo 37ROBOTICS 01PEEQW - 2014/2015
Direct and inverse dynamics
Basilio Bona - DAUIN - PoliTo 38ROBOTICS 01PEEQW - 2014/2015
![Page 20: Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS 01PEEQW -2014/2015 35 1 1 () ( ) ( ) c c c N N t t t t = = = τ Φ τ θ Φθ τ Φ ⋮](https://reader033.fdocuments.us/reader033/viewer/2022042301/5ecc2edbbe472800794394d2/html5/thumbnails/20.jpg)
20/03/2015
di 23 20
Numerical recursive algorithms – 1
Basilio Bona - DAUIN - PoliTo 39ROBOTICS 01PEEQW - 2014/2015
Numerical recursive algorithms – 2
Basilio Bona - DAUIN - PoliTo 40ROBOTICS 01PEEQW - 2014/2015
![Page 21: Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS 01PEEQW -2014/2015 35 1 1 () ( ) ( ) c c c N N t t t t = = = τ Φ τ θ Φθ τ Φ ⋮](https://reader033.fdocuments.us/reader033/viewer/2022042301/5ecc2edbbe472800794394d2/html5/thumbnails/21.jpg)
20/03/2015
di 23 21
Numerical recursive algorithms – 3
Basilio Bona - DAUIN - PoliTo 41ROBOTICS 01PEEQW - 2014/2015
Numerical recursive algorithms – 4
Basilio Bona - DAUIN - PoliTo 42ROBOTICS 01PEEQW - 2014/2015
![Page 22: Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS 01PEEQW -2014/2015 35 1 1 () ( ) ( ) c c c N N t t t t = = = τ Φ τ θ Φθ τ Φ ⋮](https://reader033.fdocuments.us/reader033/viewer/2022042301/5ecc2edbbe472800794394d2/html5/thumbnails/22.jpg)
20/03/2015
di 23 22
Numerical recursive algorithms – 5
Basilio Bona - DAUIN - PoliTo 43ROBOTICS 01PEEQW - 2014/2015
Numerical recursive algorithms – 6
Basilio Bona - DAUIN - PoliTo 44ROBOTICS 01PEEQW - 2014/2015
![Page 23: Robotics 2015 05 Dynamics - polito.it · 2015-03-20 · Basilio Bona -DAUIN -PoliTo ROBOTICS 01PEEQW -2014/2015 35 1 1 () ( ) ( ) c c c N N t t t t = = = τ Φ τ θ Φθ τ Φ ⋮](https://reader033.fdocuments.us/reader033/viewer/2022042301/5ecc2edbbe472800794394d2/html5/thumbnails/23.jpg)
20/03/2015
di 23 23
Conclusions
� Dynamics equations are essential for modeling and control purposes
� Modeling is easier to understand adopting the Lagrange energy
function
� Computer program are more efficient if they implement recursive
Newton-Euler approach
� Nonlinear state equations have this form
Basilio Bona - DAUIN - PoliTo 45ROBOTICS 01PEEQW - 2014/2015
NonlinearitiesProducts, squares, trigonometric functions
herehere here