COMMANDE PAR MODE DE GLISSEMENT
Moteurs synchrones
Comme mentionnรฉs prรฉcรฉdemment, sept moteurs รฉlectriques permettent de dรฉplacer les articulations de lโexosquelette. Le choix des moteurs a รฉtรฉ portรฉ sur des machines synchrones du fabricant Maxon, car ceux-ci sont compacts, lรฉgers et facilement contrรดlables lorsquโils sont autopilotรฉs. Deux calibres de moteurs sont nรฉcessaires afin de bouger les articulations duย robot soit des machines de 90 W (EC 90 flat) contenant 12 paires de pรดles et des machines de 30 W (EC 45 Flat) contenant 8 paires de pรดles. Deux moteurs EC 90 permettent de faire bouger lโรฉpaule; un moteur EC 90 fait flรฉchir le coude tandis quโun EC 45 le fait pivoter; et, trois autres moteurs EC 45 actionnent le poignet. De plus, on retrouve installรฉs sur le stator des moteurs trois capteurs ร effet de Hall qui permettent lโautopilotage des moteurs. Ils ont pour but dโindiquer au microcontrรดleur du servoamplificateur le moment oรน il faut commuter les bobines afin de crรฉer une rotation au niveau du rotor. Or, en mesurant les signaux produits par ces capteurs, il sera possible de dรฉterminer la position du rotor et ainsi sโen servir comme capteur de position
CompactRio
Le CompactRIO (cRIO) 9074 est un chรขssis embarquรฉ reconfigurable de la compagnie National Instrument. On retrouve sur celui-ci huit fentes pouvant comporter des modules interchangeables dโentrรฉes et de sorties. De plus, on y retrouve un processeur ร temps rรฉel cadencรฉ ร 400 MHz avec un FPGA 2M, deux ports Ethernet (10/100 Mb/s) et un port de communication RS232. Les modules dโentrรฉes/sorties utilisรฉs pour le bras exosquelette sont les suivants :
– 2 NI 9205 : Module dโentrรฉes analogiques, 16 bits, 32 canaux, ยฑ10 Volts,
– 1 NI 9264 : Module de sorties analogiques, 16 bits, 16 canaux, ยฑ10 Volts,
– 2 NI 9403 : Module dโentrรฉes/sorties digitales, 32 canaux.
Les modules NI 9205 permettent de convertir les donnรฉes analogiques recueillies provenant des diffรฉrents capteurs en donnรฉes numรฉriques. Contrairement, le module NI 9264 convertit les donnรฉes de la commande numรฉrique ร envoyer au servoamplificateur en donnรฉe analogique. Les modules NI 9403 interagissent avec les signaux digitaux nรฉcessaires au robot et mesurant les รฉtats acquis par les capteurs ร effet de Hall.
Cartes pilotes des moteurs
Le robot comporte sur la carte-mรจre sept cartes pilotes oรน lโon retrouve des servoamplificateurs (ZB12A8). Ceux-ci produisent un signal de type MLI ร une frรฉquence de commutation รฉlevรฉe (33 kHz) et permettent dโautopiloter toutes les machines synchrones installรฉes sur lโexosquelette. Le servoamplificateur utilisรฉ peut recevoir comme rรฉfรฉrence une tension allant de ยฑ 15 Volts. Une tension positive fait bouger les moteurs dans le sens horaire et le contraire se produit lors dโune tension nรฉgative.
On retrouve installรฉ sur les cartes pilotes un rรฉgulateur de tension permettant de transformer une tension de 40 V ร 5 V. Cette tension permettra dโalimenter les capteurs ร effet de Hall continuellement dans le but de maintenir la position mesurรฉe lorsque lโalimentation principale est coupรฉe. De plus, on retrouve installรฉs sur les cartes des filtres RC passifs de deuxiรจme ordre permettant dโattรฉnuer le bruit se trouvant sur les signaux digitaux desย capteurs ร effet de Hall. La valeur des rรฉsistances est de 1 kโฆ tandis que la valeur des condensateurs est de 0.1 ยตF.
Capteurs de positions
Afin dโassurer le bon fonctionnement du systรจme, plusieurs capteurs de positions sont placรฉs sur lโexosquelette. Chaque articulation est รฉquipรฉe dโun potentiomรจtre de 10k โฆ qui joue le rรดle de capteurs de position. Ainsi, la tension varie aux bornes du potentiomรจtre en fonction du degrรฉ de rotation des articulations du robot. La prรฉcision de la mesure des potentiomรจtres est de 0.01 degrรฉ. De plus, lโutilisation des capteurs ร effet de Hall installรฉs sur les machines synchrones pourrait รชtre employรฉe comme capteurs de position.
Carte-mรจre
Le rรดle de la carte-mรจre est dโacheminer les diffรฉrents signaux analogiques et numรฉriques provenant des diffรฉrents systรจmes de lโexosquelette. Afin de parvenir ร ses fins, plusieurs รฉlรฉments sont installรฉs sur cette carte.
La carte-mรจre est alimentรฉe par une source de tension transformant la tension alternative de 120 Volts, 60 Hz du rรฉseau ร une tension continue de 40 Volts (40V PWR). Afin de faire fonctionner les diffรฉrentes composantes, un rรฉgulateur de tension est placรฉ sur la carte pour maintenir celle-ci ร 10 Volts. Par prรฉcaution, un fusible est fixรฉ sur les cartes dans le souci de protรฉger les composantes dโun courant supรฉrieur ร 30 Ampรจres. De plus, deux relais sont installรฉs pour alimenter les cartes lorsquโils sont enclenchรฉs par lโutilisateur. Le premier relais est contrรดlรฉ par lโentrรฉe digitale ยซ CTRL Relai ยป et fournit lโalimentation au rรฉgulateur de tension installรฉ sur les cartes pilotes. Le deuxiรจme relais est contrรดlรฉ par lโentrรฉe digitale ยซ PWR Relai ยป et fournit lโalimentation au rรฉgulateur de tension installรฉ sur la carte mรจre. Ce dernier peut se dรฉclencher lorsque le bouton dโarrรชt dโurgence est activรฉ.
FPGA
Le FPGA ou ยซ Field Programmable Gate Array ยป est un circuit intรฉgrรฉ pouvant รชtre programmรฉ aprรจs sa fabrication. Il contient des composantes logiques programmables, appelรฉes blocs logiques, qui peuvent รชtre connectรฉes entre elles pour obtenir diffรฉrentes configurations. Or, la connexion de ces blocs entre eux permet de crรฉer des fonctions combinatoires complexes ou tout simplement des portes logiques comme des ET ou des OU.
Le rรดle du FPGA dans le prรฉsent projet consiste, dans un premier temps, ร transmettre au contrรดleur temps rรฉel du cRIO les donnรฉes de la position et de la vitesse de chaque articulation. Pour ce faire, une lecture de la tension des capteurs de position, provenant du module dโentrรฉe analogique, est effectuรฉe afin de transformer ces donnรฉes en position angulaire. Par la suite, celle-ci sera traitรฉe par un filtre de deuxiรจme ordre pour obtenir un rรฉsultat plus lisse et pour obtenir la vitesse angulaire des articulations.
Dans un deuxiรจme temps, le FPGA a pour but dโasservir le courant des moteurs synchrones afin de sโassurer que le couple calculรฉ par le systรจme de commande soit vraiment celui utilisรฉ par les moteurs. Pour ce faire, un correcteur PI asservit le signal du courant prรฉalablement traitรฉ avec lโaide dโun filtre de deuxiรจme ordre. Cette boucle interne est calculรฉe 25 fois plus rapidement que celle du systรจme de commande.
Ordinateur Real-Time
Lโordinateur Real-Time (RT) est le systรจme qui met en ลuvre les opรฉrations nรฉcessaires au fonctionnement du robot. Cette tรขche aurait pu รชtre appliquรฉe au niveau du processeur temps rรฉel du cRIO, mais celui-ci nโest pas assez puissant pour calculer les systรจmes de commande dans un dรฉlai infรฉrieur ร 2 ms. Avec un temps plus รฉlevรฉ, le systรจme ne serait pas assez rapide pour utiliser les systรจmes de commande รฉtudiรฉs adรฉquatement. Or, lโordinateur RT est programmรฉ afin de traiter ces opรฉrations. Pour parvenir ร ses fins, le programme lit la position et la vitesse de MARSE transmises prรฉalablement par le cRIO. Par la suite, il calcule les prochaines donnรฉes de la trajectoire dรฉsirรฉe ainsi que le couple selon la mรฉthode de contrรดle choisie prรฉalablement. Finalement, il convertit le couple en courant de rรฉfรฉrence avant de transmettre cette valeur au cRIO. Cette manipulation est accomplie ร toutes les 1.25 ms pour toute la durรฉe de lโexercice programmรฉ. Voici les spรฉcifications de lโordinateur utilisรฉ lors des expรฉrimentations
Limite de lโarchitecture รฉlectronique
Lโarchitecture รฉlectronique proposรฉe comporte plusieurs limites qui seraient intรฉressantes dโidentifier. De la sorte, les dommages au robot ou des blessures ร son utilisateur pourront รชtre prรฉvenus. Dans un premier temps, comme mentionnรฉ prรฉcรฉdemment, lโordinateur RT effectue ses opรฉrations ร toutes les 1.25 ms. Or, ce temps pourrait รชtre raccourci sโil nโy aurait pas un dรฉlai de communication ente le cRIO et lโordinateur RT. Ce dรฉlai reprรฉsente un temps dโenviron 450 ยตs. Toutefois, cet inconvรฉnient est nรฉcessaire compte tenu du fait que leย cRIO nโest pas en mesure dโintรฉgrer la boucle de contrรดle des systรจmes de commande รฉtudiรฉs dans un temps infรฉrieur ร 2 ms.
Dans un deuxiรจme temps, en supposant que le dรฉlai discutรฉ prรฉcรฉdemment soit retirรฉ, la frรฉquence limite que prendrait le systรจme pour effectuer ces opรฉrations serait รฉgale ร celle du FPGA. Or, avec la configuration et la programmation actuelle, le FPGA pourrait effectuer ces itรฉrations ร une frรฉquence de 2 kHz. Finalement, la tension de rรฉfรฉrence disponible des servoamplificateurs est limitรฉe par la tension maximale distribuรฉe par le module de sortie analogique NI-9264. En effet, la tension de rรฉfรฉrence des servoamplificateurs peut aller jusquโร ยฑ15 volts tandis que celle du module NI-9264 peut aller jusquโร ยฑ10 volts. Ceci signifie que lโexosquelette pourrait manquer de puissance advenant le cas oรน un mouvement nรฉcessiterait une tension de rรฉfรฉrence supรฉrieure ร 10 volts. Toutefois, nous avons remarquรฉ que la puissance des moteurs รฉtait suffisante pour exรฉcuter les mouvements et nous avons dรป saturer la tension de rรฉfรฉrence afin de limiter le couple disponible.
|
Table des matiรจres
INTRODUCTION
CHAPITRE 1 REVUE DE LITTรRATUREย
CHAPITRE 2 MODรLISATION DE MARSEย
2.1 Cinรฉmatique directe
2.2 Modรจle dynamique
2.3 Modification apportรฉe au modรจle
2.4 Espaces de travail
2.5 Conclusion
CHAPITRE 3 COMMANDE PAR COUPLE PRรCALCULรย
3.1 Loi de commande partitionnรฉe
3.2 Correcteur PID
3.3 Conclusion
CHAPITRE 4 COMMANDE PAR MODE DE GLISSEMENT
4.1 Surface de glissement
4.2 Loi de convergence
4.3 Loi de commande
4.4 Conclusion
CHAPITRE 5 ARCHITECTURE รLECTRONIQUE
5.1 Moteurs synchrones
5.2 CompactRio
5.3 Cartes pilotes des moteurs
5.4 Capteurs de positions
5.5 Carte-mรจre
5.6 FPGA
5.7 Ordinateur Real-Time
5.8 Limite de lโarchitecture รฉlectronique
5.9 Conclusion
CHAPITRE 6 ARCHITECTURE DE CONTRรLE DE MARSEย
6.1 Modes de fonctionnement
6.1.1 Mode manuel
6.1.2 Mode passif
6.2 Architecture du FPGA
6.2.1 Boucle dโacquisition de la position et de la vitesse
6.2.2 Boucle interne du courant
6.3 Architecture module RT du Compact Rio
6.4 Architecture de lโordinateur Real-Time
6.4.1 Mode manuel
6.4.2 Mode passif
6.4.3 Boucles de contrรดle
6.4.3.1 Gรฉnรฉration de la trajectoire
6.4.3.2 Friction de Coulomb
6.4.3.3 Conversion couple ร courant
6.5 Interface usager
6.6 Conclusion
CHAPITRE 7 CAPTEURS ร EFFET DE HALL COMME CAPTEURS DE POSITIONย
7.1 Capteur ร effet de Hall sur MARSE
7.2 Implantation dans le FPGA
7.3 Conclusion
CHAPITRE 8 RรSULTATS ET ANALYSEย
8.1 Rรฉsultats des comparaisons entre les mรฉthodes de commande
8.1.1 Rรฉsultats pour des exercices ร un degrรฉ de libertรฉ
8.1.2 Rรฉsultats pour des exercices ร deux degrรฉs de libertรฉ sรฉparรฉment
8.1.3 Rรฉsultats pour des exercices de 2 degrรฉs de libertรฉ et plus simultanรฉment
8.2 Rรฉsultats des comparaisons entre les mรฉthodes de mesure de la position
8.3 Analyse des rรฉsultats
8.3.1 Analyses de performances des systรจmes de commande
8.3.2 Analyses de la mรฉthode de mesure des diffรฉrents capteurs de positions
CONCLUSION
Tรฉlรฉcharger le rapport complet