TP 04.2 Robot Ericc 3 - Stephane Genouel Free Fr
Transcription
TP 04.2 Robot Ericc 3 - Stephane Genouel Free Fr
TP 04.2 Robot Ericc 3 Page 1/7 TP 04.2 Robot Ericc 3 Pendant 25 min, lire le dossier technique sauf la partie 3) Utilisation du logiciel de pilotage et d’analyse. 1) Objectifs du TP et sommaire. Il est proposé dans ce TP de : - mettre en évidence l'asservissement, - visualiser l'influence des correcteurs sur la stabilité, la rapidité et la précision d’un système asservi perturbé par un couple résistant, - analyser et préciser l’origine des écarts entre le comportement mesuré et le comportement provenant d'un modèle. NB : Les parties théorique 2 (45 min) et expérimentale 3 (40 min) sont indépendantes et peuvent être effectuées dans n’importe quel ordre. 1) OBJECTIFS DU TP ET SOMMAIRE. .............................................................................................................. 1 2) ETUDE THEORIQUE. ...................................................................................................................................... 1 21) REALISATION DU SCHEMA FONCTIONNEL DE L'ASSERVISSEMENT DE POSITION DE L'AXE DU LACET. 1 22) SIMULATION DU SYSTEME A PARTIR DU LOGICIEL DID'ACSYDE ET ANALYSE DE L’INFLUENCE DES CORRECTEURS. ......................................................................................................................................................... 4 3) EXPERIMENTATION....................................................................................................................................... 5 31) DECOUVERTE DU PILOTAGE. ............................................................................................................................. 5 32) ANALYSE DE L’INFLUENCE DES CORRECTEURS A L'AIDE D’ESSAIS. ........................................................... 5 4) BILAN............................................................................................................................................................... 6 2) Etude théorique. 21) Réalisation du schéma fonctionnel de l'asservissement de position de l'axe du lacet. Le schéma synoptique de la chaîne fonctionnelle d'un axe du robot est présenté dans le dossier technique page 5. Le schéma-bloc de l'asservissement de position de l'axe du lacet est amorcé ci-dessous. Cr Θcm imp Θ ca ° K RC Transducteur + UCNA ε - 96 + + + - K p .2 −19 Ki Te.p Cm K CNA Ω sm rad / s Im Kv Km + CNA Θsa ° Mo teur Réducteur Variateur électronique K d.Te. Θsm rad 1 f + J.p - 96 .p 128 Correcteur Θsm imp Codeur MPSI-PCSI Sciences Industrielles pour l’Ingénieur S. Génouël 30/10/2009 TP 04.2 Robot Ericc 3 Page 2/7 Caractéristiques des constituants de la chaîne fonctionnelle « axe lacet ». Il traduit θca ° ( t ) en θcm imp ( t ) Transducteur avec : θca ° ( t ) : consigne de position de l'axe lacet en degré θcm imp ( t ) : image de la consigne de position de l'arbre du moteur en nombre d’impulsions Correcteur Proportionnel Intégral Dérivé (PID) avec : K p : coefficient proportionnel K i : coefficient intégral K d : coefficient dérivé Te : temps d'échantillonnage (qui vaut ici 3096 μs) Correcteur CNA : convertisseur numérique analogique 16 bits Variateur électronique Il convertit les impulsions en tension : la plage de ±32767 impulsions est donc convertie en une plage de ±10 V avec : uCNA ( t ) : tension en sortie du CNA en V Pour une plage de ±10 V, il commande le moteur en courant sur une plage de ±1,7 A (limitation du courant moteur réglée à 1,7 A) avec : i m ( t ) : courant moteur en A Piloté par une commande en courant, son fonctionnement est régi par les deux équations ci-dessous : c m ( t ) = K m .im ( t ) c m ( t ) − c r ( t ) − f .ωsm rad / s ( t ) = J. avec : Moteur dωsm rad / s ( t ) dt c m ( t ) : couple moteur en N.m c r ( t ) : couple résistant perturbateur en N.m im ( t ) : courant moteur en A ωsm rad / s ( t ) : vitesse de rotation de l’arbre du moteur en rad/s K m : constante de couple du moteur de lacet (0,043 N.m/A) J : inertie équivalente ramenée sur l'arbre moteur (2,09.10-5 kg.m2) f : coefficient de frottement visqueux (1,17.10-4 N.m.s) θsm ° ( t ) θsm rad ( t ) ωsm rad / s ( t ) 1000 = = = Il réduit la vitesse du moteur : 3 θsa ° ( t ) θsa rad ( t ) ωsa rad / s ( t ) avec : Réducteur θsm ° ( t ) : position de l’arbre du moteur en degré θsa ° ( t ) : position de l'axe lacet en degré θsm rad ( t ) : position de l’arbre du moteur en rad θsa rad ( t ) : position de l'axe lacet en rad ωsm rad / s ( t ) : vitesse de rotation de l’arbre du moteur en rad/s ωsa rad / s ( t ) : vitesse de rotation de l'axe lacet en rad/s Codeur Il traduit θsm rad ( t ) en θsm imp ( t ) en fournissant 2000 impulsions par tour de l'arbre du moteur auquel il est accouplé avec : θsm rad ( t ) : position de l’arbre du moteur en rad θsm imp ( t ) : position de l'arbre du moteur en nombre d’impulsions MPSI-PCSI Sciences Industrielles pour l’Ingénieur S. Génouël 30/10/2009 TP 04.2 Robot Ericc 3 Page 3/7 La relation entre la vitesse angulaire ω sm rad / s ( t ) et la position angulaire θ sm rad ( t ) du moteur, n'a pas été donnée dans le texte. Question 1 : Donner donc cette relation temporelle générale qui relie vitesse et position. En déduire la Θ sm rad (p) fonction de transfert Ω sm rad / s (p) . Question 2 : Déterminer la fonction de transfert du réducteur Question 3 : Déterminer la fonction de transfert du codeur Θ sa ° (p) Θ sm rad (p) Θ sm imp (p) Θ sm rad (p) . . Question 4 : Calculer le gain K RC du transducteur pour que ε soit l’image de l’erreur. Question 5 : Calculer le gain K CNA du convertisseur numérique analogique en Volt par impulsion. Question 6 : Calculer le gain K v du variateur électronique en Ampère par Volt. Le schéma bloc complet de l'asservissement de position de l'axe du lacet est donc : Θ ca ° Θcm imp 2000 1000 2π . . 2π 3 360 + UCNA ε - 96 + + + - K p .2 −19 Ki Transducteur 1,7 10 Cm 0,043 + Ω sm rad / s 1 - 1,17.10−4 + 2,09.10−5.p CNA 3096.10 −6.p K d .3096. 10− 6. 10 32767 Cr Im Θsm rad 1 p 3 360 . 1000 2π Moteur Réducteur Variateur électronique 96 .p 128 Correcteur Θsm imp 2000 2.π Codeur Nous allons donc maintenant le simuler sur Did'Acsyde. MPSI-PCSI Sciences Industrielles pour l’Ingénieur S. Génouël 30/10/2009 Θsa ° TP 04.2 Robot Ericc 3 Page 4/7 22) Simulation du système à partir du logiciel Did'Acsyde et analyse de l’influence des correcteurs. Effacer tous les fichiers et répertoires placés à l’intérieur du répertoire « mes documents élève » situé sur le bureau, à l’exception du répertoire « Digiview ». Le schéma-bloc de l'asservissement de position est fourni ci-dessous, ainsi que dans le fichier Did’Acsyde "lacet_ericc.sch" situé dans le répertoire SII Elève / TP SUP. Copier ce fichier dans le répertoire « mes documents élève », puis l'ouvrir. Pour cette partie : • la consigne de position θca ° ( t ) est fixée à 0,4°, • la perturbation c r ( t ) est fixée à 0,05 Nm, et est paramétrée pour apparaître au temps 0,5 s, • on effectuera la simulation sur une durée de 1 s. Cr oca tran k96 eps u e cpro DAC N(s) N(s) D(s) D(s) Var CNA N(s) Km im D(s) fjp c N(s) D(s) inte red int N(s) D(s) cint N(s) D(s) c d e r N(s) D(s) cod osm N(s) D(s) Vérifier que le schéma fourni correspond au schéma-bloc de la partie 21, au niveau de l'architecture et des valeurs numériques saisies. Dans les trois cas ci-dessous, visualiser les réponses temporelles à l’échelon de position, et compléter le tableau du document réponse : • Cas 1 : pour une correction proportionnelle seule ( K p = 10 6 ). • Cas 2 : pour une correction proportionnelle et dérivée ( K p = 10 6 et K d = 600 ). • Cas 3 : pour une correction proportionnelle, intégrale et dérivée ( K p = 10 6 , K i = 2.10 5 et K d = 600 ). NB1 : Ne pas imprimer les courbes NB2 : Les valeurs choisies de K p ( 10 6 ), K d ( 600 ) et K i ( 2.10 5 ) sont les valeurs de réglage par défaut du correcteur PID de l’axe lacet… Question 7 : Indiquer quel a été l’effet du correcteur dérivé, et l’effet du correcteur intégral vis à vis des performances de stabilité, rapidité et précision sous l’effet d’une perturbation. MPSI-PCSI Sciences Industrielles pour l’Ingénieur S. Génouël 30/10/2009 osa TP 04.2 Robot Ericc 3 Page 5/7 3) Expérimentation. 31) Découverte du pilotage. Lire la partie 3 « utilisation du logiciel de pilotage et d’analyse » du dossier technique, tout en réalisant quelques essais. 32) Analyse de l’influence des correcteurs à l'aide d’essais. Vous allez commander plusieurs échelons de position sur l’axe de lacet (avec différents correcteurs), et observer l'influence de ces correcteurs sur la stabilité, la rapidité et la précision. Sur le système, une perturbation de couple provenant des frottements dans la chaîne cinématique existe en permanence ; néanmoins, pour mieux visualiser les effets, on exercera une légère pression manuelle sur le bras du robot pendant son mouvement (voir la photo), pour le 2ème essai de chaque cas cidessous. Cas 1 : correction proportionnelle seule ( K p = 10 6 , K i = 0 et K d = 0 ). Placer le robot dans sa posture initiale (menu : Robot / Déplacement manuel) : θ1 = 0° (lacet), θ 2 = 0° (épaule), θ 3 = −90° (coude), θ 4 = 0° (poignet) qui est la posture de détermination de Jéquivalent. (Attention : pour placer l'axe du lacet en position initiale, il faut penser à appliquer les valeurs par défauts du correcteur PID dans le menu : Robot / Paramétrage du correcteur). Régler le correcteur avec les valeurs du cas 1 ci-dessus (menu : Robot / Paramétrage du correcteur). Lancer un 1er échelon de position (1er essai) en boucle fermée sur l’axe de lacet : Amplitude de 0,4° Durée 500 ms Lancer un 2ème échelon de position (2ème essai) en boucle fermée sur l’axe de lacet, mais cette fois-ci en exerçant une légère pression manuelle sur le bras du robot pendant son mouvement (voir photo ci-dessus). Visualiser les réponses temporelles à l’échelon de position des 2 essais, et compléter le tableau du document réponse. NB : - Ne pas imprimer les courbes. - Il est recommandé de réaliser plusieurs fois le même essai, pour éviter tous les essais erronés. Reprendre la même démarche pour les 2 cas ci-dessous. Cas 2 : correction proportionnelle et dérivée ( K p = 10 6 et K d = 600 ). Cas 3 : correction proportionnelle, intégrale et dérivée ( K p = 10 6 , K i = 2.10 5 et K d = 600 ). Question 8 : Indiquer quel a été l’effet du correcteur dérivé, et l’effet du correcteur intégral vis à vis des performances de stabilité, rapidité et précision sous l’effet d’une perturbation. MPSI-PCSI Sciences Industrielles pour l’Ingénieur S. Génouël 30/10/2009 TP 04.2 Robot Ericc 3 Page 6/7 4) Bilan. Question 9 : Comparer les résultats de l’expérimentation avec ceux de la simulation effectuée dans la partie 2. Avant de quitter le poste, remettre le robot en position initiale, en cliquant sur Robot / Position repos. AVANT DE PARTIR, RANGER LE POSTE MPSI-PCSI Sciences Industrielles pour l’Ingénieur S. Génouël 30/10/2009 TP 04.2 Robot Ericc 3 (DOCUMENT REPONSE) Page 7/7 Valeurs théoriques. Correcteur Stabilité Kp Ki Kd 106 0 0 106 0 600 106 2.105 600 Nb de dépassements (pour Cr = 0) Valeur du 1er dépassement D1% (pour Cr = 0) Rapidité tr5% en ms (pour Cr = 0) Précision Er en ° (pour Cr = 0) Er en ° (pour Cr ≠ 0) (voir cours page 20 pour la définition du dépassement) Valeurs expérimentales. Correcteur Stabilité Kp Ki Kd 106 0 0 106 0 600 106 2.105 600 Nombre de dépassements (pour Cr = 0) Valeur du 1er dépassement D1% (pour Cr = 0) Rapidité tr5% en ms (pour Cr = 0) Précision Er en ° (pour Cr = 0) Er en ° (pour Cr ≠ 0) (voir cours page 20 pour la définition du dépassement) MPSI-PCSI Sciences Industrielles pour l’Ingénieur S. Génouël 30/10/2009