Table des matières
La Bras de pelleteuse électrique autonome est un produit inspiré des nouvelles générations de pelleteuses compactes électriques que les constructeurs commencent à développer afin de diminuer leur impact environnemental.
Certains constructeurs travaillent également à rendre leurs machines autonomes.
Le support de TP Bras de pelleteuse électrique autonome regroupe ces deux technologies et permet de réaliser des activités de travaux pratiques sur la quasi totalité du nouveau programme CPGE mis en place à la rentrée 2021.
Cette documentation est mise à jour dès qu'une erreur est rapportée. Pensez à vérifier que vous disposez de la dernière mise à jour.
Interface Homme-Machine ↵
Architecture générale
Le diagramme des échanges entre le bras de pelleteuse et l’ordinateur est représenté ci-dessous :
Les tableaux de bord livrés avec le système permettent non seulement de piloter le bras de pelleteuse réel, mais également un jumeau numérique de ce dernier.
Ce jumeau numérique n’est pas un modèle schéma-bloc simplifié mais un simulateur très complet réalisé avec MapleSim, logiciel de modélisation physique multi-domaine. Il intègre les sous-ensembles suivants :
- partie mécanique (importée à partir du modèle volumique SolidWorks) incluant le calcul des forces sur chaque vérin;
- vérins électriques;
- boucles d’asservissement en vitesse et position;
- logiques de commutation entre les différentes phases (initialisation / fonctionnement normal) et les différents types de pilotage (vitesses angulaires / vitesse des vérins / positions angulaires / longueurs des vérins);
- cinématique inverse;
- calcul de trajectoire cartésienne.
Ce modèle est mis en œuvre de la façon suivante :
- le modèle physique multi-domaine réalisé dans MapleSim est généré sous forme d’un composant de cosimulation de type FMU (code C compilé suivant le format standard « Functional Mockup Interface » en version 2.0);
- ce composant est exécuté en temps-réel par le programme Python de gestion du bras de pelleteuse, grâce à la bibliothèque FMPy;
- les positions angulaires calculées par ce simulateur sont utilisées pour animer rendu 3D openGL du bras grâce à la bibliothèque Pyrender.
Enfin, les tableaux de bord de pilotage de ce jumeau numérique permettent de modifier les paramètres suivants :
- paramètres classiques des moteurs électriques des vérins (inertie, constante de couple, résistance, frottement visqueux et frottements secs)
- charge sur le godet : elle correspond à un glisseur sur le godet au point \(K\) de résultante égale à \(-m\,g\,\vec{y}\).
Ceci illustre très bien l’intérêt d’un jumeau numérique, qui se situe entre le système réel et le schéma-bloc simplifié :
- il n’est pas possible de modifier les caractéristiques des moteurs sur le système réel. On peut bien sûr charger le godet sur ce dernier, mais le dépassement des capacités limites de la pelleteuse pourrait détériorer celle-ci;
- on peut modifier les caractéristiques d’un moteur sur un schéma-bloc simplifié d’un seul vérin, mais on ne peut pas voir l’influence sur le système complet lorsqu’il est piloté en cartésien, par exemple;
- le jumeau numérique permet quant à lui :
- d’avoir une très bonne idée de l’influence de certains paramètres sur le système complet;
- de modifier des paramètres sans risque, ni pour le matériel, ni pour les opérateurs.
Mise en œuvre
La procédure à suivre est simple :
- Brancher le câble d’alimentation du bras de pelleteuse.
- Connecter le câble USB entre l’ordinateur et le système.
- Brancher le joystick sur l’ordinateur.
- Basculer l’interrupteur d’alimentation du bras de pelleteuse. Le voyant rouge de cet interrupteur s’allume alors.
- Appuyer sur le bouton poussoir jaune. Deux LEDs rouge et verte s’allument presque instantanément, indiquant la présence du 24 V et du 5 V sur la carte de pilotage.
- Lancer MyViz et ouvrir le tableau de bord Pelleteuse_Maintenance.json.
- Sélectionner le port série utilisé par l’ordinateur via le menu Paramètres → Port série par défaut :
- Cliquer sur le bouton Marche / arrêt en haut à gauche pour démarrer l’application
- Le message Attente de démarrage s’affiche alors. Puis après quelques instants, le bouton d’initialisation devient actif :
- Cliquer sur Démarrer pour lancer l'initialisation et attendre jusqu’à son terme :
- L’interrupteur d’activation des consignes devient actif :
- Cliquer dessus. Le bras de pelleteuse est maintenant pilotable avec le joystick.
Arrêt d'urgence
En cas d’appui sur le bouton d’arrêt d’urgence puis de réarmement de ce dernier, il faut de nouveau appuyer sur le bouton poussoir jaune pour remettre sous tension la carte électronique.
Mise hors-tension
Pour éteindre le système, il suffit de basculer sur 0 l’interrupteur d’alimentation général.
Tableaux de bord
L'application MyViz fonctionne en tableaux de bord associés à une activité pédagogique permettant ainsi de n'afficher que les informations utiles sans surcharger l'environnement.
Note
Mêmes si les informations affichées sont limitées, toutes les grandeurs mesurables restent accessibles via le bouton "Tracer".
Maintenance
Objectif
Ce tableau de bord permet de piloter le bras de pelleteuse avec le joystick et de visualiser les valeurs des différents signaux mesurés par le système.
Ouvrir dans MyViz le fichier Pelleteuse_Maintenance.json
Ci-dessous, une capture d'écran du tableau de bord MyViz.
Warning
Ce tableau de bord ne permet pas de faire des expériences pédagogiques mais de vérifier que toutes les entrées / sorties sont correctement lues et pilotées.
Calibration
Objectif
Ce tableau de bord permet de calibrer les capteurs d'effort situé sur chaque tige de vérin après un déplacement du banc de TP.
Ouvrir dans MyViz le fichier Pelleteuse_MaintenanceCalibration.json
Quand calibrer les capteurs ?
Il est conseillé d'effectuer la procédure de calibration dans les cas suivants
- après chaque déplacement du banc d'essai
- si les valeurs des capteurs d'effort semblent incohérentes
Prise en main - Pilotage par joystick
Objectif
Ce tableau de bord permet de prendre en main le pilotage de la pelleteuse par joystick et de visualiser les angles et efforts associés.
Ouvrir dans MyViz le fichier Pelleteuse_PriseEnMain.json
Ci-dessous, une capture d'écran du tableau de bord MyViz.
Il est possible de régler la vitesse des vérins entre 0 et 10 mm/s, la valeur par défaut étant de 5 mm/s.
La fenêtre de visualisation reprend l'historique des positions et orientations mesurées des extrémités du balancier (point \(O_2\)), de la flèche (point \(O_3\)) et du godet (point \(L\)) sous forme de points. Il est possible d'effacer cet historique via le bouton Effacer les points.
Asservissements
Objectif
Ce tableau de bord permet de spécifier différents types de consignes pour un sous-ensemble donné (flèche, balancier ou godet) et de voir sur les tracés graphiques l’influence de la modification des réglages des asservissements.
Ouvrir dans MyViz le fichier Pelleteuse_Asservissement.json.
Voici une capture d’écran du tableau de bord MyViz :
Réglage du correcteur
Le choix du type de correcteur fait en imposant les gains \(K_p\), \(K_i\) et \(K_d\) correspond à la fonction de transfert du correcteur : \(C(p)=K_p\left(1+\dfrac{K_i}{p}+K_d \,p\right)\). Ces réglages se font dans le cadre Réglages.
Saturation en vitesse
La boucle de vitesse présente une saturation dont la valeur peut être modifiée dans le cadre Réglages.
Choix de l'axe piloté
Dans ce tableau de bord, seul un seul axe peut-être piloté.
Le choix de l'axe se fait dans le cadre Choix de l'actionneur.
Le bouton Activation des consignes permet de lancer une mesure.
La durée de l'acquisition peut être modifiée (10 s par défaut). Il est nécessaire de desactiver les consignes pour pouvoir exploiter les résultats via les boutons Enregistrer et Tracer du cadre Contrôle de l'application.
Consignes
Plusieurs type de consignes sont proposées avec chacune leur paramètres de réglages
- rectangle : correspond à une consigne en échelon
- sinus
- trapèze
- triangle
- rampe
Dynamique
Objectif
Ce tableau de bord permet de visualier les efforts dans les vérins au cours d'un mouvement imposé.
Ce tableau de bord est très similaire au précédent (asservissements), avec les différences suivantes :
- Les asservissements ne sont plus réglables
- Les tracés graphiques permettent de visualiser les forces sur chaque sous-ensemble
Ouvrir dans MyViz le fichier Pelleteuse_Dynamique.json
Voici une capture d’écran du tableau de bord MyViz :
Statique
Objectif
Ce tableau de bord permet de positionner le bras de pelleteuse dans la posture angulaire spécifiée avec une vitesse de déplacement potentiellement très lente et de relever les forces correspondantes.
Ouvrir dans MyViz le fichier Pelleteuse_Statique.json
Voici une capture d’écran du tableau de bord MyViz :
Géométrique
Objectif
Ce tableau de bord permet de travailler sur la correspondance entre la longueur du vérin et la position angulaire d'un sous-ensemble donné (flèche, balancier ou godet).
Ouvrir dans MyViz le fichier Pelleteuse_Geometrique.json.
Voici une capture d’écran du tableau de bord MyViz :
Une fois l'axe choisi, l'activation de l'excursion angulaire aller-retour va déplacer l'axe sur toute la plage angualire dans un sens puis dans l'autre.
Cinématique
Objectif
Ce tableau de bord permet de travailler sur la correspondance entre la vitesse de la tige du vérin et la vitesse angulaire d'un sous-ensemble donné (flèche, balancier ou godet).
Ouvrir dans MyViz le fichier Pelleteuse_Cinematique.json.
Voici une capture d’écran du tableau de bord MyViz :
Énergétique Puissance
Objectif
Ce tableau de bord permet de positionner le godet en coordonnées cartésiennes et de relever les différentes puissances et énergies mises en œuvre pour réaliser le mouvement.
Deux types trajectoires sont possibles :
- Rectiligne : le godet va de sa position courante à sa position cible en suivant une trajectoire complètement rectiligne ou bien en suivant deux morceaux de trajectoires rectilignes passant par un sommet dont la hauteur est réglable par un curseur
- Non rectiligne : les axes ne sont plus synchronisés. Chaque vérin cherche à atteindre sa position cible le plus rapidement possible.
Ouvrir dans MyViz le fichier Pelleteuse_EnergetiquePuissance.json.
Voici une capture d’écran du tableau de bord MyViz.
API Python
Objectif
Piloter la pelleteuse (réelle ou virtuelle) à partir d'un programme python utilisant des fonctions de haut niveau.
Ouvrir dans MyViz le tableau de bord Pelleteuse_Python.json
Ci-dessous une capture d'écran du tableau de bord
IA Apprentissage par renforcement
Objectif
Réaliser un apprentissage par renforcement permettant de déterminer la meilleure trajectoire (d'un point de vue énergétique) pour aller d'un point de départ à un point d'arrivée.
Ouvrir dans MyViz le fichier Pelleteuse_ApprentissageRenforcement.json.
Voici une capture d’écran du tableau de bord MyViz.
Description de la méthode
Les listes des variables est décrite dans la partie IA Apprentissage par renforcement.
Durant les calculs, le chemin en cours est représenté par des flèches oranges.
Les flèches vertes qui apparaissent dans les cases correspondent à la meilleure action à prendre lorsque l'agent se trouve dans cet état. Au cours des itérations, avec l'actualisation des valeurs de la matrice \(Q\), la direction des flèches peut évoluer.
Les flèches violettes représentent la meilleure trajectoire (d'un point de vue énergétique) trouvée depuis le début du calcul. Suivant les paramètres définis et l'itération en cours, cette trajectoire n'est pas forcément la meilleure et peux donc encore évoluer à la suite du calcul.
Fonctions Python
Pelleteuse_API()
Description
Elle lance en particulier en tâche de fond le client Websocket destiné à envoyer les ordres de pilotage au système.
Exemple
1 2 3 4 |
|
Cette fonction doit impérativement être éxéctuée au début de chaque programme.
Initialiser()
Description
Cette fonction lance la prise d’origine du bras de pelleteuse.
Exemple
1 2 3 4 5 6 7 8 9 10 |
|
Cette fonction doit impérativement être exécutée au début de chaque programme.
Terminer()
Description
Cette fonction permet l’arrêt du programme de manière propre.
Exemple
1 2 3 4 5 6 7 8 9 |
|
Cette fonction doit impérativement être exécutée à la fin de chaque programme.
PID_position(Kp, Ki, Kd, vmax)
Paramètres
Kp
: réel. Gain proportionnel du PID d’asservissement en position, saturé en interne entre 0,1 et 9,9.Ki
: réel. Gain intégral du PID d’asservissement en position, saturé en interne entre 0 et 40.Kd
: réel. Gain dérivé du PID d’asservissement en position, saturé en interne entre 0 et 0.1.vmax
: réel. Vitesse maximale de consigne de la boucle de vitesse, saturée en interne entre 0 et 10 mm/s.
Description
Cette fonction permet de changer les gains et la vitesse de saturation du PID d’asservissement en position.
Verin(sous-ensemble, mode, consigne, duree)
Paramètres
sous-ensemble
- type : chaîne de caractères
- valeurs :
fleche
,balancier
ougodet
mode
- type : chaîne de caractères
- valeurs :
position
ouvitesse
consigne
:- type : réel ou chaîne de caractères
- valeurs : expression Python valide du type
0.5 * sin(t)
,t
étant reconnu comme le temps courant, uniquement en mode « vitesse »). Consigne de position (en mm) ou de vitesse (en mm/s)
duree
: réel. Durée de la manœuvre en secondes.
Description
Cette fonction donne une consigne de position ou de vitesse au vérin du sous-ensemble sélectionné pendant une certaine durée.
Angle(sous-ensemble, consigne, duree)
Paramètres
sous-ensemble
- type : chaîne de caractères
- valeurs :
fleche
,balancier
ougodet
consigne
: réel. Consigne de position angulaire (en deg)duree
: réel. Durée de la manœuvre en secondes.
Description
Cette fonction donne une consigne de position angulaire au sous-ensemble sélectionné pendant une certaine durée.
Bras(angle_fleche, angle_balancier, angle_godet)
Paramètres
angle_fleche
: réel. Consigne de position angulaire de la flèche (en deg)angle_balancier
: réel. Consigne de position angulaire du balancier (en deg)angle_godet
: réel. Consigne de position angulaire du godet (en deg)
Description
Cette fonction donne une posture globale au bras de pelleteuse. Le positionnement se fait d’une manière douce, sur une durée calculée automatiquement
Godet(mode)
Paramètres
mode
: chaîne de caractères (libre
oufixe
)
Description
Cette fonction définit le mode de fonctionnement du godet lorsque ce dernier est piloté par la fonction GodetXY (voir plus loin) :
libre
: le godet conserve son orientation par rapport au bâtifixe
: le godet conserve son orientation par rapport au balancier
GodetXY(xcons, ycons, gammacons, rectiligne = 1, hauteur = 0)
Paramètres
xcons
: réel. Consigne de position cartésienne horizontale du pivot du godet (en mm)ycons
: réel. Consigne de position cartésienne verticale du pivot du godet (en mm)gammacons
: réel. Consigne de position angulaire du godet (en deg)rectiligne
: entier (optionnel). 1 mode rectiligne (valeur par défaut), 0 : mode non synchronisé (voir tableau de bord Énergétique - Puissance).hauteur
: entier (optionnel). Hauteur max de la trajectoire (en mode rectiligne uniquement, voir tableau de bord Énergétique - Puissance). Valeur par défaut : 0
Description
Cette fonction positionne le godet en coordonnées cartésiennes, sur une durée calculée automatiquement.
Charger()
Description
Positionne le godet à l’horizontale (dans la limite de ce qui est mécaniquement possible).
Exemple
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 |
|
Decharger()
Description
Rentre le vérin du godet au maximum.
Niveler(mode, cons_mini, cons_maxi)
Paramètres
mode
: chaîne de caractères (horizontal
ouvertical
)cons_mini
: réel. Point de départ (en mm)cons_maxi
: réel. Point d’arrivée (en mm)
Description
Cette fonction permet de réaliser une opération de nivelage suivant le mode :
horizontal
: le godet se met alors en position verticale et le bras se déplace entre xmin=cons_mini et xmax=cons_maxi suivant un mouvement horizontal (c’est la partie « coupante » du godet qui réalise le nivelage, pour un fond de tranchée par exemple)vertical
: le godet se met alors en position horizontale partie coupante vers la droite (vérin complètement rentré) et le bras se déplace entre ymin=cons_mini et ymax=cons_maxi suivant un mouvement vertical, pour une paroi de tranchée par exemple
LireVariable(variable)
Paramètres
- variable : chaîne de caractères. Nom de la variable à lire
Description
Cette fonction retourne la valeur de la variable spécifiée
Liste des variables
theta1cons
: consigne d'angle flèche (deg)theta2cons
: consigne d'angle balancier (deg)theta3cons
: consigne d'angle godet (deg)theta1
: angle flèche (deg)theta2
: angle balancier (deg)theta3
: angle godet (deg)theta5
: angle 4 barres (deg)w1
: vitesse angulaire flèche (deg/s)w2
: vitesse angulaire balancier (deg/s)w3
: vitesse angulaire godet (deg/s)w5
: vitesse angulaire 4 barres (deg/s)xc
: consigne cartésienne en x (mm)yc
: consigne cartésienne en y (mm)gammac
: consigne cartésienne d'angle godet (deg)x
: position cartésienne calculée en x (mm)y
: position cartésienne calculée en y (mm)gamma
: position cartésienne calculée d'angle godet (deg)v1cons
: consigne de vitesse vérin de flèche (mm/s)v2cons
: consigne de vitesse vérin de balancier (mm/s)v3cons
: consigne de vitesse vérin de godet (mm/s)v1
: vitesse vérin de flèche (mm/s)v2
: vitesse vérin de balancier (mm/s)v3
: vitesse vérin de godet (mm/s)L1cons
: consigne de position vérin de flèche (mm)L2cons
: consigne de position vérin de balancier (mm)L3cons
: consigne de position vérin de godet (mm)L1
: position vérin de flèche (mm)L2
: position vérin de balancier (mm)L3
: position vérin de godet (mm)F1
: force vérin de flèche (N)F2
: force vérin de balancier (N)F3
: force vérin de godet (N)i1
: courant vérin de flèche (A)i2
: courant vérin de balancier (A)i3
: courant vérin de godet (A)u1
: tension de commande vérin de flèche (V)u2
: tension de commande vérin de balancier (V)u3
: tension de commande vérin de godet (V)P1
: puissance électrique vérin de flèche (W)P2
: puissance électrique vérin de balancier (W)P3
: puissance électrique vérin de godet (W)E1
: énergie vérin de flèche (J)E2
: énergie vérin de balancier (J)E3
: énergie vérin de godet (J)PM1
: puissance mécanique vérin de flèche (W)PM2
: puissance mécanique vérin de balancier (W)PM3
: puissance mécanique vérin de godet (W)thetaM1
: angle moteur vérin de flèche (rad)thetaM2
: angle moteur vérin de balancier (rad)thetaM3
: angle moteur vérin de godet (rad)wM1
: vitesse moteur vérin de flèche (rad/s)wM2
: vitesse moteur vérin de balancier (rad/s)wM3
: vitesse moteur vérin de godet (rad/s)
Mise à jour du logiciel MyViz
- Télécharger la dernière version de MyViz en cliquant ici.
- Si une version antérieure de MyViz existe déjà sur votre ordinateur, ne pas la supprimer (pour l’instant).
- Décompresser le .zip le plus haut possible dans l’arborescence de fichiers, idéalement à la racine (C:).
- Copier les fichiers de licence (.lic) situés dans le répertoire principal de l’ancienne version pour les placer au même endroit (répertoire principal) de la nouvelle version.
- L’ancienne version de MyViz peut alors être éventuellement supprimée (mais ce n’est pas indispensable de le faire).
Mise à jour du firmware du bras de pelleteuse
Version 0.12.9 minimum de MyViz
La procédure de mise à jour du firmware du bras de pelleteuse est disponible à partir de la version 0.12.9 de MyViz. Pour mettre à jour MyViz, suivez la procédure de mise à jour de MyViz.
- Connecter l’ordinateur au bras de pelleteuse et mettez le système sous tension.
- Lancer la nouvelle version de MyViz en double-cliquant sur l’exécutable MyViz_S2IDIDAC.
- Sélectionner le port COM de l’ordinateur sur lequel est connecté le système dans le menu « Paramètres \(\to\) Port série par défaut ».
- Sélectionner le menu « Outils \(\to\) Mises à jour de systèmes \(\to\) Bras de pelleteuse \(\to\) Téléverser le firmware du bras de pelleteuse ».
- Un message indiquant l’évolution de la mise à jour apparaît assez furtivement (téléversement de la nouvelle version du firmware très rapide) :
- Un nouveau message apparaît alors lorsque la mise à jour a réussi :
- Si un message d’erreur tel que celui-ci apparaît, vérifier que le port COM sélectionné plus haut correspond bien à celui du bras de pelleteuse :
Ended: Interface Homme-Machine
Modèles ↵
Modélisation structurelle
Diagramme de contexte
Diagramme de cas d'utilisation
Diagramme de définition des blocs
Bras de la pelleteuse
Vérin électrique
Diagramme de blocs internes
Bras de la pelleteuse
Vérin électrique
Modèlisation géométrique ↵
Modélisation plane
Schéma cinématique
La pelleteuse, schématisée figure ci-dessous, est principalement constituée de six solides et de trois vérins qui actionnent respectivement la flèche 1, le balancier 2 et le godet 3 via le triangle 5 et la bielle 4.
Pour les activités de travaux pratique, il est souvent proposé une décomposition en sous-systèmes (SE) du bras :
- SE Bâti ;
- SE Flèche : vérin de flèche (corps et tige), flèche ;
- SE Balancier : vérin de pénétration (corps + tige), balancier ;
- SE Godet : vérin de cavage (corps + tige), triangle de renvoi, bielle, godet.
Paramétrage global
Paramétrage pièces
- Le repère \(\left(0_1,\vec x_0, \vec y_0, \vec z_0\right)\) est lié au socle 0.
- Le repère \(\left(0_1,\vec x_1, \vec y_1, \vec z_1\right)\) est lié à la flèche 1.
- Le repère \(\left(0_1,\vec x_2, \vec y_2, \vec z_2\right)\) est lié au balancier 2.
- Le repère \(\left(0_1,\vec x_3, \vec y_3, \vec z_3\right)\) est lié au godet 3.
La position des centres des liaisons dans les repères liés aux solides est définie par son vecteur position :
- \(\overrightarrow{0_10_2}=L_1\vec x_1\)
- \(\overrightarrow{0_20_3}=L_2\vec x_2\)
- \(\overrightarrow{0_3K}=L_3\vec x_3\)
Paramétrage liaisons
Les trois liaisons pivot montées en série sont définies par les coordonnées dites articulaires de la pelleteuse robot :
- \(\gamma_1=\left(\vec x_0, \vec x_1\right)=\left(\vec y_0, \vec y_1\right)\)
- \(\gamma_2=\left(\vec x_1, \vec x_2\right)=\left(\vec y_1, \vec y_2\right)\)
- \(\gamma_3=\left(\vec x_2, \vec x_3\right)=\left(\vec y_2, \vec y_3\right)\)
Hypothèse générales
La pelleteuse évolue dans le plan \(\left(O_0,\vec x_0,\vec y_0\right)\) et en conséquence tous les repères orthonormés directs utilisés sont tels que \(\vec z_0=\vec z_1=\vec z_2=\vec z_3\).
Toutes les liaisons sont géométriquement parfaites et sans frottement.
Modèle géométrique direct
Info
Le modèle géométrique direct (MGD) décrit la position que prend le segment terminal de la structure (effecteur) lorsque la valeur des variables articulaires est connue, c'est-à-dire pour une configuration donnée de la structure.
Ce modèle est constitué de l’expression des coordonnées du repère lié au segment terminal dans le repère lié au solide de référence exprimé en fonction des coordonnées articulaires.
La situation de l’effecteur, ici le godet 3, est définie :
- par la positon du point \(K\), \(\overrightarrow{O_1K}=x\vec x_0+y\vec y_0\);
- et par l’orientation du godet 3 dans le repère lié au socle 0, \(\gamma=\left(\vec x_0, \vec x_3\right)=\left(\vec y_0, \vec y_3\right)\).
MGD
Modèle géométrique inverse
Info
Si nous désirons piloter la pelleteuse il faut définir le modèle géométrique inverse (MGI). On connaît la position et l’orientation que doit atteindre l’effecteur par rapport au solide de référence. Pour commander l’effecteur il faut connaître la valeur des coordonnées articulaires pour atteindre cette situation c'est-à-dire trouver l’expression des coordonnées articulaires en fonction de la position et de l’orientation de l’organe terminal.
Le MGI consiste à calculer les coordonnées articulaires, \(\left(\gamma_1,\gamma_2,\gamma_3\right)\), correspondant à une situation donnée du godet 3, \(\left(x, y, \gamma\right)\). Lorsqu’elle existe la forme explicite qui donne toutes les solutions possibles (il y a rarement unicité de solution) constitue le MGI.
D'après le MGD, posons \(A\) et \(B\) connus tels que :
MGI
Cas du porteur seul
On considère le porteur seul constitué de la flèche 1 et du balancier 2 si le godet 3 est piloté indépendamment.
Soit la position du point \(O_3\) dans le repère lié au socle 0 : \(\overrightarrow{O_1O_3}=x_3\vec x_0+y_3\vec y_0\).
MGD
Le MGD du bras complet se simplifie en :
MGI
Le MGI du bras complet devient
Deux solutions
La figure ci-dessous montre que le problème possède deux solutions correspondant à deux postures différentes du bras 2 (sous réserve qu'il n'y ait pas de butées sur les articulations).
La position du point \(O_3\) dans le repère lié au socle 0 peut être atteinte avec le couple d'angles \(\left(\gamma_1,\gamma_2\right)\) ou le couple \(\left(\gamma_1^{*},\gamma_2^{*}=-\gamma_2\right)\)
Remarques
- L’angle \(\gamma_2\) peut aussi être trouvé en appliquant le théorème de Pythagore généralisé
- Connaissant \(\gamma_2\), le système d’équations à deux inconnues \(\sin\gamma_2\) et \(\cos\gamma_1\) peut être résolu en utilisant la méthode de Cramer via le déterminant du système.
Génération de mouvement point à point avec une trajectoire imposée
Équation d'une trajectoire du point \(O_3\)
Considérons le cas simple d'un déplacement du point \(O_3\) suivant le segment \(\left[O_{3i}O_{3f}\right]\) illustré sur la figure ci-dessous.
L'équation de la trajectoire rectiligne \(y_3=a\,x_3+b\) est définie par
- la pente \(a\) de la droite : \(a=\dfrac{y_{3f}-y_{3i}}{x_{3f}-x_{3i}}\)
- l'ordonnée à l'origine : \(b=\dfrac{x_{3f}\, y_{3i}-x_{3i}\, y_{3f}}{x_{3f}-x_{3i}}\)
Application numérique
Applications numériques :
Paramètres | Valeurs (mm) |
---|---|
\(L_1\) | 520 |
\(L_2\) | 300 |
\(x_{3i}\) | 530 |
\(y_{3i}\) | 490 |
\(x_{3f}\) | 715 |
\(y_{3f}\) | 10 |
La durée de déplacement est arbitrairement de 4,6 s.
Les expressions de \(\gamma_1\) et \(\gamma_2\) du MGI permettent d’obtenir les courbes ci-dessous. L’angle \(\gamma_3\) est géré indépendamment des deux autres.
Tous les calculs dans l'onglet "angles"
Les figures suivantes donnent le résultat dans Solidworks.
Loi E/S ↵
Loi E/S Flèche
Schéma cinématique
Paramétrage
\(\overrightarrow{AO_1}=c\,\overrightarrow{x_0}, \quad \overrightarrow{AB}=l_1\,\overrightarrow{x_{v1}}, \quad \overrightarrow{O_1B}=\lambda_1\,\overrightarrow{x'_1}\)
Fermeture géométrique
Modèle géométrique
Info
\(\beta_1\) est un paramètre géométrique de la flèche voir géométrie des pièces.
Résultats de simulation
Le vérin de flèche a une course de \(\Delta\lambda_1=80\) mm et \(233\textrm{ mm}\le l_1\le 313\textrm{ mm}\).
La figure ci-dessous présente les résultats de simulation du modèle géométrique et des mesures réalisées sur le bras de pelleteuse.
Loi E/S balancier
Schéma cinématique
Paramétrage
\(\overrightarrow{DO_2}=\lambda_1'\,\overrightarrow{x''_1}, \quad \overrightarrow{DF}=l_2\,\overrightarrow{x_{v2}}, \quad \overrightarrow{O_2F}=\delta\,\overrightarrow{x'_2}\)
Fermeture géométrique
Modèle géométrique
Definition de \(\beta_2\)
Dans la paramétrage des pièces, l'angle \(\beta_2\) est défini par \(\beta_2=\left(\vec y_2,\vec x_2'\right)\).
Ici, dans le modèle proposé, on a pris \(\beta_2=\left(\vec x_2,\vec x_2'\right)\). Pour les calculs, il conviendra d'ajouter 90° à la valeur de \(\beta_2\) donnée.
Info
- \(\beta'_1\) est un paramètre géométrique de la flèche voir géométrie des pièces.
- \(\beta_2\) est un paramètre géométrique du balancier voir géométrie des pièces.
Résultats de simulation
Le vérin de pénétration a une course de \(\Delta\lambda_2=42\) mm et \(233\textrm{ mm}\le l_2\le 275\textrm{ mm}\).
La figure ci-dessous présente les résultats de simulation du modèle géométrique et des mesures réalisées sur le bras de pelleteuse.
Loi E/S triangle
Schéma cinématique
Paramétrage
\(\overrightarrow{GH}=\lambda_2\,\overrightarrow{x''_2}, \quad \overrightarrow{GJ}=l_3\,\overrightarrow{x_{v3}}, \quad \overrightarrow{HJ}=l\,\overrightarrow{x'_5}\)
Fermeture géométrique
Modèle géométrique
Info
- \(\beta'_2\) est un paramètre géométrique du balancier voir géométrie des pièces.
- \(\beta_5\) est un paramètre géométrique du triangle voir géométrie des pièces.
Résultats de simulation
Le vérin de cavage a une course telle que \(233,55\textrm{ mm}\le l_3\le 292,03\textrm{ mm}\).
La figure ci-dessous présente les résultats de simulation du modèle géométrique et des mesures réalisées sur le bras de pelleteuse.
Loi E/S godet
Schéma cinématique
Système 4 barres
L'entrainement du godet par le triangle est réalisé par 4 barres montées en liaisons pivot : système 4 barres.
Pour établir la loi E/S de celui-ci, une méthode consiste à diviser ce système en deux sous-systèmes :
- le premier défini par les barres \([HI]\), \([HO_3]\) et une barre virtuelle \([O_3I]\). L'entrée sera l'orientation du triangle \(\gamma_5\) qui entrainera la modification de l'orientation \(\varphi\) et de longueur \(s\) de \([O_3I]\);
- le deuxième défini par les barres \([O_3K]\), \([IK]\) et la barre \([O_3I]\). Cette dernière est l'entrée du sous-système est entraîne, entre autres, l'orientation du godet \(\gamma_3\).
Premier sous-système
Paramétrage
\(\overrightarrow{H0_3}=(L_2-k)\,\overrightarrow{x_2}, \quad \overrightarrow{O_3I}=s\,\overrightarrow{x_6}, \quad \overrightarrow{HI}=L_5,\overrightarrow{x_5}\)
Fermeture géométrique
Modèle géométrique
et
Deuxième sous-système
Paramétrage
\(\overrightarrow{O_3I}=s\,\overrightarrow{x_6}, \quad \overrightarrow{IK}=L_4\,\overrightarrow{x_4}, \quad \overrightarrow{O_3K}=L_3,\overrightarrow{x_3}\)
Fermeture géométrique
Modèle géométrique
Résultats de simulation
Le course du vérin de cavage implique un débattement angulaire du triangle tel que \(0°\le \gamma_5\le 78°\).
La figure ci-dessous présente les résultats de simulation du modèle géométrique et des mesures réalisées sur le bras de pelleteuse.
Ended: Loi E/S
Ended: Modèlisation géométrique
Modélisation des actions mécaniques ↵
Vérin de flèche
Objectif
Déterminer l'effort dans le vérin de flèche
Paramétrage
Schéma cinématique
Graphe de structure
Hypothèses
Dans les calculs ci-dessous, la masse du vérin de flèche est négligée devant les autres masses mises en jeu.
\(\vec P\) correspond au poids de l'ensemble du bras sans le vérin de flèche appliqué au centre de masse \(G_S\). La position du centre de masse \(G_S\) dépend principalement de l'orientation du balancier par rapport à la flèche, du godet par rapport au balancier et de la masse embarquée dans le godet. Soit \(\overrightarrow{O_1G_S}=x_{G_S}\vec x_0 + y_{G_S}\vec y_0\).
Les liaisons sont supposées parfaites.
Détermination de l'effort dans la tige du vérin flèche
Inventaire des actions mécaniques
Dans cette étude, on distingue :
- les actions mécaniques transmissibles dans les liaions
- \(\left\lbrace\mathcal{T}_{\textrm{bâti}\to\textrm{CVF}}\right\rbrace= \left\lbrace\begin{matrix}A_x&-\\A_y&-\\-&0\end{matrix}\right\rbrace_{A,-,-,\vec z_0}\)
- \(\left\lbrace\mathcal{T}_{\textrm{bâti}\to\textrm{F}}\right\rbrace= \left\lbrace\begin{matrix}O_{1x}&-\\O_{1y}&-\\-&0\end{matrix}\right\rbrace_{0_1,-,-,\vec z_0}\)
- \(\left\lbrace\mathcal{T}_{\textrm{CVF}\to\textrm{TVF}}\right\rbrace= \left\lbrace\begin{matrix}F_v&-\\Y&-\\-&N\end{matrix}\right\rbrace_{A,\mathcal{B}_{v1}}\)
- \(\left\lbrace\mathcal{T}_{\textrm{TVF}\to\textrm{F}}\right\rbrace= \left\lbrace\begin{matrix}B_x&-\\B_y&-\\-&0\end{matrix}\right\rbrace_{B,-,-,\vec z_0}\)
- l'action de la pesanteur sur l'ensemble du bras sans le vérin de flèche
- \(\left\lbrace\mathcal{T}_{\textrm{pes}\to\textrm{F}}\right\rbrace= \left\lbrace\begin{matrix}0&-\\-P&-\\-&0\end{matrix}\right\rbrace_{G_S,\mathcal{B}_0}\)
Isolement de l'ensemble vérin flèche
L'ensemble vérin flèche est constitué du corps (CVF) et de la tige (TVF) du vérin.
Cet ensemble est en équilibre sous l'action de deux glisseurs aux points \(A\) et \(B\).
D'après le principe fondamental de la statique, les résultantes de ces deux glisseurs sont portées par la direction \(\overrightarrow{x_{v1}}\).
Ainsi :
- \(\left\lbrace\mathcal{T}_{\textrm{bâti}\to\textrm{CVF}}\right\rbrace= \left\lbrace\begin{matrix}\mathcal{R}_A&-\\0&-\\-&0\end{matrix}\right\rbrace_{A,\mathcal{B}_{v1}}\)
- \(\left\lbrace\mathcal{T}_{\textrm{TVF}\to\textrm{F}}\right\rbrace= \left\lbrace\begin{matrix}\mathcal{R}_B&-\\0&-\\-&0\end{matrix}\right\rbrace_{B,\mathcal{B}_{v1}}\)
Isolement de la flèche
La flèche est en équilibre sous l'action de 3 glisseurs. Pour déterminer l'effort dans la tige de vérin, il convient d'écrire le théorème du moment statique au point \(O_1\) projeté sur la direction \(\vec z_0\) :
Soit donc
Isolement de la tige du vérin
L'application du théorème de la résultante statique en projection sur \(\overrightarrow{x_{v1}}\) donne :
soit donc
Ended: Modélisation des actions mécaniques
Modélisation volumique ↵
Modélisation volumique du vérin électrique
Présentation
Normes dimensionnelles
Le constructeur du vérin ne donne pas de renseignements sur les caractéristiques des roues dentées, de la vis sans fin et de la vis de manœuvre. Les normes utilisées pour ces éléments ne sont manifestement pas les normes européennes. De plus nous n’avons pas la désignation des matériaux utilisés. Les seules informations sont celles données sur le site du constructeur. En conséquence la maquette numérique réalisée, avec SolidWorks 2019-2020 (SW), est seulement proche du réel. Les dentures des roues 2, 3 et 4 ainsi que la vis sans fin 1 en représentation réaliste ne sont pas, géométriquement, correctes.
Format neutre du SW
Afin d’éviter la complexité des arbres de construction la maquette a été convertie dans un format neutre.
La figure ci-dessous montre la maquette numérique du vérin complet.
L'intérieur du vérin est présenté sur la figure ci-dessous, ½ carter enlevé et tube de section rectangulaire transparent.
Info
Le vérin destiné à la pelleteuse a été modifié de part la nécessité de placer à l’extrémité du coulisseau un capteur d’effort entre un raccord d’adaptation et une chape mobile.
Arbre de construction dans SolidWorks
La représentation de l’ensemble des pièces du vérin est structurée en une association de classes d’équivalence (pièces liées complètement ou pièces cinématiquement équivalentes), notées par la suite SE.
Ainsi l’arbre de construction de premier niveau du vérin est constitué de cinq SE:
- SE Carter ;
- SE Coulisseau ;
- SE Vis de manoeuvre ;
- SE Arbre moteur ;
- SE Roues dentées.
L’éclaté de la maquette numérique (figure ci-dessous) montre les cinq SE de premier niveau.
Détails des sous-ensembles
SE Carter
La figure ci-dessous présente les pièces constituants le SE Carter.
SE Glissière
La figure ci-dessous présente les pièces constituants le SE Glissière.
SE Coulisseau
La figure ci-dessous présente les pièces constituants le SE Coulisseau.
L’écrou et le raccord sont vissés sur le tube de section circulaire et le capteur d’effort sur le raccord et la chape mobile.
SE Vis de manoeuvre
La figure ci-dessous présente les pièces constituants le SE Vis de manoeuvre.
En toute rigueur, compte tenu du choix de la construction de la maquette par SE cinématiquement équivalents, les bagues extérieures des roulements et les rondelles de la butée à billes devraient être liées à la chape fixe liée au carter.
Modélisation spatiale minimale
Présentation
La pelleteuse électrique schématisée, dont l’image de la maquette numérique est donnée ci-dessous (version assemblée et éclatée), est constituée essentiellement de cinq pièces principales et de trois vérins.
L’organisation des dossiers dans Windows est donnée ci-dessous.
Larbre de construction du schéma de la maquette dans SolidWorks (2019-2020) est donné ci-dessous.
Analyse mécanique
Note
Dans cette représentation schématique, les vérins électriques sont représentés simplement par une tige (coulisseau) en liaison glissière avec le corps (glissière).
La transmission du mouvement du mouvement depuis le moteur électrique jusqu’au coulisseau n’est pas représentée.
D’après le schéma cinématique fig. 1 et le graphe de structure fig. 4, le nombre de pièces du bras de la pelleteuse est \(N_P=12\) et le nombre de liaisons est \(N_L=15\) donc le nombre cyclomatique \(\nu\) définissant le nombre de cycles indépendants est
Il est donc possible d’écrire \(E_c=6\nu=6\times 4=24\) équations cinématiques de rang \(r_c\) avec \(I_c=31\) inconnues cinématiques.
Le nombre de degrés de mobilités utiles, correspond au mouvement de la flèche 1, du balancier 3 et du godet 3, est \(m_{cu}=3\).
Intuitivement on dénombre \(m_{ci}=4\) mobilités internes (rotation des trois vérins et de la bielle 4 autour de leurs axes).
Donc au total le bras de la pelleteuse possède \(m_c=m_{cu}+m_{ci}=7\) degrés de mobilité.
Comme \(r_c=I_c-m_c=31-7=24\) alors le degré de surabondance est
En conclusion le bras de la pelleteuse comporte 3 degrés de mobilité utile et ainsi schématisé, n'est donc pas surabondante géométriquement (cinématiquement, ou isostatique).
En conséquence la maquette schématique de la pelleteuse peut être utilisée directement dans Méca3D pour des études géométrique et/ou cinématique.
Ended: Modélisation volumique
Ended: Modèles
Intelligence Artificielle ↵
Apprentissage par renforcement
L'objectif de cet apprentissage est de permettre au bras de pelleteuse de déterminer de manière autonome la trajectoire à imposer au godet pour aller d'un point à un autre en évitant toute colision avec l'environnement.
Tableau de bord associé
Consultez également le tableau de bord assosicié.
Qlearning
L'apprentissage utilise la méthode Q-learning : une matrice \(Q\left[s,a\right]\) permet de déterminer l'action \(a\) à prendre par l'agent dans l'état \(s\) lui permettant d'obtenir la meilleure récompense \(r\) lorsqu'il sera dans l'état \(s'\) :
Les variables ajustables de ce modèle sont :
- le facteur d'apprentissage \(\alpha \in \left[0;1\right]\) : permet de déterminer à quel point la nouvelle information calculée surpassera l'ancienne (valeur par défaut \(\alpha=0,6\))
- \(\alpha=0\) : l’agent ignore le futur;
- \(\alpha=1\) : l’agent ignore le passé.
- le facteur de dépréciation \(\gamma \in \left[0;1\right]\) : détermine l'importance des actions futures \(a'\) (valeur par défaut \(\gamma=0,9\).)
- \(\gamma=0\) : seule la récompense \(r\) est prise en compte;
- \(\gamma=1\) : la récompense \(r\) est valorisée par les meilleures actions futures).
Environnement
L'environnement correspond à la zone de déplacement du godet tel que celui-ci puisse rester horiztontal. Cette zone est disctrétisée en carrés gris clairs de côté 60 mm.
Dans cet environnement sont disposés :
- un obstacle (rectangulaire ou triangulaire) que le godet devra éviter
- un point de départ
qu'il est possible de déplacer
- un point d'arrivée
qu'il est possible de déplacer mais sous la contrainte de toujours être à gauche du point de départ, ou au même niveau.
Actions
Les actions correspondent aux déplacements possibles du godet. On retient ici, sous la contrainte imposée du placement des points de départ et d'arrivée :
- Haut
- Gauche-Haut
- Gauche
- Gauche-Bas
- Bas
Récompenses
Au changement d'état
La récompense \(r\) qui intervient dans le calcul de la matrice \(Q\) prend en compte la distance qui sépare l'état \(s\) de l'agent au point d'arrivée :
La distance 120 correspond à 3 cases de l'environnement, cette variable peut être ajustée dans la boîte Récompenses du tableau de bord associé dans MyViz. Il en va de même pour le facteur \(10^{-3}\).
Au succés
Lorsque l'agent arrive au point d'arrivée, la récompense est fixée à \(r=10\) (bonus). Cette valeur peut-être modifiée.
À l'échec
Lorsque l'agent arrive rencontre un obstacle ou sort du domaine, la récompense est fixée à \(r=-10\) (malus). Cette valeur peut-être modifiée.
Epsilon-greedy
Le choix de l'action à prendre, pour passer d'un état \(s\) à un état \(s'\), est générée grâce à la méthode Epsilon-greedy. Un facteur aléatoire \(\epsilon\) est calculé en fonction du nombre d'itérations total de l'apprentissage \(N\) (par défaut \(N=2000\)) et par le numéro \(i\) de l'itération en cours :
Une variable aléatoire \(var\) entre 0 et 1 est calculée à pour chaque changement d'état :
- si \(var\leq \epsilon\) alors le choix de l'action \(a\) est aléatoire;
- si \(var> \epsilon\) alors le choix de l'action \(a\) est déterminé par \(\max_a Q[s,a]\).
Dans MyViz, pour représenter le choix de l'action, un pictogramme apparaît
dans le cas d'un choix aléatoire
dans le cas d'un choix par la matrice \(Q\)
Ended: Intelligence Artificielle
Documentation technique ↵
Caractéristiques des pièces ↵
Caractéristiques géométriques
Bâti
Flèche
Balancier
Triangle de renvoi
Bielle
Godet
Centre de masse
Flèche
Balancier
Triangle
Bielle
Godet
Vérin
Corps
Tige
Ended: Caractéristiques des pièces
Chaîne d'information ↵
Mesures
Codeurs d'axes
Présentation
Le codeur d’axe est un codeur absolu numérique Avago AEAT-6012-A06 avec interface SSI.
Le bras de pelleteuse en compte 4, permettant la mesure des angles relatifs
- flèche \ bâti (\(\gamma_1\));
- balancier \ flèche (\(\gamma_2\));
- triangle \ balancier (\(\gamma_3\));
- godet \ triangle (\(\gamma_4\)) .
Position angulaire des axes
Sa mesure est codée sur 12 bits, ce qui signifie que la résolution angulaire brute est de 0,088 °, selon la formule \(\dfrac{360}{2^{12}}=\dfrac{360}{4096}\approx 0,088\) °.
Cependant, un algorithme particulier a été mis en place pour éliminer les mesures aberrantes observées dans certains cas de figure :
- une mesure est faite toutes les 2 ms;
- toutes les 10 ms, on fait la moyenne sur les 5 dernières mesures;
- les trois mesures les plus éloignées de la moyenne sont éliminées;
- la position angulaire fournie par le système est la moyenne des 2 mesures restantes. La résolution angulaire est alors de 0,044°;
- dans le cas particulier des modes « Statique » et « Energétique / Puissance », la position est en plus filtrée par un premier ordre de constante de temps 0,05 s.
Vitesse angulaire des axes
Ce capteur est également utilisé pour calculer, toutes les 10 ms, la vitesse angulaire des axes (en divisant par 0,01 l’écart entre la position courante et la position précédente) et en faisant une moyenne glissante sur 10 échantillons.
Avant la moyenne glissante, la résolution sur la valeur angulaire est égale à \(\dfrac{0,044}{0,01}=4,4\) °/s.
La moyenne glissante permet d’obtenir une résolution 10 fois inférieure, de 0,44 deg/s.
Codeurs de vérins
Présentation
Le moteur du vérin est doté d’un codeur incrémental afin de mesurer sa position et de calculer sa vitesse de rotation. Ce codeur incrémental fournit deux signaux carrés en quadrature, comme sur la capture ci-dessous.
Deux signaux en quadrature sont indispensables pour connaître le sens de rotation. En effet, lorsqu’un front (montant ou descendant) est compté sur une voie, le niveau (haut ou bas) du signal sur l’autre voie permet de savoir si le moteur tourne dans le sens positif ou dans le sens négatif.
Le codeur du moteur du vérin intègre un seul aimant. Il génère donc 1 impulsion par tour (PPR) ce qui conduit à 4 fronts par tour (CPR) car on est capable de compter les fronts montants et descendants produits par cet aimant sur les deux capteurs à effet Hall décalés de 90°, attachés à la partie fixe du moteur.
Position vérin
Dans la mesure où la fonction essentielle du moteur est de déplacer la tige du vérin, nous allons nous intéresser ici à la résolution linéaire de la mesure de position et du calcul de vitesse.
La résolution sur la position se calcule sachant que le moteur fait 7,16 tours pour un déplacement de la tige de 1 mm. Le CPR étant égal à 4, la résolution est donc égale à \(\dfrac{1}{4\times 7,16}\approx 0,035\) mm.
Vitesse vérin
La vitesse est calculée toutes les 10 ms en divisant par 0,01 l’écart entre la position courante et la position précédente et en faisant une moyenne glissante sur 10 échantillons. Avant la moyenne glissante, la résolution est donc \(\dfrac{0,035}{0,01}=3,5\) mm/s.
La moyenne glissante permet d’obtenir une résolution 10 fois inférieure, de 0.35 mm/s.
Capteur d'effort
Les capteurs d'effort, monté entre les tiges de vérins et respectivement la flèche, le balancier et la bielle du godet, sont de type piezoélectrique.
Etalonnage
À la première utilisation du banc de TP ou après un déplacement du banc de TP, il est conseillé de réaliser un étalonnage du capteur via le Tableau de Bord MaintenanceCalibration).
Commande des vérins
Chacun des 3 axes du bras de la pelleteuse intègre deux boucles d’asservissement imbriquées :
- Asservissement de type PI sur la vitesse des vérins
- Asservissement de type PID sur la position angulaire des axes
Asservissement en vitesse
Commande en Vitesse
Lorsque la pelleteuse est utilisée à partir du tableau de bord "Prise en main", les commandes sont passées via le joystick : l'inclinaison \(\alpha\) du joystick génère une commande proportionnelle à la vitese désirée (l'inclinaison maximale correspond à la vitesse maximale de la tige)
L’asservissement en vitesse des vérins est réalisé par un régulateur de type proportionnel-intégral avec saturation de tension de commande en sortie et dispositif d’anti-saturation de l’intégrateur (anti-emballement ou anti-windup).
Le régulateur a la forme générale ci-dessous.
Ci-dessous le dispositif d’anti-windup et le correcteur proportionnel-intégral dans le sous-système PI, implémenté.
La fonction de transfert du régulateur PI si la sortie n’est pas saturée est la suivante :
Si la sortie est saturée, la relation entre l’entrée (\(u\)), la sortie non saturée (\(y\)) et la sortie saturée (\(y_{sat}\)) est la suivante :
Asservissement en position
Info
Sauf dans le cas d'une utilisation par joystick, c'est l'asservissement en positon angulaire de l'axe qui est retenu, avec la boucle de vitesse imbriquée dans la commande du vérin (voir paragraphe précédent).
Le saturateur permet d’imposer une vitesse maximale de déplacement de la tige du vérin. Elle correspond à la valeur adaptée réglable dans MyViz.
Le codeur avec interface SSI permet d'obtenir en sortie directement la valeur de l'angle, ce qui implique l'absence d'adaptateur entre l'entrée \(\gamma_c\) et le comparateur. On peut donc considérer un retour unitaire.
L’asservissement de position des axes est réalisé par un régulateur de type proportionnel-intégral-dérivé avec saturation de vitesse de consigne en sortie et dispositif d’anti-saturation de l’intégrateur (anti-windup).
Le régulateur a la forme générale suivante :
Ci-dessous, le dispositif d’anti-windup et le correcteur proportionnel-intégral-dérivé dans le sous-système PID.
Par rapport au PI implanté dans la boucle de vitesse, on a ajouté la fonction de transfert « ActionDerivee », soit donc la fonction de transfert du correcteur, sans saturation,
D’un point de vue mathématique, le dénominateur permet d’éviter que la fonction de transfert du PID soit « non-propre » (ordre du numérateur supérieur à l’ordre du dénominateur). D’un point de vue plus concret, il permet aussi de filtrer la dérivée. La valeur de \(T_f\) est \(0,02\).
Si la sortie est saturée, la relation entre l’entrée (\(u\)), la sortie non saturée (\(y\)) et la sortie saturée (\(y_{sat}\)) est :
Ended: Chaîne d'information
Chaîne d'énergie ↵
Verin électrique
Référence
Le vérin électrique TA38 est un produit conçu et fabriqué par la société TiMOTION (site).
Constitution du vérin électrique
Vue d'ensemble
Le démontage de la partie supérieure du carter fait apparaître les pièces et les sous-ensembles du vérin (figure ci-dessous).
Dans le carter, en deux parties, se trouvent principalement :
- un moteur électrique ;
- une carte électronique ;
- un système de transmission du mouvement de rotation du moteur à un système vis-écrou.
Transmission du mouvement arbre/vis de manœuvre
Les figures ci-dessous présentent les détails de la transmission du mouvement depuis l’arbre moteur jusqu’à la vis de manœuvre. L’arbre moteur, vis sans fin à deux filets à droite, engrène avec une roue hélicoïdale de 25 dents. Cette dernière est liée complètement à une roue hélicoïdale de 6 dents qui engrène avec une roue hélicoïdale de 11 dents d’axe orthogonal, liée à la vis de manœuvre (pas de 3 mm à droite).
Système vis/écrou
Le système vis-écrou (figure ci-dessous) est principalement et classiquement constitué d’une glissière (tube carré), d’un écrou lié complètement à un tube cylindrique (s-e coulisseau) et d’une vis de manœuvre en liaison pivot par rapport au carter (figure ci-dessous).
La liaison pivot (figure ci-dessous) est, plus précisément, réalisée entre les deux ½ chapes liés complètement au carter et la vis de manœuvre par deux roulements à billes et une butée à billes simple effet.
La glissière est munie de deux interrupteurs de fin de course actionnés par l’intermédiaire de l’ergot de l’écrou.
Schéma cinématique
L’examen des pièces démontées permet de tracer le schéma cinématique plan développé du vérin.
Maquette numérique
Se référer à la partie modèle volumique.
Rapport de transmission
Masses des pièces du vérin électrique
Matériaux inconnus
Les matériaux utilisés pour les différentes pièces du vérin électrique sont inconnus. La pesée des différentes pièces a permis d’obtenir la masse.
SE Carter | Masse (g) |
---|---|
Carter 1 | 47 |
Carter 2 | 31,9 |
Tube section rectangulaire | 26,8 |
Embout | 3,8 |
Chape fixe | 16 |
Palier | 32,7 |
Axe palier | 5,9 |
Vis torx l=25 | 1,1x7 |
Vis torx l=12 | 0,6x3 |
Vis (tube carré) | 0,5 |
Vis (palier) | 0,5x2 |
SE Coulisseau | Masse (g) |
---|---|
Tube section circulaire | 21,5 |
Ecrou | 5,2 |
SE Vis de manœuvre | Masse (g) |
---|---|
Vis de manœuvre | 59,3 |
Billes+cage | 1,3 |
Rondelles | 1,3x2 |
Roulements | 4,9x2 |
Entretoises | 1,6x2 |
SE Engrenages | Masse (g) |
---|---|
Roue hélicoïdale | 8,6 |
s-e Roues dentées | 3,5 |
Ecrou freiné | 3 |
SE Moteur électrique | Masse (g) |
---|---|
Moteur électrique | 210 (mesuré) |
Stator | 50 (évaluation) |
Arbre moteur | 160 (évaluation) |
Total | 503,1 |
---|---|
Capteur effort | 100 (donnée constructeur) |
Structure articulée
La transformation de mouvement, translation/rotation, de chaque axe est réalisée par la biais d'une strucuture articulée actionnée par le vérin (association en série de trois liaisons pivot et une liaison glissière). Pour le godet, un système 4 barres vient s'ajouter entre le godet et la structure articulée.
Voir la section Modélisation géométrique plane pour plus de détails.