Asservissement de vitesse d un moteur à courant continu à l aide de la carte Arduino UNO

Transcription

1 CHELLY Nizar CHARED Amine FORMATION ARDUINO SIMULINK/ANDROID Asservissement de vitesse d un moteur à courant continu à l aide de la carte Arduino UNO ISET Rades 2/3 Juin 2015

2 TABLE DES MATIÈRES TABLE DES MATIÈRES Table des matières 1 Présentation de la carte Arduino Le matériel : Arduino UNO Le logiciel Arduino Structure d un programme Arduino Présentation de la maquette 6 3 Commande du moteur à courant continu avec la carte Arduino Présentation des sorties analogiques (mode PWM) Présentation du schéma électronique Exemples de programme pour la commande du moteur Exploitation de l encodeur optique avec la carte Arduino Présentation du capteur Principe de fonctionnement Comptage du nombre d impulsions Programme d acquisition des impulsions l instruction de base pour l acquisition Code Arduino pour l acquisition L interfacage Arduino Matlab/Simulink L environnement Matlab/Simulink ArduinoIO Pré-chargement du programme dans la carte Arduino Installation du package ArduinoIO Exploitation de la bibliothèque ArduinoIO sous Simulink Exploitation du package ArduinoIO sous Matlab Arduino Target Commande du moteur avec Arduino/Simulink Utilisation du package ArduinoIO Libraray Exploitation de l encodeur optique avec Arduino/Simulink 14 8 Modélisation du système Présentation de l étape d identification avec Matlab Acquisition de la réponse indicielle du système Détermination de la fonction de transfert G(z) Implémentation de la commande sur Simulink Synthèse du régulateur numérique Implémentation de la commande sous Simulink Implémentation de la commande sur la carte Arduino Le régulateur PID Numérique L implémentation du régulateur PID

3 TABLE DES FIGURES TABLE DES FIGURES Table des figures 1 Description de la Carte Arduino "Uno" L interface du logiciel Arduino Une vue de la maquette Description du signal PWM Exemples de variation du rapport cyclique Branchement de la carte Arduino UNO avec un moteur DC Circuit interne du module Les deux signaux issues de l encodeur optique ArduinoIO Library Les Blocs d ArduinoIO nécessaires pour la commande Emplacement COM de la carte Arduino UNO Envoie de la commande PWM sous ArduinIO Library acquisition des impulsions sous Arduino IO Library L utilisation de l outil System Identification Modèle Simulink pour la détermination de la réponse indicielle L interface de l outil System identification Choix des types des données Time Domain Data Saisie des données relatives aux Input et Output du système Choix de la description du système à estimer Tranfer Function Choix du nombre des pôles et zéros de la fonction de transfert à estimer Visualisation du résultat de l estimation Récupération de la fonction de transfert estimée Schéma synoptique de l asservissement à implémenter Emplacement de l outil PID tuning Interface de l outil PID tuning Importation du modèle estimé Interface de l outil Import Linear System Choix du régulateur à implémenter Récupération des paramétrés du régulateur Modèle Simulink d asservissement de température Saisie des paramétrés du régulateur Schéma synoptique de l asservissement à implémenter

4 Formation Arduino Simulink/Android Asservissement de vitesse d un moteur à courant continu à l aide de la carte Arduino UNO CHELLY, Nizar Ingénieur en Électrique et Automatique chellynizar@gmail.com CHARED, Amine Ingénieur en Informatique amineaby@gmail.com Nizar CHELLY-Amine CHARED 3 ISET RADES 2015

