Réalisation Et Commande D'un Bras Manipulateur À Quatre Degrés de Liberté
Réalisation Et Commande D'un Bras Manipulateur À Quatre Degrés de Liberté
Thème :
Tous nos remerciements vont également aux membres de jury pour nous
avoir fait l’honneur de juger ce modeste travail.
Nos remerciements vont également à toutes les personnes qui nous ont
aidés et soutenue de près ou de loin dans la réalisation de ce travail.
i
Dédicace
Aux êtres les plus chers aumonde « MES PARENTS»Aucune dédicace ne saurait
exprimer l’amour, l’estime, le dévouement et le respect que j’ai
toujours eu pour vous.
Rien au monde ne vaut les efforts fournis jour et nuit pour mon éducation et mon bien être. Ce
travail est le fruit de vos sacrifices que vous avez consentis pour mon éducation et ma
formation.
A mes très chers frères
Les mots ne suffisent guère pour exprimer l’attachement, l’amour et l’affection que je porte pour
vous.
Mohammed et sa femme Sonia,Madjid et sa femmeNawel.
Ainsi qu’à mes adorables nièces : Lwiza ,Lidia et Meriem. Que DIEU leurs offre le bonheur.
Rosa
iii
Dédicace
A mon très chère père Allah yarhamo
Qui nous a élevés dans la droiture, l'intégrité et l'altruisme et nous a quitté si jeune pour un
monde meilleur avant de voir sa vision se réaliser.
Ce travail est une preuve de reconnaissance de la part d'un enfant qui a toujours prié pour le
salut de son âme. Puisse Dieu, le Tout puissant, l'avoir en sa Sainte Miséricorde. Amen
Que dieu vous bénisse et vous garde dans son vaste paradis.
ii
Table des matières
Chapitre 1: Généralités
v
2.4.1. Présentation du bras manipulateur .............................................................................. 24
2.4.2. Notion de position ...................................................................................................... 24
[Link]. Coordonnées cartésiennes .................................................................................... 25
[Link]. Coordonnées cylindriques .................................................................................... 25
2.4.3. Notion d’orientation ................................................................................................... 27
2.4.4. Modèle Géométrique direct ........................................................................................ 27
[Link]. Paramètre de DENAVET- HARTENBERG (D-H) ............................................. 27
[Link]. Modélisation du bras manipulateur réalisé .......................................................... 28
[Link]. Identification des paramètres de DH de BM1...................................................... 30
2.4.5. Le modèle géométrique inverse .................................................................................. 31
2.4.6. Modélisation du moteur électrique à courant continu ................................................ 33
[Link]. Les équations électromécaniques ......................................................................... 33
[Link]. Modèle d’état du moteur ...................................................................................... 34
2.5. Conclusion ......................................................................................................................... 37
vi
[Link]. Logiciel de programmation Arduino.................................................................... 45
[Link]. Logiciel LABVIEW (Laboratory Virtual Instrument Engineering Workbench). 46
[Link].1 Présentation du logiciel ............................................................................................. 46
.................................................................................................................................................. 47
[Link].2. Présentation de l’interface ........................................................................................ 47
3.3.2. Commande .................................................................................................................. 50
[Link]. Commande manuelle............................................................................................ 50
[Link].2. Commande analogique des articulations .................................................................. 50
[Link] .Commande Automatique ..................................................................................... 52
[Link].1. Commande par le modèle géométrique inverse du bras .......................................... 52
[Link] Régulateur PID...................................................................................................... 54
[Link].1. L’action Proportionnel .......................................................................................... 54
[Link].2. L’action Intégrale ................................................................................................. 55
[Link].3. L’action Dérivé ..................................................................................................... 55
[Link].4. Simulation du régulateur PID sur MATLAB / Simulink ..................................... 56
[Link]. La régulation par la logique floue ........................................................................ 57
[Link].1. Les trois parties de la structure générale du contrôleur ........................................ 58
[Link].2. Les étapes de conception de contrôleur flou FLC ................................................ 59
[Link].3. Simulation du contrôleur flou sous MATLAB / Simulink ....................................... 59
vii
4.4. Les résultats de simulation sous Matlab ............................................................................ 70
4.4.1. Contrôleur PID en utilisant l'outil de conception SISO de Matlab............................. 70
4.4.2. Contrôleur PID sous Simulink .................................................................................... 70
4.4.3. Résultat de simulation du contrôleur flou sous simulink ........................................... 71
4.5. Le BM1 final ..................................................................................................................... 72
4.5 Etude socio-économique .................................................................................................... 72
4.6
Conclusion……………………………………………………………………………………73
Références bibliographiques………………………………………………………………….73
viii
Liste des figures
Chapitre 1 : Généralités
viii
Fig.2.13. Représentation schématique du moteur CC ............................................................. 33
Fig.2.14. Schéma fonctionnel du moteur CC. .......................................................................... 36
ix
Chapitre 4 : Tests et résultats
x
Liste des tableaux
xi
Liste des abréviations
Abréviation Signification
xii
Liste des symboles
V Tension [V]
xiii
INTRODUCTION
GENERALE
Introduction générale
Introduction générale
Aujourd’hui, il existe plusieurs types de robots conçus pour des tâches bien spécifiques.
Les robots industriels actuellement en service sont des robots de type manipulateur. Ils sont
bien implantés dans les procédés de fabrication modernes et sont employés pour augmenter le
volume de production et améliorer la qualité du produit dans les chaînes de montage de
l’industrie automobile, ils remplacent les ouvriers dans les tâches pénibles, répétitives ou
dangereuses (peinture, soudure…).
Dans ce travail de mémoire, nous nous sommes intéressés aux robots manipulateurs
pour des applications en robotique industrielle.L’objectif de notre travail est de réaliser et
commander un bras manipulateur à 4 degrés de liberté en développant une carte de commande
autour d’une carteArduino.
Le premier chapitre donne un bref historique sur la robotique et les différents types de
robots, analyse aussi les différents constituants d’un robot manipulateur quiest l’objet de notre
étude. L’objet du premier chapitre est d’apporter quelques définitions de base et décrire les
constituants technologiques d'un robot et enfin définir les principaux termes du domaine.
1
CHAPITRE 1 :
CH
GEN
GENERALITES
Chapitre 1 Généralités
1.1. Introduction
La robotique est considérée comme un des grands axes de progrès scientifiques et
techniques, elle consiste à l’automatisationde nombreux secteurs de l’activité humaineafin par
exemple, d’augmenter la productivité dans les entreprises, stimuler la compétitivité entre eux
et surtout pouvoir travailler dans des zones à haut risque (espace, démantèlement nucléaire,
déminage ...etc.).
1.2. Définitions
1.2.1. Définition d’un robot
Appareil automatique capable de manipuler des objets ou d'exécuter des opérations
selon un programme fixe, modifiable ou adaptable [1].
3
Chapitre 1 Généralités
4
Chapitre 1 Généralités
5
Chapitre 1 Généralités
[Link]
ation de
d l'approvisionnement annuel mondial en robots
rob
industriels [11].
[Link] mobile[12]
6
Chapitre 1 Généralités
7
Chapitre 1 Généralités
8
Chapitre 1 Généralités
Une structure mécanique articulée peut être représentée par une architecture composée
de plusieurs chaînes de corps rigides assemblés par des liaisons appelées articulations. Les
chaînes peuvent être dites soit ouvertes ou en série dans lesquelles tous les corps ont au plus
deux liaisons, ou bien arborescentes où au moins l’un des corps a plus de deux liaisons. Les
chaînes peuvent aussi être fermées dans lesquelles l’organe terminal est relié à la base du
mécanisme par l’intermédiaire de plusieurs chaînes [17].
9
Chapitre 1 Généralités
Fig.1.10
10. Architecture d’un robot [12].
10
Chapitre 1 Généralités
1.8.1. La base
La base du manipulateur est fixée sur le lieu du travail. Ceci est le cas de la quasi-
totalité des robots industriels [18].
1.8.2. Le porteur
Le porteur représente l’essentiel du système mécanique articulé (segment, articulation,
actionneur, organe terminal), il a pour rôle d’amener l’organe terminal dans une situation
imposée[18].Il est constitué de :
[Link]. Segment
Corps solides rigides susceptibles d’être en mouvement par rapport à la base du porteur,
et les uns par rapport aux autres [18].
[Link]. Articulation
Une articulation liédeux corps successifs en limitant le nombre de degré de liberté, de
l'un par rapport à l’autre [18].
[Link].2. Articulationprismatique
Il s'agit d'une articulation de type glissière, notée P, réduisant le mouvement entre deux
corps à une translation le long d'un axe commun. La situation relative entre les deux corps est
mesurée par la distance le long de cet axe [20].
11
Chapitre 1 Généralités
Pour les robots devant manipuler de très lourdes charges (par exemple, une
pellemécanique), les actionneurs sont le plus souvent hydrauliques, agissant en translation
(vérin, hydraulique) ou en rotation (moteur hydraulique). (Les actionneurs pneumatiques sont
d'un usage général pour les manipulateurs à cycles(robots tout ou rien)).
Un manipulateur à cycles est une structure mécanique articulée avec un nombre limité
de degrés de liberté permettant une succession de mouvements contrôlés uniquement par des
capteurs de fin de course réglables manuellement à la course désirée (asservissement en
position difficile dû à la compressibilité de l'air).
1.8.4.L’organeterminal
Il s'agit d'une interface permettant au robot d'interagir avec son environnement. Un
organe terminal peut être multifonctionnel, au sens où il peut être équipé de plusieurs
dispositifs ayant des fonctionnalités différentes. Il peut aussi être monofonctionnel, mais
interchangeable.
12
Chapitre 1 Généralités
13
Chapitre 1 Généralités
Pour certains robots, par exemple les robots de peinture, qui doivent suivre une
trajectoire complexe et difficile d’être exprimée mathématiquement, un opérateur humain
spécialiste de la tâche effectue la trajectoire en guidant le bras du robot à l’aide d’un« pantin»,
et l’entièreté de la trajectoire est mémorisée par le robot et [22], fig.1.16 représente les
robotsprogrammables [23].
14
Chapitre 1 Généralités
Fig.
Fig.1.18. Structure d’un Robot cartésien [18].
Fig
Fig.1.19. Structure d’un robot cylindrique [18].
[18]
15
Chapitre 1 Généralités
16
Chapitre 1 Généralités
Exemples de robots utilisés pour des tâches simples : robots soudeurs par points
etrobots soudeurs à l'arc.
17
Chapitre 1 Généralités
- Robot pompiste.
- Robot de construction.
- Robot Computer Motion.
- Robot Assistance aux Personnes Handicapées.
1.12. Conclusion
Dans ce chapitre, nous avons donné un aperçu général sur la robotique : l’historique des
robots, leurs structures, leurs utilisations, leurs différents types,leurs classificationsainsi que
leurs domaines d'application ce qui va nous servir pour la construction de notre bras.
18
CHAPITRE 2 :
CH
DESCRIPT
RIPTION MECANI
CANIQUE
ET
T MODELISATION
MO TION
Chapitre 2 Description mécanique et modélisation
2.1. Introduction
Dans tout système en robotique la mécanique et l’électronique sont liées, ceci se
matérialise par l’étude des actionneurs des chaînes cinématiques associées et aussi par l’étude
des capteurs qui constituent la source d'information. L’objectif de notre travail est de réaliser
et commander un bras manipulateur à 4 degrés de liberté en utilisant une carte Arduino. Dans
ce chapitre, on va d’abord décrire la partie mécanique de notre bras manipulateur, puis on va
passer à la modélisation, qui consiste à représenter les aspects importants d’un système en
décrivant les relations entre ses différentes grandeurs par des relations mathématiques.
Pour réaliser le BM1 nous avons opté à utiliser le [Link] choix de ce matériau a
été basé sur sa légèreté, sa disponibilité et son coût [Link] figure ci-dessous montre
les pièces de la structure mécanique du bras manipulateur sous le logiciel SolidWorks :
19
Chapitre 2 Description mécanique et modélisation
[Link]. La base
La base est le socle fixe du bras, elle contient un servomoteur qui permet la rotation du
bras de 0° à 180°.Lorsque nous avons assemblé tout le bras, nous avons remarqué une légère
inclinaison de la base à cause du poids exercé sur elle. Comme le montre la figure suivante :
[Link] du BM1.
[Link]. L’épaule
Elle est liée à la base à travers la deuxième articulation (servomoteur),qui permet la rotation
de 0° à 180°
[Link]. Le coude
Il est lié à l’épaule par la troisième articulation, qui permet la rotation de 0° à 180°
[Link]. Le poignet
Il lié au coude par la quatrième articulation, qui permet la de 0° à 180°.
20
Chapitre 2 Description mécaniqu
canique et modélisation
[Link]. La pince
C’est l’organe terminal
inal du bras manipulateur, un servomoteur qui
ui permet
per la rotation de
0° à 180°, il assure l’ouvert
uverture et la fermeture de la pince, commee le montre la figure
suivante.
21
Chapitre 2 Description mécanique et modélisation
Les trois actionneurs les plus utilisés sont les actionneurs hydrauliques surtout pour les
grands robots qui peuvent soulever plusieurs dizaines de kilogrammes, les moteurs électriques
souvent utilisés et les actionneurs pneumatiques qui n’exigent pas d’asservissements (robot a
mouvement séquentiels). Dans notre projet nous avons utilisé les actionneurs électriques
(servomoteur).
22
Chapitre 2 Description mécanique et modélisation
23
Chapitre 2 Description mécanique et modélisation
L’utilisation des capteurs proprioceptifs n’était pas également nécessaire vu que les
servomoteurs contiennent un capteur potentiométrique qui sert à l’asservissement de position.
2.4. Modélisation
2.4.1. Présentation du bras manipulateur
Le bras manipulateur est un système de positionnement où les forces agissantes
auniveau des articulations sont produites par des actionneurs. Ces derniers peuvent être de
type pneumatique ouélectrique (servomoteur dans notre cas).
24
Chapitre 2 Description mécaniqu
canique et modélisation
Les six coordonnéess sont nécessaires et suffisantes pour placer unn objet
obje dans l’espace.
25
Chapitre 2 Description mécanique et modélisation
Les coordonnées cylindrique sont liées aux cordonnéescartésiennes par les relations
suivantes :
X = ρ cos(φ)
Y = ρ sin(φ) (2.1)
Ѳ = Ѳ
Et inversement :
P = +
Φ = atang (2.2)
Ѳ = Ѳ
Avec Φϵ [0,2π]
Un point est repéré par ses coordonnées(r, Ѳ, Φ) dites sphérique illustrées sur la figure
suivante :
= !"#$(Ѳ)cos (Φ)
y = r sin(Φ) sin(Ѳ) (2.3)
z = r cos(Ѳ)
Et inversement :
!= + +(
Ѳ = atan (z, + ) (2.4)
Φ = atan2(x, y)
26
Chapitre 2 Description mécanique et modélisation
Ѳϵ[0,2π]
Avec : ,
Φϵ[0,2π]
X= f(q) (2.5)
Dans le cas d’une chaine cinématique simple ouverte, il peut être représenté par la matrice
43,5 qui se calcule par :
La matrice 43,5 représente la position et l’orientation, elle est exprimée dans le repère de
référence 23 de l’organe terminal (effecteur) du robot [26].
1/ ∝j : angle entre les axes ;896 <= ;8 correspondant à une rotation autour de >896
27
Chapitre 2 Description mécanique et modélisation
3/ θj : angle entre l’axe xj-1 et >8 correspondant à une rotation autour de zj.
896
64 =Rot(x,?8 ) ×Trans(x,dj) ×Rot (z,Ѳ8 ) × Trans (z,!8 ).(2.7)
BѲ8 −"Ѳ8 0 E8
896 D?8 "Ѳ8 D?6 DѲ8 −"?8 −!8 "?8
84 = A D?8 !8 D?8
G(2.8)
"?8 "Ѳ8 "?8 DѲ8
0 0 0 1
Le bras manipulateur doit suivre une trajectoire précise lors du déplacement d’un objet à
un endroit désigné par les coordonnées X, Y, et [Link] tâche nécessite l’utilisation du modèle
géométrique direct et [Link] notre cas le modèle cinématique et le model dynamique ne
sont pas nécessaires puisque la vitesse et le temps d’exécution de la tâche ne sont pas
importants [26].
Ces articulations sont actionnées par des servomoteurs qui s’actionnent par un signal de
commande. Le tableau 2.1 ci-dessous donne les caractéristiques techniques du BM1 réalisé.
28
Chapitre 2 Description mécaniqu
canique et modélisation
Tableau
leau 2.1. Caractéristiques techniques du BM1.
Caractér
aractéristiques techniques du bras manipulateur
Nombre d’articulati
ticulation 4
Actionneur Servomote
omoteurs
Rotations
La base 180°
L’épaule 180°
Le coude 180°
Le poignet 180°
La pince 180°
29
Chapitre 2 Description mécanique et modélisation
Segment Ѳ8 E8 ?8 !8
1 Ѳ6 E6 π/2 0
2 Ѳ 0 0 !
3 ѲH 0 0 !H
4 ѲI 0 -π/2 0
BѲ −"Ѳ 0 E BѲ −"Ѳ 0 0
D? "Ѳ D? DѲ −"? −! "? "Ѳ DѲ 0 0G.(2.10)
4 6J A G=A
"? "Ѳ "? DѲ D? ! D? 0 0 1 !
0 0 0 1 0 0 0 1
>I LI ;I MI
3 >I LI ;I MI
I4 = A G. (2.14)
>IN LIN ;IN MIN
0 0 0 1
30
Chapitre 2 Description mécanique et modélisation
Par identification avec les élémentsde la matrice dupassage homogène obtenu par les
coordonnées opérationnelleset avec la convention :
On obtient :
1ére colonne :
>I = SѲI
2émecolonne:
LI J CѲI
3émecolonne:
;I =0
4éme colonne :
MI =0
MI = −!H − !
MIN =0
31
Chapitre 2 Description mécaniqu
canique et modélisation
Le modèle géométrique
trique inverse permet de calculer la positionn de chaque
c liaison du
robot en fonction de la position
sition et de l’orientation de l’organe terminale [266].
q = c 96 (x) (2.15)
Où x est le vecteur
ur des coordonnées opérationnelles exprimées
ées dans
d le repère de
référence 23 et q les variables
bles articulaires.
ar
Fig.2.12
12. Les vecteurs des variables articulaires.
Avec :
VX d \VW d 9Z[ d 9 Z] d
DS" (T)) = (2.15)
d Z[ Z]
`ab(e)
T = =U$96 (2.17)
^_`(e)
Ѳ = (180- T)(2.18)
VW
ß==U$96 (V )(2.19)
X
Ѳ6 =ß-?(2.
(2.21)
32
Chapitre 2 Description mécanique et modélisation
f
f==U$96 ( hg )(2.22)
g
ѲH = c − Ѳ − Ѳ6 (2.23)
E =i>j d + Lj d (2.24)
ѲI =DS" 96 ( ;j /E )(2.25)
L'équation (2.27) illustre la relation entre force électromotrice produite et la vitesse de l'arbre :
Où
vn : Désigne force électromotrice arrière.
33
Chapitre 2 Description mécanique et modélisation
Equation mécanique
Ewu (=)
τr (=)=tr +cv (=)+Br wr (=) (2.28)
E=
ϕ : Le flux magnétique ;
ya€ (•) ~ ƒ 6
=− ‚€ wr (=) − ‚ € il (t) + k (=)(2.31)
yx € € ‚€ l
yѲ(x)
= wr (=) (2.32)
yx
Ces équations, écrites sous la forme matricielle, permettent d’obtenir le modèle d’état de
la machine, il est donné par :
„ = … (=) + †‡(=)
>(=) (2.33)
6 (=)= #l (=)
(=) = Ѳ(=) (2.35)
H (=) = wu (=)
34
Chapitre 2 Description mécanique et modélisation
ya€ (•)
Œ 6„ (=) =
yx
Š yѲ(x)
„ (=) = yx (2.36)
‹
Š „ (=) = yz{ (x)
‰ H yx
ƒ € € ’
‘− ‚€ 0 − ‚€
6
6„ 6 (=)
‚€
• „ Ž=• 0 0 1 G “ (=)”+ “ 0 ” kl (t) (2.37)
• ’• |{
H„ H (=)
•}{ 0 − }{ 0
6 (=)
(=) = [0 1 0] “ (=)”(2.38)
H (=)
Pour dériver la fonction de transfert du moteur à courant continu, le système est divisé
en trois composantes principales de l'équation : équation électrique, équation mécanique et
électromécanique.
Ѳ(x) ~•
•›œ—OxOœ5 (")= = (2.40)
–(—) —[}{ ‚€ ™ ] \(‚€ |{ \ƒ€ }€ )—\~• ~š ]
35
Chapitre 2 Description mécanique et modélisation
Le schéma fonctionnel du moteur CC est illustré dans la figure (2.14), avec la valeur
nulle de couple de charge 4• [29].
36
Chapitre 2 Description mécanique et modélisation
[Link]
37
CHAPITRE
PITRE 3 : COMMAN
MMANDE
DU BRAS
RAS MANIPULATLATEUR
Chapitre 3 Commande du bras manipulateur
3.1. Introduction
Généralement, la fonction d’un robot manipulateur est de situer dans l’espace son
organe terminal, la commanded’un bras manipulateur nécessite la commande de ses
articulations une à une, afin de réaliser une tâche. Dans ce chapitre, on cherche à commander
le bras manipulateur BM1 en position.
[Link]
Cet environnement matériel et logiciel permet à l'utilisateur de formuler ses projets par
l'expérimentation directe avec l'aide de nombreuses ressources disponibles en ligne. Pont
tendu entre le monde réel et le monde numérique, Arduino permet d'étendre les capacités de
relations humain/machine ou environnement/machine.
38
Chapitre 3 Commande du bras manipulateur
Microcontrôleur ATmega2560
Tension de fonctionnement 5V
Tension d’alimentation 7-12V
(recommandée)
Tension d’alimentation (limites) 6-20V
Broches E/S numériques 54 (dont 14 disposent d'une sortie PWM)
Broches d’entrées analogiques 16 (utilisables en broches E/S numériques)
Intensité maxi disponible par 40 mA (ATTENTION : 200mA cumulé
broche E/S (5v) pour l'ensemble des broches E/S)
Intensité maxi disponible pour la 50 mA
sortie 3.3v
Intensité maxi disponible pour la Fonction de l'alimentation utilisée - 500 mA
sortie 5v max si port USB utilisé seul
Mémoire programme Flash 256 KB dont 8 KBsont utilisés par le boot
loader
Mémoire SRAM (mémoire 8 KB
volatile)
Mémoire EEPROM (mémoire 4 KB
non volatile)
Vitesse d’horloge 16 MHz
Longueur 101.52 mm
Largeur 53.3 mm
Poids 37 g
39
Chapitre 3 Commande du bras manipulateur
Dans notre réalisation on a utilisé trois types différents de servomoteurs illustrés dans
[32, 33, 34], fig.3.3. :
40
Chapitre 3 Commande du bras manipulateur
[32, 33, 34], Tableau 3.1illustre les paramètres des servomoteurs qu’on a utilisé.
Spécifications
Poids 55 g 55 g 9g
0.2 s/60º (4.8 V), 0.16 s/60º 0.17 s/60º (4.8 V),
Vitesse 0.1 s/60°
(6 V) 0.14 s/60º (6 V).
Rotation angle 180° 180° 180°
41
Chapitre 3 Commande du bras manipulateur
Fig.3.4. De gauche à droite :(a)schéma interne de joystick[35], (b) Arduino PS2 Joystick [36].
3.2.4. Alimentation
42
Chapitre 3 Commande du bras manipulateur
3.2.6. LED
La [Link] les LED
Fig.3.7. LED
Fig.3.8. Bouton-poussoir
[Link]
[Link]ésentation du logiciel
[Link]. Présentation du logiciel ISIS(Intelligent Schematic Input System)
Le logiciel ISIS de Proteus est principalement connu pour éditeur des schémas
électriques. Par ailleurs, le logiciel permet également de simuler ces schémas ce qui permet de
déceler certaines erreurs dès l’étape de conception. Indirectement, les circuits électriques
conçus grâce à ce logiciel peuvent être utilisés dans des documentations car le logiciel permet
de contrôler la majorité de l’aspect graphique des circuits[37].
43
Chapitre 3 Commande du bras manipulateur
44
Chapitre 3 Commande
de du bras manipulateur
Fig.3.12. Simulation
lation de la commande manuelle et automatique du BM1.
[Link].Logiciel de program
rogrammation Arduino
L'environnement de programmation
progr Arduino (IDE en anglais) est
st une application écrite
en Java. L'IDE permet d'écrire
'écrire, de modifier un programme et de le conv
convertir en une série
d'instructions compréhensibles
sibles pour la [Link] langage de programmation
ation de l’Arduinoétant
dérivé du C et de C++, ill respecte
respe les règles de syntaxe propres à cess langages
lang qui sont, où
demeurant, relativement simple
imple.
45
Chapitre 3 Commande
de du bras manipulateur
[Link].1 Présentation
n du llogiciel
Il dispose de nombreus
breuses fonctions permettant de piloter facile
facilement des cartes
d’acquisition et autres instrum
nstruments, mais aussi de filtrer, d’analyser
ser et de présenter les
données. Ce langage est également
égale appelé code G. Le code est représen
ésenté par un schéma
composé de fonctions, de struct
structures et de fils qui propagent les données.
46
Chapitre 3 Commande du bras manipulateur
sont les instructions qui ont la priorité, alors qu’avec LabVIEW ce sont les données. Une
fonction s’exécutera donc uniquement si elle dispose a ses entrées de toutes les données dont
elle a besoin. Lorsqu’un langage classique est ainsi séquentiel, LabVIEW est naturellement
prédispose au parallélisme. Ce qui augmente encore sa puissance et la rapidité d’exécution du
code [38].
47
Chapitre 3 Commande du bras manipulateur
48
Chapitre 3 Commande du bras manipulateur
49
Chapitre 3 Commande du bras manipulateur
3.3.2. Commande
[Link]. Commande manuelle
- Insérer la bibliothèque du servo et déclarer les constantes et les variables dont on a besoin.
- Configurer les entrée-sorties et initialiser le débit de données en bits par seconde (baud)
pour transmettre les données en série.
- Mettre le BM1 dans sa position initiale et lire les valeurs analogiques des axes X, Y de
joystick à l’état de repos.
- Calculer les angles en fonction de la différence entre les valeurs analogiques des axes X,
Y à l’état de repos et après le déplacement.
50
Chapitre 3 Commande
de du bras manipulateur
51
Chapitre 3 Commande
de du bras manipulateur
Fig.3.20. Organigramme
Or du sous-programme « map ».
[Link].1. Commandepar
par le
l modèle géométrique inverse du bra
bras
52
Chapitre 3 Commande
de du bras manipulateur
53
Chapitre 3 Commande du bras manipulateur
E = Consigne – Mesure
Le régulateur PID sert à atteindre la valeur souhaitée pour une des variables du
système(vitesse, position,...)
[Link].1.L’action Proportionnel
Plus Kp est grand, plus la réponse est rapide mais on obtient une Erreur statique.
54
Chapitre 3 Commande du bras manipulateur
U( ) = × ( ) (3.3)
U( ) = × ( )/(3.4)
Le corrige l'erreur statique, Plus Ki est élevé, plus l'erreur statique est corrigée.
()
U( ) = × (3.5)
U( ) = × ( ) × (3.6)
Réduit le dépassement et le temps de stabilisation mais aussi notre système sera sensible au
bruit.
55
Chapitre 3 Commande du bras manipulateur
56
Chapitre 3 Commande du bras manipulateur
57
Chapitre 3 Commande du bras manipulateur
Dans la configuration interne d'un régulateur par logique floue, on distingue troisparties :
- La fuzzification: conversion des valeurs d'entrées (grandeurs physiques) engrandeurs
floues réunies dans le vecteur x.
- L'inférence :(avec la base de règles) : prise des décisions (chaque règle activéedonne un
sous-ensemble flou de sortie).
- La défuzzification : conversion des sous-ensembles flous de sortie en
valeursdéterminées.
58
Chapitre 3 Commande du bras manipulateur
59
Chapitre 3 Commande du bras manipulateur
[Link]
Dans ce chapitre nous avons abordé les différents aspects (hardware et software) relatifs
àla réalisation de notre projet. On a étudié également les différents composants de notre bras
ainsi que la commande du bras manipulateur.
60
CHAPITR
APITRE 4 : TESTS
STS ET
E
RE
RESULTATS
Chapitre 4 : Tests et Résultats
4.1. Introduction
Après avoir vu toutes
utes les
le parties composantes de notre bras manipu
anipulateur (mécanique
et logiciel), nous allons dans
ans ce chapitre analyser et interpréter les résultats
ultats de l’utilisation de
la carte de commandee Ar
Arduino qui est chargé de contrôler
ler les
le servomoteurs.
A la fin on va survenir surr l’étape
l’étap dite implémentation ou bien les testss de fo
fonctionnement.
61
Chapitre 4 : Tests et Résultats
Temps (s)
62
Chapitre 4 : Tests et Résultats
200
Temps (s)
200
180
Variation de l'angle Theta 2
160
140
(servomoteur 2)
120
100
80
60
40
20
0
Temps (s)
63
Chapitre 4 : Tests et Résultats
Temps (s)
200
Variation de l'angle Theta 3(degré)
180
160
140
120
100
80
60
40
20
0
Temps (s)
64
Chapitre 4 : Tests et Résultats
200
180
160
Theta3(servomoteur 3)
Variation de l'angle 140
120
100
80
60
40
20
0
Temps (s)
Temps (s)
65
Chapitre 4 : Tests et Résultats
200
180
Temps (s)
200
Variation de l'angle Theta 4(degré)
180
160
140
120
100
80
60
40
20
0
Temps (s)
66
Chapitre 4 : Tests et Résultats
• Variation de Theta 1
• Variation de Theta 2
67
Chapitre 4 : Tests et Résultats
• Variation de Theta 3
• Variation de Theta 4
68
Chapitre 4 : Tests et Résultats
Fig.4.17. Réponse
Rép à un échelon d'unité du contrôleurr PID.
69
Chapitre 4 : Tests et Résultats
[Link] BM1 final exposé au salon national des produits et de la recherche scientifique.
71
Chapitre 4 : Tests et Résultats
D’après ce tableau, le prix revient est de 12, 950,00DA , ce montant n’inclut pas le prix des
pièces mécanique.
4.6 Conclusion
Dans le chapitre précédent nous avons entamé les différents aspects relatifs à la conception et
la réalisation de notre projet. Dans ce dernier chapitre nous présentons les résultats et les tests
faits.
72
CONCLUS
CLUSION GENERA
NERALE
Conclusion générale
Conclusion général :
Signalons que dans le cadre ce travail,nous avons été amené à aborder plusieurs
domaines d’étude : la mécanique, la programmation, l’électronique, l’automatique….
Le modèle analytique inverse a été utilisé pour effectuer des tâches dans l’espace
opérationnel du bras manipulateur que nous avons réalisé.
- LabView ;
- Proteus ;
- Matlab ;
- Arduino .
Il faut signaler que la partie la mécanique de la réalisation de notre bras était le principal
problème rencontré dans ce projet.
Le prototype réalisé peut servircomme base pour des travaux futurs qui seront destinées
à l’amélioration du robot et de la fonctionnalité de ses diverses parties.
Notre travail est tout de même susceptible d’être amélioré. Nous proposants en
perceptive :
70
Conclusion générale
Enfin, signalons que ce travail a été valorisé par notre participation au Salon National
des Produits de la Recherche Scientifique (SAFEX, Alger,18-21 mai 2017) organisé par la
Direction Générale de la Recherche Scientifique et du Développement Technologique.
71
Références bibliographiques
Références bibliographiques
72
Références bibliographiques
73
Références bibliographiques
[33] « MG996R High Torque MetalGear Dual Ball Bearing Servo » [En ligne]. Disponible :
[Link]
[34] « MG995 High Speed MetalGear Dual Ball Bearing Servo ». [En ligne]. Disponible :
[Link]
[35] « Arduino PS2 Joystick Schematic » dans Henry’sBench. [En ligne]. Disponible :
[Link]
joystick-tutorial-keyes-ky-023-deek-robot/
[36] « 5-Pin 2-Way Arduino Compatible PS2 Joystick Game Controller Module » dans
FASTECH. [En ligne]. Disponible : [Link]
arduino-compatible-ps2-joystick-game
[37] « Proteus (ISIS et ARES) » dansElektronique. [En ligne]. Disponible :
[Link]
[38] [Link], [Link], LabVIEW Programmation et applications, 3e éd. Paris :
DUNOD, 2015. [En ligne] disponible :
[Link]
[39] M. Camus, E. Deguine et D. Ross, Régulation par PID, Paris : TELECHOM Tech, 2010.
[40] C. Rosental, Histoire de la logique floue. Une approche sociologique despratiques de
démonstration, octobre-décembre 1998.
74
"# ا
تC=و36ا اT ھNZEP2 .123456 ت89ور ذو أر=< در8AB تC=و36 ذجCEF ز8HF وا1JراK= ،8ھ8FNHF اOP6ج ا3QP6ة ا3STB لVW XB 8AEY
.CA2 أردو1Y8[= 8\= ]_ّ 4P`ر وC`CBCa3b6 ا1[JاC= ك34P` ،1Z5deB 1Z_ZF8_ZB 1ZAf=
،O_Z`8BC` ّ_] أو4` OF8r6 وا.lZPb2CH6 اmّF إ،ho8eE6 اOa ]_ّ 4P68= مCj2 و،ويK2 ولk ا:]_ّ 4P6 اXB XZgCF hEi6ا اT ھOa 8A5EiPJ اKj6
.ور8AE6ت اC=و356 1b_iAE6 ا1ZJKA\6 ا19TEA6 اmPE\B
.ور8AE6ت اC=36 hEiPbE6_] ا4` hZ\bP6 LABVIEWvB8F3= ل8EiPJ8= 1ZF8Z= 1\9ء وا8tFu= 8AEY 8ES
روC`CBCa3b6 ا،lZPb2CH6 ا،CA2 أردو،ور8AE6ت اC=و36 ا: ا! تا
Résumé
Dans ce travail, nous nous intéressons à l’étude et à la réalisation du prototype d’un bras
manipulateur à 4 dégrée de liberté c’est une structure mécanique articulée, actionnée par des
servomoteurs et commandée par la carte Arduino.
On a utilisé deux commandes : la première est la commande manuelle des articulations par joysticks
et la deuxième c’est la commande automatique à base de la modélisation géométrique inverse du
bras manipulateur.
On a également créé une interface graphique en utilisant le logiciel de LABVIEW afin de faciliter à
l’utilisateur la commande du bras manipulateur.
Mots clés :Bras manipulateur, Arduino, Joysticks,Servomoteur,LABVIEW.
Abstract
In this work, we are interested in the study and realization of the prototype of a manipulator arm
with 4 degrees of freedom. It is an articulatedmechanical structure, actuated by servo motors and
controlled by the Arduino board.
Twocommands have been used: the first is the manual control of the joysticks and the second is the
automatic control based on the inverse geometric modeling of the manipulator arm.
A graphical interface has also been createdusing the LABVIEW software to facilitate user control
of the manipulator arm.