Académique Documents
Professionnel Documents
Culture Documents
• DEFINITION
Établir une relation entre les grandeurs cinématiques (déplacements, vitesses,
accélérations) et les grandeurs dynamiques (couples aux joints, forces de gravité,
forces de travail...)
1
6.1 CONCEPT DE MODELE DYNAMIQUE
.
θ(0) θ(0)
– Matrice d’inertie
– Forces centrifuges et de Coriolis
– Termes de gravité
– Couples extérieurs
2
6.1 PLAN DU CHAPITRE
• PRINCIPE DE HAMILTON
Entre les instants t1 et t2 auxquels la position est prescrite, la trajectoire réelle que
le système adopte est telle que:
Z t2 Z t2
± (K ¡ U ) dt + ± W dt = 0
t1 t1
3
6.2 DYNAMIQUE DU CORPS RIGIDE
z´
y´
V f
Z
r p
x´
X
• Hypothèses
– Corps rigide
– Système de coordonnées x’ y’ z’ centré au centre de masse O’ du corps
– Mouvement sous l’action
• des forces de gravité de vecteur g
• d’une distribution de forces de volume f
– Position d’un point du corps: r + Rp0
ENERGIE POTENTIELLE
Z
U = gT (r + Rp0 ) dm
V
• On a donc
U = m gT r
4
6.2 DYNAMIQUE DU CORPS RIGIDE
ENERGIE CINETIQUE Z
1
K = vT v dm
2 V
K = K1 + K2 + K3
1 1 T
K1 = m r_ T r_ = m v0 v0
2 2
Z
K2 = r_ T R_ T p0 dm
V
Z
1 T
K3 = p0 R_ T R_ p0 dm
2 V
v0 = RT r_
5
6.2 DYNAMIQUE DU CORPS RIGIDE
• Etant donné que le point o’ est le centre de masse, elle est nulle
Z
K2 = r_ T R_ T p0 dm = 0
V
• On tire 1 0 T 0 0
K3 = (! ) J !
2
6
6.2 DYNAMIQUE DU CORPS RIGIDE
ENERGIE CINETIQUE
Z
1
K = vT v dm v = r_ + R_ p0
2 V
• Tous calculs faits, l’énergie cinétique est constitué d’un terme d’énergie en translation
et d’un terme d’énergie en rotation:
1 T 1
K = mr_ r_ + !T J !
2 2
1 0T 0 1 T
= mv v + !0 J 0 !0
2 2
7
6.2 DYNAMIQUE DU CORPS RIGIDE
±(r + Rp0 ) = ±r + ±®
~ (p ¡ r) ~ = ±R RT
±® ~ (p ¡ r) = ¡ (pg
±® ¡ r) ± ®
• Son expression devient
± W = F T ±r + N T ±®
8
6.2 DYNAMIQUE DU CORPS RIGIDE
• Définition (rappel)
~ = ±R RT
±® ~ = R_ RT
!
±! = ±®_ ¡ !
~ ±®
±! 0 = ±®_ 0 + !
~ 0 ±®0
EQUATIONS DU MOUVEMENT
• Variation de l’énergie cinétique en coordonnées absolues
1 T
± K = m r_ T ± r_ + ! T J ± ! + ! ±J !
2
• Tenant compte que:
~ J ¡ J ±®
±J = ± ® ~
• On a
±K = m r_ T ±r_ + !T J ±®_
• Variation de l’énergie potentielle
±U = mgT ±r
• Variation du travail des forces extérieures
±W = F T ±r + N T ±®
9
6.2 DYNAMIQUE DU CORPS RIGIDE
EQUATIONS DU MOUVEMENT
• Le principe de Hamilton donne
Z t2
[m r_ T ± r_ + ! T J ±®_ ¡ m g T ± r + F T ± r + N T ± ®] dt = 0
t1
• Et encore
£ T ¤t 2
! J ± ® + mr_ T ± r t 1
Z t2 ½ ¾
T T
£ d ¤
+ ±r (¡ Ä ¡
mr m g F+ ) + ±® N ¡ (J! ) dt = 0
t1 dt
EQUATIONS DU MOUVEMENT
Les conditions de stationarité issues du principe de Hamilton donnent lieu aux
équations d’équilibre
mrÄ = ¡ mg + F
d
(J ! ) = N
dt
Ou encore
J !_ + !
~J! = N
10
6.2 DYNAMIQUE DU CORPS RIGIDE
EQUATIONS DU MOUVEMENT
• Equations d’équilibre en axes matériels
– Pour l’équilibre en translation, on a simplement que
ma0 = ¡ m g0 + F 0 a0 = RT rÄ
ce qui donne
J 0 !_ 0 + !
~ 0 J 0 !0 = N 0
• Définitions:
– ω’i vitesse angulaire du corps i en axes
matériels du corps i qi+1
– v’ic et a’ic vitesse et accélération du centre de
qi
masse du maillon en axes matériels i vic wi
– f’i+1 et n’i+1 forces et réactions exercées par
*
-f i+1
le corps i sur le corps i+1 dans les axes du -n*i+1
maillon i+1
ni
– f*i+1 et n*i+1 forces et réactions exercées par f i
le corps i sur le corps i+1 ramenées dans les zi
gi yi
axes du corps i xi
zi-1
– g*i le vecteur position du centre de masse du y x i-1
corps i depuis oi mais exprimé dans le repère i-1
du maillon i-1 di
11
6.3.1 Equilibre du maillon dans le formalisme de Newton-Euler
mi a0ic = ¡ mi g + Fi0
Ji0 !_ i0 + !
~ i0 Ji0 !i0 = Ni0
3 étapes:
• Calcul de la cinématique selon une procédure récursive directe
• Calcul des forces d’inerties des liens
• Calcul de la dynamique et des forces selon une procédure récursive inverse
F, C
12
6.3.2 Technique récursive de Newton-Euler
pour la dynamique inverse
• ETAPE 1 : APPROCHE RECURSIVE DIRECTE POUR LA CINEMATIQUE
– Initialisation
!00 = 0 v00 = 0
!_ 00 = 0 a00 = ¡ g
– Etapes i = 1…n ? 0
!i+ 1 = !i + (1 ¡ ¾) q_i+ 1 k
?
!_ i+ _ i0 + (1 ¡ ¾) [q_i+1 !
1 = ! ~ i0 + qÄi+ 1 ] k
?
? 0
ai+ 1 = ai + (! ~_ i+ 1 ¡ ! ? T
~ i+ 1 ! ?
~ i+1 )d?i+ 1 + ¾ (2qÄi0 !
~ i0 + qÄi + 1 )k
0 T ?
!i+ 1 = Ri+ 1 !i+ 1
0 T ?
!_ i+ 1 = Ri+ 1 !
_ i+ 1
– Itération i=n-1…0
fi0 = Fi0 + fi?+ 1
n0i = Ni0 + n?i + 1 + g~i0 Fi0 + d~0i fi+ 1
fi? = Ri fi + 1
n?i = Ri n0i
– Forces dans les actuateurs
¿i = kT n?i
13
6.4 DYNAMIQUE LAGRANGIENNE
L(qk ; q_k ) = K ¡ U
• Équations de Lagrange décrivant le mouvement
d ³ @L ´ @L
¡ = Qk k = 1; : : : n
dt @ q_k @qk
n
X n n
1 XX
K = Ki = mj k (q) q_j q_k
2 j = 1 k =1
– Propriétés de la matrice M i= 1
• Les coefficients mjk sont dépendants de la configuration et sont symétriques
14
6.4.2 Énergie Potentielle et forces de gravité
• Charges de gravité
Xn
@U @rci
Gk = = mi gT
@qk i= 1
@qk
±x = J ±q
15
6.4.4 Structure des forces d’inertie
– Le premier terme
d ³X ´
n X n
d
mk j q_j = [mkj qÄj + (mk j )q_j ]
dt j =1 j =1
dt
• avec n
d X @mkj
(mk j ) = q_l
dt l =1
@ql
– Le second terme
n n
@K 1 X X @mj l
= q_j q_l
@qk 2 j= 1 l=1 @qk
M qÄ + C(q ; q_ ) q_
– Le second terme prend en compte les forces centrifuges et de Coriolis
n ³
X @mkj 1 @mlj ´
ck j = ¡ q_l
@ql 2 @qk
l= 1
– On a la propriété suivante d’antisymétrie de la matrice
n ³
X @mkj @mlj ´
_ ¡ 2C
S = M ¡ + q_l
@ql @qk
– De la plus grande importance pour le contrôle (Fonction
l =1 de Lyapounov)
16
6.4.5 Equation du mouvement
M qÄ + A q_ 2 + G + J T F = ¿
• Introduction
– Solution du problème de dynamique inverse.
– Comme pour la formulation Euler-Newton, la formulation lagrangienne peut être écrite de
sous forme d’une procédure récursive pour les chaînes cinématiques ouvertes.
– Adoption du formalisme des transformations homogènes.
• Plan:
– Cinématique de la chaîne ouverte selon une procédure récursive directe (de la base vers
l’effecteur).
– Dynamique inverse formulée selon une procédure récursive inverse (de l’effecteur vers la
base).
17
6.5.1 Cinématique directe
• Vitesse du point P
p_ = T_i p0
• Accélération du point P
pÄ = TÄi p0
– avec
· ¸
~ ¾k
(1 ¡ ¾)k
¢_ i = q_i
i¡ 1
0T 0
• Calculer les dérivées secondes à partir de
18
6.5.2 Énergie cinétique
2 3
(¡Ixx + Iy y + Iz z )=2 Ixy Ixz mx0c
6 Ixy (Ixx ¡ Iy y + Iz z )=2 Iy z myc0 7
J = 6
4
7
Ixz Iy z (Ixx + Iy y ¡ Iz z )=2 mzc0 5
mx0c myc0 mzc0 m
Z Z
2 2 R 2 2 2 2
Ixx = (y 0 + z 0 )dm Iy y = Vi (x0 + z 0 )dm Iz z = (x0 + y0 )dm
Vi Vi
Z Z
R
Ixy = x0 y 0 dm Iy z = Vi y 0 z 0 dm Iz x = z 0 x0 dm
Vi Vi
19
6.5.4 Énergie potentielle et ses dérivées partielles
Ui = ¡ mi gT pic
= ¡ mi gT Ti p0ic
• Commençons par
@ h1 ªi
n
@K ©X
= trace T_i Ji T_iT
@ q_k @ q_k 2 i=1
n
X © @ T_i ª
= trace Ji T_i
i=1
@ q_k
• Notons que 8 _
>
> @Ti
>
> = 0 if k > i
< @ q_k
>
> _
>
: @Ti = @Ti
>
if k · i
@ q_k @qk
20
6.5.5 Dérivées partielles de l’énergie cinétique
• Soit Xn
© @Ti ª
@K
= trace Ji T_iT
@ q_k i=k
@qk
• Et encore n
X
d ¡ @K ¢ © @ T_i @Ti ª
= trace Ji T_iT + Ji TÄiT
dt @ q_k @qk @qk
i=k
• De manière similaire
Xn
@K © @T_i ª
= trace Ji T_iT
@qk i=k
@qk
n h
X © @Ti ª @Ti 0 i
trace Ji TÄiT ¡ mi g T p = Qk (t) (k = 1; : : : n)
@qk @qk ic
i=k
• Remarque:
– Qk sont les efforts aux liaisons dont une partie est produite par les actuateurs le reste étant
fourni par des réactions dans les organes de la liaison.
• Nombre d’opérations
– si on adopte une procédure récursive directe pour la cinématique
– le nombre d’opérations est proportionnel à n²
– par exemple pour n=6, on a 705 multiplications et 5652 additions
21
6.5.8 Forme récursive des équations du mouvement
• On note d’abord
@Ti @Tk k
= Ti
@qk @qk
i= k
n
X
= Jk TÄkT + Ak + 1 k+1
Ti Ji TÄiT
i= k + 1
Dk = Jk TÄkT + Ak +1 Dk + 1
Ck = mk p0kc + Ak +1 Ck + 1
22
6.5.8 Forme récursive des équations du mouvement
• En termes de ces deux nouvelles quantités, les forces généralisées peuvent s’écrire
© @Tk ª @Tk
Qk (t) = trace Dk ¡ gT Ck
@qk @qk
• Nombre d’opérations:
– si on procède de manière récursive directe pour les quantités cinématiques
– si on procède de manière récursive inverse pour les quantités dynamiques
– le nombre d ’opérations est d’ordre ‘n’
– pour n=6, on a 4388 multiplications et 3586 additions
– si on abandonnait la représentation homogène (4x4), on pourrait obtenir un gain de 50%
23