Fermer X

Contents

1 Orientation

On veut déplacer, à l’aide d’un système de levage par câble (grue ou pont roulant), une charge d’un endroit à un autre en évitant les oscillations résiduelles à l’arrivée.

L’objectif est de proposer une stratégie de commande simple et réaliste qui repose sur une structure de commande hiérarchisée, composée de régulateurs de bas niveau rapides, simples et découplés et d’une commande de haut niveau lente et prenant en compte les couplages.

En outre, on mesure la position et la vitesse du chariot ainsi que la position et la vitesse du treuil, mais la position de la charge n’est pas mesurée. C’est pourquoi nous ne considérons dans tout ce TP que des bouclages qui ne dépendent que des positions et vitesses du chariot et du treuil.

2 Modélisation

Un chariot de masse M roule sur l’axe OX, supposé représenter la flèche de la grue ou le pont s’il s’agit d’un pont roulant. Sa position est notée x. Un moteur exerce sur lui une force horizontale d’intensité F. Le chariot porte en outre un treuil de rayon ρ autour duquel s’enroule un câble assurant le levage de la charge située à son extrêmité. La position de la charge dans le repère XOZ est notée (ξ,ζ) et sa masse est égale à m. Le couple exercé sur le treuil par un second moteur est noté C. La longueur du câble, sa tension et l’angle par rapport à la verticale sont notés R, T et 𝜃 respectivement. On se place dans la configuration où R < R0 pour éviter que la charge ne traîne par terre, et on suppose que la tension du câble T est toujours positive. On adopte en outre la convention de signe pour 𝜃 : 𝜃 0 si ξ x et 𝜃 > 0 sinon.

Les équations du mouvement sont les suivantes :

m ¨ξ = − T sin 𝜃
m ¨ζ = T cos 𝜃 − mg
M x¨=  − γ (x˙) + F + T sin 𝜃
          1
J-¨R =  − γ2(R ˙) − C + T ρ
ρ
(1)

et les contraintes géométriques entre les coordonnées des deux corps sont données par :

ξ = x +  R sin 𝜃
ζ =  − R cos 𝜃.
(2)


PIC


Figure 1: Grue en dimension 2.

Pour les simulations, nous aurons besoin de la forme explicite de (1), donnée (voir le polycopié section 7.1) par

(   M                           )
   (---+ sin2𝜃 )    sin𝜃      0   (   ¨x )
||   m               J           ||     ¨
|(      sin𝜃      (-----+ 1 )  0 |) (  R  )
                  m ρ2                ¨𝜃
       cos𝜃           0 (    R                                )
                              ˙2                 1-        F-
                        |  (R 𝜃 + g cos𝜃) sin 𝜃 − m γ1(˙x) + m  |
                      = ||      ˙2           -1--   ˙    -C--  ||  .
                        (    R𝜃  + g cos𝜃 − m ρ γ2(R) − m ρ   )
                                     − 2R˙˙𝜃 − gsin𝜃
(3)

Posons

      -J---                       M--
J1 =  m ρ2,  J2 = J1 + 1,  M1  =  m ,
μ(𝜃) = J M   + J  sin2 𝜃,  α(R, 𝜃,𝜃˙) = R ˙𝜃2 + gcos 𝜃,
        2  1    1
et supposons que les frottements sont linéaires par rapport aux vitesses correspondantes :
γ1(˙x) = Γ 1˙x, γ2 (R ˙) = Γ 2R˙.
Après inversion de la matrice du membre de gauche de (3), on obtient :
         [                        (         )                ]
¨x = --1-- J α (R,𝜃, ˙𝜃)sin 𝜃 + sin𝜃- C  + Γ R˙  + J2-(F − Γ  ˙x)
    μ (𝜃) [ 1                 m ρ        2      m         1
      1                   (M1 +  sin2 𝜃)(         )
¨R =  ----- M1 α(R, 𝜃, ˙𝜃) −-------------  C + Γ 2R ˙
     μ(𝜃)                      m ρ                     ]
                                      − sin-𝜃-(F − Γ 1˙x)
            [                            m                      ]
¨     -cos𝜃-           ˙        sin-𝜃(        ˙)    J2-
𝜃 = − R μ(𝜃)  J1α(R, 𝜃,𝜃)sin𝜃 +  m ρ   C + Γ 2R  +  m (F −  Γ 1˙x)
                                        1 (             )
                                      − -- 2 ˙R𝜃˙+ g sin 𝜃  .
                                        R
(4)

Pour les simulations, on utilise les valeurs suivantes :

m  = 500 kg,   M  = 5000  kg,  g = 10 m  ⋅ s−2, J  = 50kg ⋅ m2,
ρ = 0.4 m,   Γ  =  20 kg ⋅ s−1, Γ  = 20 kg ⋅ m ⋅ s−1
               1                 2

Comme annoncé à la section précédente, on mesure les positions x et R ainsi que leurs vitesses et mais on ne mesure ni 𝜃 ni ˙𝜃. Les bouclages ne devront donc dépendre que de x, , R et .

Pour le problème de manutention qui nous intéresse, nous ne considèrerons que des déplacements arrêt-arrêt, c’est-à-dire partant du repos et arrivant au repos, avec des durées de transfert assez courtes. Pour cela, on dispose de moteurs suffisamment puissants, ce qui évite d’imposer des limitations sur la force et le couple que le moteur et le treuil sont capables de produire.

