Contrôle d'un bras manipulateur 6 D.D.L.
Contrôle d'un bras manipulateur 6 D.D.L.
15-22
RÉSUMÉ
L’objectif de cet article est de proposer une méthode de contrôle d’un robot manipulateur à six degré de liberté avec évitement
d’obstacle par la logique floue. Ce bras exécute la tâche de déplacement des objets bien définis dans un environnement bien
déterminé. Cette méthode est orientée de manière à régler le problème de difficulté et parfois d’absence d’un modèle
mathématique pour la modélisation et la commande des systèmes non linéaires. Elle permet d’aider le robot pour rejoindre un
but bien défini avec la faculté d’évitement d’obstacles. Nous proposons également un simple contrôleur flou et un ensemble de
modèles géométriques qui vont faciliter le suivi des meilleurs chemins pour le robot manipulateur. Les résultats obtenus en
simulation montrent l’efficacité de l’approche proposée.
Notre article est structuré comme suit: dans la première Tableau 1 : Paramètres géométriques du robot Staubil RX-90
section, nous exposons la structure géométrique de notre
bras à étudier. Dans la deuxième section, nous allons J σj αj dj θj rj
modéliser notre bras manipulateur en utilisant deux 1 0 0 0 θ1 0
modèles réels qui sont le Modèle Géométrique Inverse
(M.G.I) et le Modèle Géométrique Direct (M.G.D) [9] [20]. 2 0 π /2 0 θ2 0
Puis nous allons passer à présenter la structure de notre
contrôleur flou. Finalement il y a la phase d’exécution, sont
3 0 D3 θ3 0
des résultats de simulation de notre système en utilisant un 4 0 π
/2 0 θ4 RL4
outil du langage de programmation.
5 0 π/2 0 θ5 0
6 0 π
/2 0 θ6 0
2 LA DESCRIPTION GEOMETRIQUE DU BRAS
La structure de notre bras est la Structure Ouverte Simple
(St.O.S) dont la quelle chaque corps a au plus deux 2.1 Modèles géométriques direct du bras
articulations. La St.O.S permet d’amener l’organe terminal
dans une situation (position et orientation) donnée [9]. Elle Le modèle géométrique direct du robot Staubil RX-90 est
est la plus utilisé et a pour avantage essentiel d’augmenter donné par les équations suivantes :
la rigidité ainsi que la précision. Le bras manipulateur à
étudier est un robot articulé à 6 D.D.L « robot Staubil RX-
90 ». Six degrés de liberté sont suffisants pour positionner
(
sx = C1 C23 (C4C5C6 − S4 S6 )− S23S5C6 ) − S1 ( S4C5C6 +C4 S6 )
l’organe terminal dans une position et orientation complet
dans l’espace [21]. La cinématique du porteur est de type
RRR et le poignet comporte trois rotations comme la figure
( )
sy = S1 C23(C4C5C6 −S4S6 )−S23S5C6 + C1 ( S4C5C6 +C4S6 )
1 l’indique [9].
sz = S 23 (C4C5C6 − S4 S6 ) + C23 S5C6
(
nx = C1 −C23 (C4C5 S6 + S4 S6 )+ S23S5C6 ) + S1 ( S4C5S6 −C4C6 )
z4 , z6
x 4 , x5 , x6 (
ny = S1 −C23(C4C5S6 − S4C6 )+ S23S5S6 ) − C1 ( S4C5S6 −C4C6 )
RL 4 ax = − C1 (C23C4 S5 + S23C5 ) + S1 S 4 S5
z 0 , z1
ay = − 1 S (C23C4 S5 + S23C5 ) − C1 S 4 S5
x 0 , x1 , x 2 x3
z2 D3 az = − S 23C4 S5 + C23C5
z3
px = − C1 ( S23 RL4 +C2 D3 )
Les paramètres géométriques du robot sont représentés dans avec C 23 = Cos (θ 2 + θ 3 ) et S 23 = Sin (θ 2 + θ 3 )
la figure suivante :
16
Commande d'un bras manipulateur 6 D.D.L avec évitement d'obstacle par la logique floue
X
XZ + ε X X + Y − Z
2 2 2
et S2 =
X +Y
2 2
Y
ε = ±1 , B1 = p xC 1 + pz S1 , X = −2 p yD3 , Y = −2 B1D3 , Figure 2 : Bras manipulateur se dirigeant vers un point cible
Z = ( RL4 ) − ( D3 ) − ( Pz ) − ( B1 )
2 2 2 2
→
Le vecteur de la cible Vcible est calculé à partir de la
θ3 = a tan 2 ( pz S2 − B1C2 + D3 / RL4 , − B1 S2 + pz C2 / RL4 ) position de la cible et le vecteur d’évitement représente la
→
sortie du contrôleur flou. VEvitement
(
θ 4 = a tan 2 S1ax − C1a y , −C23 ( C1ax + C1a y ) − S 23 az )
θ 4' = θ 4 + π
4 LE CONTROLEUR FLOU POUR L’EVITEMENT
θ5 = a tan 2 ( S5 , C5 ) L’objectif est la création d’un contrôleur flou capable
→
avec d’évaluer le vecteur d’évitement VEvitement correspondant à
la position actuelle d’obstacle.
S5 = −C4 ⎡⎣C23 ( C1ax + S1a y ) + S 23 az ⎤⎦ + S4 ( S1ax − C1a y )
Comme la figure 3 l’indique, le contrôleur possède deux
entrées et une sortie, les entées sont l’angle et la direction
C5 = − S 23 ( C1ax + S1a y ) + C23 az par apport l’obstacle et la sortie est le vecteur d’évitement.
Le bras utilise ce dernier pour calculer ses coordonnées
θ 6 = a tan 2 ( S 6 , C 6 ) absolues.
Nous avons choisi un contrôleur de type Mamdani [15],
avec
dont la conclusion est un ensemble flou. Ce modèle
S6 = −C4 ( S1 sx − C1 s y ) − S 4 ⎡⎣C23 ( C1 sx + S1 s y ) + S 23 sz ⎤⎦ présente l’avantage d'être facilement interprétable et bien
adapté à ce type de problème. La fonction d’appartenance
utilisée est gaussienne, ce type de fonction est généralement
C6 = −C4 ( S1nx − C1n y ) − S 4 ⎡⎣C23 ( C1nx + S1n y ) + S 23 nz ⎤⎦ le plus utilisé.
17
H. Ghodbane & al
0 15 30 dobstacle
Figure 5 : La fuzzification de la distance d’obstacle
18
Commande d'un bras manipulateur 6 D.D.L avec évitement d'obstacle par la logique floue
ϕevitemente ϕobstacle
Obstacle
GN MN PN EZ PP MP GP
α cible
P GGN GGN GGN GGN GGN GN MN
dobstacle
M GGN GGN GGN GGN GN MN PN
α obstacle
α source
G GGN GGN GGN GN MN PN EZ
X
2ème cas : αobstacle inférieur à αsource (l’organe terminal) et Figure 9 : Evitement gauche droite
[ ]
supérieur à αciblée α obstacle ∈ α source , α cible c'est-à-dire
l’évitement se fait à droite comme la figure 8 l’indique Les règles sont résumées dans le tableau suivant :
19
H. Ghodbane & al
Début
c ible
Création des paramètres du bras 1
manipulateur et de l’environnement obs tac le
Démarrage du système
déDdéémarag -1 -1
-1 s ourc e
-0.5
Transformation relative des positions -0.5
(cible, obstacle) 0
0
0.5 0.5
Calcul les données du système
( θ cible , d obstacle , θ obstacle ) 1 1
Exécution du
Vue 3D
NON
Exécution de OUI Il y a un obstacle contrôleur flou de
l’évitement détecté deplacement libre
d’obstacles -1
-0.8
Déplacement du
bras -0.6
-0.4
NON cible
Le bras atteint la -0.2
cible
OUI 0
0.4
Figure 10 : L'architecture fonctionnelle du système proposé
0.6
source
0.8
8 VALIDATION 1
-1 -0.8 -0.6 -0.4 -0.2 0 0.2 0.4 0.6 0.8 1
Dans ce papier, nous présenterons les résultats de
simulation de notre système en utilisant MATLAB. De ce Vue de haut
faite, on peut accélérer le temps de calcul, on peut élaborer
beaucoup de données, on peut varier les paramètres de 1
l’environnement comme on le désire. On peut faire
0.8
exécuter au robot ce que l’on veut, on peut aussi modifier
les données du robot, on peut visualiser tout ce qui se passe. 0.6
MATLAB qui est un environnement de travail complet, 0.4
puissant et performant. obstacle
0.2
Nous présentons ici un exemple de notre validation réalisée. cible
L’environnement est une salle carrée. Le bras possède six 0
degré de liberté. Pour déplacer un objet le bras part d’un -0.2
état de repos. Ensuite il s’oriente progressivement vers la
configuration finale correspondant à la cible avec la -0.4 source
collision.
Vue de coté
Figure 11 : exemple de validation
20
Commande d'un bras manipulateur 6 D.D.L avec évitement d'obstacle par la logique floue
La variation des angles de chaque moteur (correspondant à Nous espérons que cet article motivera le lecteur à créer
l’exemple présenté dans la figure 11) est représentée dans la plusieurs applications avec l’exploitation des propriétés
figure suivante : intrinsèques de la logique floue.
4 3 REFERENCES
moteur 1 moteur 2
[1] P. Reignier, "Pilotage réactif d’un robot mobile étude
3
2
du lien entre la perception et l’action", Thèse
pi
pi
pi
2.5 1 [5] X. Yang, M. Moallem and R-V. Patel, "A layered goal-
pas pas
oriented fuzzy motion planning strategy for mobile
2 0 robot navigation", IEEE transactions on systems, man,
0 50 100 150 0 50 100 150
and cybernetics-part B : cybernetics, Vol. 35, No. 6,
pp. 1214-1224, December 2005.
21
H. Ghodbane & al
[14] Logique floue, car le monde est flou ! [18] R. Mahdaoui and H-L Mouss, "Diagnostic industriel
http://embedded.over-blog.com/article-4592528.html. par neuro-floue application à un système de
production", Laboratoire d’Automatique et Productique
[15] K. Chafaa, "Structure d’identification et de commande (LAP) Université de Batna, Algérie, 2006.
des systèmes non linéaires", Thèse Doctorat, Université
de Batna, Algérie, 2006. [19] D-J. Huh, J-H. Park, U-Y. Huh and H. Kim, "Path
planning and navigation for autonomous mobile robot",
[16] M. Mordjaoui, "Modélisation des effets Industrial Electronics Society. IECON 02, 28th Annual
électromagnétiques - Apport de la logique floue et Conference of the IEEE, pp. 1538- 1542, Vol. 2,
neuro-floue", Thèse Doctorat, Université de Batna, Sevilla, Spain, 2002.
Algérie, 2008.
[20] P. Fisette, H. Buyse et J-C. Samin, Introduction à la
[17] La logique floue, 2002. robotique, 2004.
http://www.gillesbalmisse.com/IMG/pdf/GB_Fuzzy.pdf
[21] Analyse et conception d’un manipulateur parallèle spatial à
cinq degrés de liberté. http://www.sciencedirect.com.
22