5 1 Présentation de la carte Arduino Arduino est un projet créé par une équipe de développeurs, composée de six individus : Massimo Banzi, David Cuartielles, Tom Igoe, Gianluca Martino, David Mellis et Nicholas Zambetti. Cette équipe a créé le "système Arduino". C est un outil qui va permettre aux débutants, amateurs ou professionnels de créer des systèmes électroniques plus ou moins complexes. 1.1 Le matériel : Arduino UNO C est un circuit imprimé comportant tous les composants électroniques nécessaires pour faire fonctionner un microcontrôleur (Atmega 328) associé à une interface USB lui permettant de communiquer avec un ordinateur. Microcontroller : ATmega328 Operating Voltage : 5v Input Voltage (recommended) : 7-12 v Input Voltage (limits) : 6-20 v DC Current per I/O Pin : 40mA DC Current for 3.3V Pin :50mA Flash Memory :32 KB Clock Speed : 16MHz Pins assignments : Analog read(a0-a5) Analog write[pwm] (3,5,6,9,10,11) Digital read(2-19) Digital write(2-19) 1.2 Le logiciel Arduino Figure 1 Description de la Carte Arduino "Uno" Arduino IDE ( Integrated Development Environment ). Le logiciel est gratuit et open source dont la simplicité d utilisation est remarquable.ce logiciel va nous permettre de programmer la carte Arduino pour : Réaliser l interfacage avec Matlab/simulink Implémenter la commande directement sur la carte. Nizar CHELLY-Amine CHARED 4 ISET RADES 2015