Par contre, les coefficients Γ1 et Γ2 sont très mal connus (les frottements sont des phénomènes difficiles à décrire quantitativement) et seront ignorés pour la mise au point de lois de commande. Par contre, ils sont pris en compte par le programme de simulation.

3 Suivi de ligne droite quasi-statique par commande hiérarchisée

On suppose dans un premier temps que l’angle 𝜃 varie suffisamment peu autour de 0, de même que la vitesse angulaire ˙𝜃, ce qui permet, d’après (2), de considérer que x ξ et z ≈−R.

On se propose alors de déplacer la charge en ligne droite depuis la position initiale ξi = xi, ζi = Ri à l’instant ti, avec 𝜃(ti) = ˙
𝜃(ti) = 0,  ˙
ξ (ti) = (ti) = 0, (ti) = ˙
ζ(ti) = 0, jusqu’à la position finale ξf = xf, ζf = Rf à l’instant tf, avec 𝜃(tf) = ˙𝜃(tf) = 0, ξ˙ (tf) = (tf) = 0, (tf) = ˙ζ(tf) = 0 (voir figure 2), avec des vitesses et suffisamment faibles (déplacement quasi-statique).



Figure 2: Déplacement de la charge en ligne droite

La trajectoire de référence de la charge est donnée par :

                       ( t )5
ξref(t) = xi + (xf − xi)  --   ⋅
         (          (   )T      (   )        (   )       (   ) )
                       t           t  2         t  3       t  4
        ⋅  126 − 420  --  +  540  --   − 315   --   + 70   --
                      T   (       T    )       T           T
                            ξref(t)-−-xi
ζref(t) = − Ri − (Rf −  Ri)    xf − xi    ,
(5)

celle du chariot par xref(t) = ξref(t) et celle de la longueur de câble par Rref(t) = ζref(t).

On peut choisir la durée T pour assurer que l’écart entre x et ξ et entre ζ et R soit suffisamment petit.

Dans tout ce qui suit, le déplacement est caractérisé par

Ri =  5m,   Rf =  3m,   xi = 0m,   xf = 15m.

On introduit en outre les deux bouclages suivants pour assurer le suivi de trajectoire : l’un sur F de façon à asservir la position x et la vitesse à leur consigne xref et ref, l’autre sur C de façon à asservir R et à leur consigne Rref et ref :

       M--
F =  − 𝜀x ((x˙− x˙ref) + K1 (x −  xref)) ,
            J-+ m ρ (                           )
C =  mg ρ + ρ------- (R˙− R˙ref ) + K3 (R − Rref)
              𝜀R
(6)

K1 et K3 sont des gains et 𝜀x et 𝜀R des constantes de temps, qu’il s’agit de régler pour assurer le suivi désiré.

Question 1 En exécutant le fichier Grue0.sci dans Scilab, étudier le comportement du système bouclé en faisant varier T entre 8 et 12 s et régler au mieux les gains et constantes de temps de (6). Que constatez-vous ?

4 Suivi de trajectoire de référence

À la place des approximations de la question précédente, on calcule la trajectoire de référence exacte de x et R, donnée par (voir cours)

                   ¨ξref-(t)ζref(t)-
xref(t) = ξref(t) −  ¨
          ┌  -------ζref(t)-+-g----------
          ││           ( ¨           )2
Rref (t) = ∘  ζ2 (t) +   ξref(t)ζref(t)-
              ref         ¨ζref(t) + g
(7)

avec ξref et ζref toujours donnés par (5).

Question 2 On pose la même question que précédemment avec les références (7) dans la commande (6) en exécutant le fichier Grue1.sci. Peut-on diminuer la durée T de déplacement au-dessous de 8 s tout en gardant des performances acceptables, avec les mêmes réglages des gains de (6) ? Expliquer.

5 Évitement d’obstacle

On veut maintenant éviter un obstacle situé vers le milieu de la trajectoire de la charge comme indiqué figure 3. Plus précisément, on veut que la charge passe par le point (ξf+ξi
  2, 2ζf ζi) qui doit être le maximum de la courbe suivie par la charge entre ξi et ξf.


PIC


Figure 3: Trajectoire polynômiale permettant d’éviter un obstacle.

On vérifie (voir cours) que la trajectoire polynômiale suivante :

                      (ξref(t) − ξi)
ζref(t) = ζi + (ζf − ζi) -----------  ⋅
           (        (    ξf − ξi)     (            )  )
                      ξref(t) −-ξi       ξref(t)-−-ξi  2
          ⋅  9 − 12     ξ − ξ      + 4    ξ  − ξ
                         f   i             f    i
(8)

avec ξref donné par (5), satisfait les conditions posées.

On recalcule alors les références de x et R en utilisant (7) et la commande (6).

Question 3 Reprendre la même étude que précédemment en exécutant le fichier Grue2.sci. Que constate-t-on si l’on cherche à diminuer T ? Expliquer.

L'École des Ponts ParisTech est membre fondateur de

L'École des Ponts ParisTech est certifiée 

ParisTech ParisEst ParisTech

 

Copyright 2014
École des Ponts ParisTech
All rights reserved