6 Figure 2 L interface du logiciel Arduino 1.3 Structure d un programme Arduino Le langage de programmation Arduino dérive du langage C++ et il en respecte les règles de syntaxe : 1. Une ligne qui commence par "//" est considérée comme un commentaire. 2. Un paragraphe qui commence par "/*" et qui se termine par "*/" est considéré comme un commentaire 3. Toute ligne d instruction de code doit se terminer par un point virgule " ;" 4. Un bloc d instructions (définition d une fonction, boucle "while" ou "if"/"else"...) doit être délimité par des accolades ouvrantes "" puis fermantes "". 5. Toutes les variables doivent être déclarées, ainsi que leur type (int,float,...) avant d être utilisées. Un programme (ou "sketch") Arduino est constitué de 2 fonctions distinctes : 1. La fonction de configuration "void setup" exécutée une seule fois au lancement du programme. 2. La fonction "void loop" qui est ensuite exécutée indéfiniment en boucle. Remarque : On peut relancer le programme en actionnant le bouton poussoir "reset" sur la carte. Exemple : le programme "Blink" : i n t DEL = 5 ; void setup ( ) { pinmode (DEL, OUTPUT) ;On i n i t i a l i s e l a borne 5 de l Arduino ( nomm e "DEL" ) comme une s o r t i e. void loop ( ) { d i g i t a l W r i t e (DEL, HIGH) ;On met l a borne 5 au niveau l o g i q u e haut (+5V) : l a diode s allume. delay (1000) ; On attend un d e l a i de 1000ms ( s o i t 1 s ). d i g i t a l W r i t e (DEL, LOW) ;On met l a borne 5 au niveau l o g i q u e bas (0V) Nizar CHELLY-Amine CHARED 5 ISET RADES 2015

7 Formation Arduino Simulink/Android l a d i o d e s teint. d e l a y ( ) ; On a t t e n d un d e l a i de 1000ms ( s o i t 1 s ). Et ainsi de suite tant que le circuit est alimenté. 2 Présentation de la maquette La maquette est constituée d un capteur de position encodeur optique et un moteur à courant continu DC MOTOR.Le capteur et le moteur sont installés dans une maquette en bois. La figure suivante schématise la connexion de la carte Arduino UNO avec l entrée et la sortie du système (DC MOTOR + encodeur optique). La figure ci dessous montre une vue réelle de la maquette utilisée. Figure 3 Une vue de la maquette Commande du moteur à courant continu avec la carte Arduino Présentation des sorties analogiques (mode PWM) La carte Arduino Uno dispose de 6 sorties (3,5,6,9,10 et 11) qui peuvent être utilisées en mode PWM, c est-à-dire en modulation de largeur d impulsion.ce sont des signaux logiques binaires de fréquence constante (500Hz) mais de rapport cyclique variable. Figure 4 Description du signal PWM Lorsqu un moteur ou une lampe est alimenté par ce type de tension, tout se passe comme si il était alimenté par une tension continue ajustable entre 0V (rapport cyclique= 0) et 5V (rapport cyclique=255).ces sorties doivent être initialisées comme des sorties digitales. Vout = Vs Nizar CHELLY-Amine CHARED τo ; τc avec : τc = 2ms 6 (1) ISET RADES 2015

8 La syntaxe de l instruction permettant de générer le signal PWM est la suivante : analog- Write(pin, valeur) ; pin : la pin sur la quelle on souhaite envoyer le signal (3,5,6,9,10 ou 11). valeur : le rapport cyclique entre 0 et 255. Figure 5 Exemples de variation du rapport cyclique 3.2 Présentation du schéma électronique Le circuit électronique ci-dessous permet de contrôler un moteur à courant continue à partir des sorties PWM de la carte Arduino. Ce circuit doit amplifier le courant de sortie de la carte Arduino avec la résistance de protection 1KΩ) et doit aussi supporter la variation du rapport cyclique du signal PWM. Parmi les transistors pouvant satisfaire ces conditions on a choisit le TIP121. Les composants utilisés sont les suivants : Figure 6 Branchement de la carte Arduino UNO avec un moteur DC Le transistor TIP122 : C est un transistor Darlington NPN qui d après la fiche technique permet d amplifier le courant jusqu à 5A avec son gain d amplification au minimum β = 1000 La diode 1N4004 : Dans une charge inductive (bobines), le courant ne peut pas se stopper instantanément. Cette diode joue le rôle d une diode de roue libre qui permet au courant de s arrêter progressivement. Nizar CHELLY-Amine CHARED 7 ISET RADES 2015

9 3.3 Exemples de programme pour la commande du moteur Commande direct du moteur avec la carte Arduino i n t cmd=90 ; //commande void setup ( ) { pinmode (6,OUTPUT) ; // Configuration du pin 6 comme s o r t i e void loop ( ) { analogwrite (6,cmd) ;// T r a n s f e r t de c e s donnees sur l a pin 6 pour g e n e r e r l e Changement de la commande avec la carte Arduino via le moniteur série i n t cmd ; //commande void setup ( ) { S e r i a l. begin (9600) ; // ouvre l e port s e r i e, f i x e l e d e b i t 9600 bauds void loop ( ) { i f ( S e r i a l. a v a i l a b l e ( ) ) { cmd=( S e r i a l. read () 48) 100+( S e r i a l. read () 48) 10+( S e r i a l. read () 48) 1 ; // l e c t u r e des donnees a r r i v e e s analogwrite (5,cmd) ; // T r a n s f e r t de c e s donnees sur l a pin 6 pour g e n e r e r l e s i g n a l PWM S e r i a l. p r i n t l n (cmd) ; delay (100) ; // d e l a i de 100ms avant l a n o u v e l l e a c q u i s i t i o n 4 Exploitation de l encodeur optique avec la carte Arduino 4.1 Présentation du capteur L encodeur optique est un capteur de position extrêmement précis, il est constitué de deux parties : un disque renferment des bandes opaques et transparentes sur sa périphérie. un module qui sert à acquérir les alternances (opaque/transparent) pour les produire en formes d ondes analogiques. Le module contient un émetteur et un récepteur. La partie émettrice se compose : une diode luminescente LED(Light Emitting Diode). une lentille. La lumière émise par la diode se transforme en faisceaux parallèles à l aide de cette lentille située directement devant la diode. A l opposé de l émetteur (LED +Lentille) on trouve la partie réceptrice englobant les photodiodes et les comparateurs ayant comme sortie les chaines A et B. Lorsque le moteur tourne, le disque solidaire l axe du moteur permet l alternance entre bandes opaques et bandes transparents d où l interruption des faisceaux lumineux. Les photodiodes qui détectent ces interruptions sont l origine de la formation du signal de sortie. Ces détecteurs sont également espacés de telle sorte que sur une paire de détecteurs une période Nizar CHELLY-Amine CHARED 8 ISET RADES 2015

10 Figure 7 Circuit interne du module opaque (0 Volts) correspond à une période transparente (5 Volts) sur la paire adjacente. Deux comparateurs reçoivent ces signaux et produisent les sorties finales pour les canaux A et B. Le canal A est en quadrature de phase avec le canal B. 4.2 Principe de fonctionnement L encodeur optique fournit deux signaux carrés en quadrature, comme sur la capture cidessous : Ces deux signaux permettent de mesurer à la fois la vitesse et le sens de rotation. Figure 8 Les deux signaux issues de l encodeur optique La mesure de la vitesse se fait simplement en comptant le nombre d impulsions pendant un temps fixe. La cadence d échantillonnage utilisée pour l asservissement sera de 0.01 s Comptage du nombre d impulsions Il suffit pour cela d observer les courbes ci-dessus, obtenues alors que le moteur tourne dans le sens positif. On constate que : Lorsque la voie A passe au niveau haut, la voie B est au niveau bas Lorsque la voie A passe au niveau bas, la voie B est au niveau haut Quand le moteur tourne dans le sens positif, lors d une interruption sur la voie A, les niveaux de A et B sont donc inversés. Si le moteur tourne dans le sens négatif. On constate que : Lorsque la voie A passe au niveau haut, la voie B est au niveau haut. Lorsque la voie A passe au niveau bas, la voie B est au niveau bas. Nizar CHELLY-Amine CHARED 9 ISET RADES 2015

11 Quand le moteur tourne dans le sens négatif, lors d une interruption sur la voie A, les niveaux de A et B sont ont le même niveau. Le code correspondant sur l Arduino est détaillé dans le paragraphe suivant. 4.3 Programme d acquisition des impulsions l instruction de base pour l acquisition Le programme d acquisition des impulsions se base sur la fonction suivante : a t t a c h I n t e r r u p t ( i n t e r r u p t i o n, fonction, mode) Lorsqu une interruption externe survient cette instruction spécifie la fonction à appeler. La plupart des cartes Arduino ont deux interruptions externes : interruption externe n 0 sur la broche numérique 2 et interruption externe n 1 sur la broche numérique 3. Les paramètres de cette fonction sont : interruption : le numéro de l interruption (type int) fonction : la fonction à appeler quand l interruption survient ; la fonction doit recevoir aucun paramètres et ne renvoie rien. Cette fonction est également appelée une routine de service d interruption (ou ISR). mode : définit la façon dont l interruption externe doit être prise en compte. Quatre constantes ont des valeurs prédéfinies valables : LOW : pour déclenchement de l interruption lorsque la broche est au niveau BAS CHANGE : pour déclenchement de l interruption lorsque la broche change d état BAS/HAUT RISING : pour déclenchement de l interruption lorsque la broche passe de l état BAS vers HAUT (front montant) FALLING : pour déclenchement de l interruption lorsque la broche passe de l état HAUT vers l état BAS (front descendant) Code Arduino pour l acquisition i n t pina = 2 ; // Channel A connecte sur l i n t e r r u p t i o n externe numero 0 ( pin2 ) i n t pinb = 3 ; // Channel B connecte sur pin3 i n t ivalue = 0 ; // i n i t i a l i s a t i o n 0 void setup ( ) { S e r i a l. begin (9600) ; pinmode ( pina, INPUT) ; pinmode ( pinb, INPUT) ; a t t a c h I n t e r r u p t (0, encoderclick, RISING ) ; // r o u t i n e de s e r v i c e d i n t e r r u p t i o n ( ou ISR ). void loop ( ) { S e r i a l. p r i n t l n ( ivalue ) ; // l e c t u r e des implusions sur l e moniteur s e r i e delay ( 1 0 ) ; // p e r i o d e d e c h a n t i l l o n a g e Nizar CHELLY-Amine CHARED 10 ISET RADES 2015

12 void encoderclick ()// l a f o n c t i o n appelee par l i n t e r r u p t i o n externe numero 0 { // encoder must have turned one c l i c k because i n t e r r u p t 0 was t r i g g e r e d // read value from both encoder pins i n t vala = d i g i t a l R e a d ( pina ) ; i n t valb = d i g i t a l R e a d ( pinb ) ; // compare pins to determine in which d i r e c t i o n encoder was turned i f ( vala!= valb ){ // pina j u s t changed but pinb had not y e t changed // D i r e c t i o n must be c l o c k w i s e i f A changes b e f o r e B ivalue++; e l s e { // pina j u s t changed and pinb had already done so. // D i r e c t i o n must be counter c l o c k w i s e i f B changes b e f o r e A ivalue ; 5 L interfacage Arduino Matlab/Simulink 5.1 L environnement Matlab/Simulink C est un logiciel de calcul mathématique pour les ingénieurs et les scientifiques créé par Mathworks. MATLAB est un environnement de programmation pour le développement d algorithme, d analyse de données, de visualisation, et de calcul numérique. En utilisant MATLAB, la résolution des problèmes de calcul complexes se fait plus rapidement qu avec des langages de programmation traditionnels, tels que C, C++, et le Fortran. SIMULINK est un environnement pour la simulation, il fournit un environnement graphique interactif et un ensemble de bibliothèques de bloc qui permettent de concevoir, simuler, mettre en application, et examiner une variété de systèmes, tel que les systèmes de communications, de commandes, de traitement des signaux, de traitement visuel, et de traitement d image. Il existe trois possibilités d interfacer la carte Arduino avec Matlab/Simulink, à savoir : 1. Programmation de la carte Arduino Uno comme une carte d interface. 2. Utilisation du package ArduinoIO. 3. Utilisation du package Arduino Target. 5.2 ArduinoIO Cette solution consiste à utiliser la carte arduino comme une interface d entrées(analog Input)/sorties(Analog/Digital Output).Ce package permet de communiquer Matlab ou Simulink avec la carte Arduino via un câble USB. Elle consiste à pré-charger un programme dans la carte Arduino afin que celle-ci fonctionne en serveur. Ce programme consiste à "écouter" les requêtes envoyées via la liaison série (USB) et de répondre Nizar CHELLY-Amine CHARED 11 ISET RADES 2015

13 à ces requêtes en renvoyant l état d une entrée ou en modifiant l état d une sortie. Ces mêmes entrées/sortie sont vues dans matlab comme des entrées logiques ou analogiques (utilisation du CAN) ou des sorties analogiques (mode PWM) Pré-chargement du programme dans la carte Arduino 1. Télécharger le package ArduinoIO 2. Décompresser à la racine de votre disque dur, exemple E :\arduinoio 3. Ouvrir le dossier décompressé. 4. Aller vers : ArduinoIO\pde\adiosrv * 5. Charger le fichier adiosrv.pde vers le logiciel Arduino. 6. Televerser! * adiosrv est l abréviation de : Analog and Digital Input and Output Server for MATLAB. La carte Arduino UNO est maintenant configuré pour être utiliser comme une carte d interface Entrées/Sorties Installation du package ArduinoIO 1. Lancer Matlab2013 et placer vous dans le répertoire E :\arduinoio 2. Exécuter la commande : install-arduino 3. Fermer et relancer Matlab puis Simulink 4. Dans les bibliothèques se trouvent maintenant les blocs dans Arduino IO library. Figure 9 ArduinoIO Library Exploitation de la bibliothèque ArduinoIO sous Simulink Les blocs nécessaires pour notre objectif d asservissement sont les suivants : Figure 10 Les Blocs d ArduinoIO nécessaires pour la commande Real-Time Pacer : Ce bloc permet de ralentir le temps de simulation de sorte qu il synchronise avec le temps réel écoulé.le coefficient de ralentissement est contrôlable par l intermédiaire du paramètre Speedup. Arduino IO Setup : Pour configurer sur quel port la carte Arduino UNO est connectée. Pour cela il suffit de voir dans Gestionnaire des périphériques.voir Figure 4. Nizar CHELLY-Amine CHARED 12 ISET RADES 2015

14 Figure 11 Emplacement COM de la carte Arduino UNO Encodeur Read : Pour configurer à partir de quel pin on va realiser l aquistion des signaux issue du capteur (channel A et channel B). Encodeur Reset : Pour configurer la période de la mise à zéro de l encodeur. Arduino Analog Write : Pour configurer à partir de quel pin [3,5,6,9,10,11] on va envoyer la commande en PWM vers l actionneur Exploitation du package ArduinoIO sous Matlab Le package ArduinoIO offre une panoplie de commandes permettant d écrire un programme sous Matlab (M-file). Pour accéder à ces commandes il faut créer un objet arduino dans l espace de travail et spécifier le port sur lequel la carte arduino est connecté avec la commande : >> a = arduino( port ); (2) Parmi les commandes qui sont accessibles on retrouve : pinmode Exemple :a.pinmode(11, output ) // configurer la pin 11 comme sortie. digitalread Exemple :val=a.digitalread(4) ; // lecture de l etat de la pin 4 digitalwrite Exemple :a.digitalwrite(13,0) ; // mettre la pin 13 à l etat bas 0V analogread Exemple :val=a.analogread(0) ; // lecture de la pin 0 de l ADC analogwrite Exemple :a.analogwrite(3,10) ; // envoyer sur la pin 10 un signal pwm de rapport cyclique 10/ Arduino Target Embedded Coder Support Package for Arduino permet de créer des applications Simulink qui vont fonctionner de façon autonome sur la carte Arduino. on dit que la carte Arduino est devenue une cible (Target) et elle peut fonctionner d une façon autonome (sans avoir recours à Matlab/Simulink). Dans la suite, on utlisera les blocs Simulink offert par le package ArduinoIO Library. 6 Commande du moteur avec Arduino/Simulink 6.1 Utilisation du package ArduinoIO Libraray 1. Pré-chargement de adiosrv.pde sur la carte Arduino UNO 2. Développement du modèle Simulink Nizar CHELLY-Amine CHARED 13 ISET RADES 2015

15 Figure 12 Envoie de la commande PWM sous ArduinIO Library 7 Exploitation de l encodeur optique avec Arduino/Simulink 1. Pré-chargement de adiosrv.pde sur la carte Arduino UNO 2. Développement du modèle Simulink Figure 13 acquisition des impulsions sous Arduino IO Library 8 Modélisation du système Le but de cette partie est de déterminer la fonction de transfert échantillonnée de notre système en boucle ouvert notée G(z).L entrée du système est la tension u(z) en volts et la sortie est la vitesse V (z) en (implusion/10ms). 8.1 Présentation de l étape d identification avec Matlab Cette étape est constituée de deux parties. La première est assuré par l environnement Simulink et le package ArduinoIO pour l envoie et l acquisition des données. La deuxième partie est assuré par l outil System identification sous Matlab. Figure 14 L utilisation de l outil System Identification Nizar CHELLY-Amine CHARED 14 ISET RADES 2015

16 8.2 Acquisition de la réponse indicielle du système Plusieurs méthodes sont utilisées pour la modélisation d un système comme la détermination des équations physiques du système, l étude de la réponse d un système à une entrée...etc. Dans notre cas on va identifier notre système en étudiant la réponse de notre système à échelon de tension. Le modèle Simulink permettant de réaliser l acquisition de la réponse du système à un échelon de tension est le suivant : Figure 15 Modèle Simulink pour la détermination de la réponse indicielle 8.3 Détermination de la fonction de transfert G(z) Après avoir déterminer la réponse du système, on passe à la détermination de la fonction de transfert G(z). 1. Ouvrir l outil System identification Tool Figure 16 L interface de l outil System identification Nizar CHELLY-Amine CHARED 15 ISET RADES 2015

17 2. Cliquer sur import data et choisir Time domain data. Figure 17 Choix des types des données Time Domain Data 3. Entrer le nom de la variable Input et la variable Output ainsi que temps de starting time et sample time qu on a utiliser lors de l identification avec Simulink.Enfin cliquer sur Import. Figure 18 Saisie des données relatives aux Input et Output du système 4. Cliquer sur Estimate et choisir Transfer Function Models Nizar CHELLY-Amine CHARED 16 ISET RADES 2015

18 Figure 19 Choix de la description du système à estimer Tranfer Function 5. Entrer le nombre de pôle et de zéro et cliquer sur Discrete-Time ensuite cliquer surestimate. Figure 20 Choix du nombre des pôles et zéros de la fonction de transfert à estimer 6. Vous pouvez revenir à l interface System Identification Tool et cliquer deux fois sur tf1 pour voir le résultat. Nizar CHELLY-Amine CHARED 17 ISET RADES 2015

19 Figure 21 Visualisation du résultat de l estimation 7. Une fenêtre apparait dans laquelle vous trouvez G(z). Figure 22 Récupération de la fonction de transfert estimée Nizar CHELLY-Amine CHARED 18 ISET RADES 2015

20 9 Implémentation de la commande sur Simulink Dans cette partie l implémentation du régulateur se fera sur Simulink. Figure 23 Schéma synoptique de l asservissement à implémenter L étape de la commande du système est constituée de deux parties. La première partie consiste à utiliser l outil Matlab PID Tuning pour déterminer les différents paramétrés de notre régulateur PI à savoir K p,k i en fonction de notre objectif de commande. La deuxième partie consiste à implémenter le régulateur sur Simulink. Figure 24 Emplacement de l outil PID tuning Nizar CHELLY-Amine CHARED 19 ISET RADES 2015

21 9.1 Synthèse du régulateur numérique 1. Ouvrir l outil PID Tuner Figure 25 Interface de l outil PID tuning 2. Cliqueur sur Import new plant, une nouvelle fenêtre apparait. Figure 26 Importation du modèle estimé 3. Une nouvelle fenêtre apparait dans laquelle vous allez sélectionner tf1 ensuite cliquer sur import puis close. Nizar CHELLY-Amine CHARED 20 ISET RADES 2015

22 Figure 27 Interface de l outil Import Linear System 4. Revenir à la fenêtre PID Tuner, vous pouvez choisir le type de régulateur à implémenter et les objectifs de la commande en boucle fermé et voir la réponse de la sotie du système. Figure 28 Choix du régulateur à implémenter Nizar CHELLY-Amine CHARED 21 ISET RADES 2015

23 5. Cliquer sur la flèche de show parameter pour voir les paramétrés utilisés de votre régulateur ainsi que les performances du système en boucle fermé. Figure 29 Récupération des paramétrés du régulateur 9.2 Implémentation de la commande sous Simulink La boucle d asservissement à implémenter sur Simulink se traduit par le schéma suivant : L asservissement de notre procédé est assuré par le schéma Simulink ci-dessous qui regroupe la consigne, le comparateur, le correcteur PI(z), l acquisition de vitesse et l envoie de la commande PWM. Figure 30 Modèle Simulink d asservissement de température L appui deux fois sur le bloc PID(z) permet d introduire les paramétrés K p K i et de configurer le régulateur selon notre objectif de commande. Figure 31 Saisie des paramétrés du régulateur Nizar CHELLY-Amine CHARED 22 ISET RADES 2015

24 10 Implémentation de la commande sur la carte Arduino Dans cette partie l implémentation du régulateur directement sur la carte Arduino UNO. Figure 32 Schéma synoptique de l asservissement à implémenter 10.1 Le régulateur PID Numérique Ce type de correcteur est défini par l équation différentielle suivante : U P ID (t) = K p e(t) + K i t 0 e(τ)dτ + K d d e(t) (3) dt L équation de contrôle PID numérique peut être exprimée en de diverses manières, mais une formulation générale est donnée par l équation suivante [3] : P ID = Kp erreur + Ki (erreur t) + Kd (erreur erreur précédente) t (4) L implémentation du régulateur PID sur la carte Arduino se fera de la manière suivante [3] : PID : Error = Setpoint Actual I n t e g r a l = I n t e g r a l + ( Error dt ) D e r i v a t i v e = ( Error Previous_error )/ dt Drive = ( Error kp) + ( I n t e g r a l ki ) + ( D e r i v a t i v e kd) Previous_error = Error wait ( dt ) GOTO PID 10.2 L implémentation du régulateur PID Le code suivant permet d implémenter le régulateur PID sur la carte Arduino. Implémentation direct de la consigne sur la carte Arduino f l o a t d e l t a _ e r r e u r =0 ; f l o a t somme_erreur = 0 ; // Somme des e r r e u r s pour l i n t g r a t e u r f l o a t kp = ; // C o e f f i c i e n t p r o p o r t i o n n e l f l o a t k i = ;// C o e f f i c i e n t i n t e g r a t e u r f l o a t ep, up, v, u, e, i n t e g r a l, cmd ; f l o a t d e r i v e ; i n t pina = 2 ; // Encoder pin A connects to i n t e r r u p t 0 (D2) i n t pinb = 3 ; // Encoder pin B connects to D4 i n t ivalue = 0 ; //A v a r i a b l e that w i l l be i n c r e a s e d or decreased Nizar CHELLY-Amine CHARED 23 ISET RADES 2015

25 i n t consigne ; void setup ( ) { S e r i a l. begin (9600) ; pinmode ( pina, INPUT) ; pinmode ( pinb, INPUT) ; a t t a c h I n t e r r u p t (0, encoderclick, RISING) ;// r o u t i n e de s e r v i c e d i n t e r r u p void loop ( ) { v=abs ( ivalue ) ; e=50 v ; d e l t a _ e r r e u r = ( e ep ) / ; somme_erreur=somme_erreur+e ; cmd = kp e + k i somme_erreur ; analogwrite (5,cmd (255/5)) ; S e r i a l. p r i n t l n ( e ) ;// envoie de l a donnee sur l e port s e r i e // delay (10) ;// p e r i o d e d e c h a n t i l l o n a g e ep=e ; ivalue =0 ; delay (10) ;// p e r i o d e d e c h a n t i l l o n a g e void encoderclick ()// l a f o n c t i o n a p p e l e par l i n t e r r u p t i o n externe num { // encoder must have turned one c l i c k because i n t e r r u p t 0 was t r i g g e r e d // read value from both encoder pins i n t vala = d i g i t a l R e a d ( pina ) ; i n t valb = d i g i t a l R e a d ( pinb ) ; // compare pins to determine in which d i r e c t i o n encoder was turned i f ( vala!= valb ){ // pina j u s t changed but pinb had not y e t changed // D i r e c t i o n must be c l o c k w i s e i f A changes b e f o r e B ivalue++; e l s e { // pina j u s t changed and pinb had already done so. // D i r e c t i o n must be counter c l o c k w i s e i f B changes b e f o r e A ivalue ;. Changement de la consigne avec le moniteur série f l o a t d e l t a _ e r r e u r =0 ; f l o a t somme_erreur = 0 ; // Somme des e r r e u r s pour l i n t g r a t e u r f l o a t kp = ; // C o e f f i c i e n t p r o p o r t i o n n e l f l o a t k i = ;// C o e f f i c i e n t i n t e g r a t e u r Nizar CHELLY-Amine CHARED 24 ISET RADES 2015

26 f l o a t ep, up, v, u, e, i n t e g r a l, cmd ; f l o a t d e r i v e ; i n t pina = 2 ; // Encoder pin A connects to i n t e r r u p t 0 (D2) i n t pinb = 3 ; // Encoder pin B connects to D4 i n t ivalue = 0 ; //A v a r i a b l e that w i l l be i n c r e a s e d or decreased i n t consigne ; void setup ( ) { S e r i a l. begin (9600) ; pinmode ( pina, INPUT) ; pinmode ( pinb, INPUT) ; a t t a c h I n t e r r u p t (0, encoderclick, RISING) ;\\ // r o u t i n e de s e r v i c e d i n t e r r u p t i o n ( ou ISR ). void loop ( ) { v=abs ( ivalue ) ; i f ( S e r i a l. a v a i l a b l e ( ) ) { consigne=( S e r i a l. read () 48) 100+( S e r i a l. read () 48) 10+\\ ( S e r i a l. read () 48) 1 ; // l e c t u r e des d o n n e s a r r i v e s e=consigne v ; d e l t a _ e r r e u r = ( e ep ) / ; somme_erreur=somme_erreur+e ; cmd = kp e + k i somme_erreur ; analogwrite (5,cmd (255/5)) ; S e r i a l. p r i n t l n ( consigne ) ; // envoie de l a donnee sur l e port s e r i e // delay ( 1 0 ) ; // p e r i o d e d e c h a n t i l l o n a g e ep=e ; ivalue =0 ; delay ( 1 0 ) ; // p e r i o d e d e c h a n t i l l o n a g e void encoderclick ()\\ // l a f o n c t i o n appelee par l i n t e r r u p t i o n externe n 0 { // encoder must have turned one c l i c k because i n t e r r u p t 0 was t r i g g e r e d // read value from both encoder pins i n t vala = d i g i t a l R e a d ( pina ) ; i n t valb = d i g i t a l R e a d ( pinb ) ; // compare pins to determine in which d i r e c t i o n encoder was turned i f ( vala!= valb ){ // pina j u s t changed but pinb had not y e t changed // D i r e c t i o n must be c l o c k w i s e i f A changes b e f o r e B Nizar CHELLY-Amine CHARED 25 ISET RADES 2015

27 ivalue++; e l s e { // pina j u s t changed and pinb had already done so. // D i r e c t i o n must be counter c l o c k w i s e i f B changes b e f o r e A ivalue ; Nizar CHELLY-Amine CHARED 26 ISET RADES 2015

28 Références [1] http :// [2] http :// [3] PID Control : A brief introduction and guide, using Arduino. [4] PID controller http ://en.wikipedia.org/w/index.php?title=pid controller soldid= Nizar CHELLY-Amine CHARED 27 ISET RADES 2015