P25 Développement d'un cobot : Différence entre versions

De Wiki de Projets IMA
(Motorisation du bras Robotique)
(Partie 3: Mode collaboratif sur 3 axes)
 
(81 révisions intermédiaires par le même utilisateur non affichées)
Ligne 50 : Ligne 50 :
 
Partie 1: Base du mouvement:
 
Partie 1: Base du mouvement:
 
*Mouvement du bras sur 1 axe en boucle ouverte.
 
*Mouvement du bras sur 1 axe en boucle ouverte.
*Mouvement du bras en chaine cinématique ouverte.
+
*Mouvement du bras en chaine cinématique directe.
 
<br>
 
<br>
 
Partie 2: Mode collaboratif sur 1 axe:
 
Partie 2: Mode collaboratif sur 1 axe:
Ligne 103 : Ligne 103 :
 
<br>
 
<br>
 
Le point fort de ce type de préhenseur est qu'il peut prendre des objets ronds ou plats grâce aux biellettes qui permettent à la pince de se courber pour s'adapter à la forme de l'objet.<br><br>
 
Le point fort de ce type de préhenseur est qu'il peut prendre des objets ronds ou plats grâce aux biellettes qui permettent à la pince de se courber pour s'adapter à la forme de l'objet.<br><br>
[[Fichier:Pince1done.JPG|400px|]]
+
[[Fichier:Pince1done.JPG|300px|]]
[[Fichier:Capteur pression.JPG|400px|]]<br><br>
+
[[Fichier:Capteur pression.JPG|300px|]]<br><br>
 
Ci-dessus, le préhenseur monté après que toutes les pièces aient été imprimé. Des vis sont utilisées afin de servir d'axes. De plus j'ai rajouté des capteurs de force au bout des doigts de la pince (photo de droite). Leur intérêt est de mesurer la force appliquée à l'objet entre les doigts et donc de savoir si on exerce une trop grosse pression sur l'objet. Les 2 câbles de chaque capteurs ont été collés ensemble avec du chatterton afin d'éviter leur dispersion et ainsi diminuer le risque qu'ils s'arrachent durant une tâche.<br>
 
Ci-dessus, le préhenseur monté après que toutes les pièces aient été imprimé. Des vis sont utilisées afin de servir d'axes. De plus j'ai rajouté des capteurs de force au bout des doigts de la pince (photo de droite). Leur intérêt est de mesurer la force appliquée à l'objet entre les doigts et donc de savoir si on exerce une trop grosse pression sur l'objet. Les 2 câbles de chaque capteurs ont été collés ensemble avec du chatterton afin d'éviter leur dispersion et ainsi diminuer le risque qu'ils s'arrachent durant une tâche.<br>
 
Cela conclut la partie "réalisation du préhenseur".<br><br>
 
Cela conclut la partie "réalisation du préhenseur".<br><br>
Ligne 135 : Ligne 135 :
 
Le schéma de montage adopté pour le branchement du moteur à la TB6560 et du TB6560 au Ramps 1.4 est le suivant:<br>
 
Le schéma de montage adopté pour le branchement du moteur à la TB6560 et du TB6560 au Ramps 1.4 est le suivant:<br>
 
[[Fichier:TbDrive.JPG|300px|center]]<br>
 
[[Fichier:TbDrive.JPG|300px|center]]<br>
//Photo du Ramps cablé <br><br>
+
[[Fichier:RampsFinal.JPG|200px|left]] <br>
//Photo de l'ensemble des drivers connectés <br><br>
+
[[Fichier:DriversConnectés.JPG|200px|center]]
//Photo du cablage sur le robot ( gaine thermorétractable ) <br><br>
+
[[Fichier:GaineThermo.JPG|200px|right]]<br><br><br><br><br><br>
 
Pour l'ensemble des moteurs, il a fallu agrandir la longueur des fils afin de pouvoir les relier jusque aux drivers.
 
Pour l'ensemble des moteurs, il a fallu agrandir la longueur des fils afin de pouvoir les relier jusque aux drivers.
 
Tous les moteurs possèdent 4 fils: un noir correspondant au A+, un vert correspondant au A-, un rouge correspondant au B+ et un bleu correspondant au B-. Mais pour deux moteurs, celui de la pronation/supination et le moteur du poignet. Il convient donc de faire un tableau d'équivalence des câbles pour signaler quel fil de couleur devient quelle couleur et à quelle phase ils correspondent:<br><br>
 
Tous les moteurs possèdent 4 fils: un noir correspondant au A+, un vert correspondant au A-, un rouge correspondant au B+ et un bleu correspondant au B-. Mais pour deux moteurs, celui de la pronation/supination et le moteur du poignet. Il convient donc de faire un tableau d'équivalence des câbles pour signaler quel fil de couleur devient quelle couleur et à quelle phase ils correspondent:<br><br>
Ligne 200 : Ligne 200 :
 
|-
 
|-
 
|}
 
|}
// Photo bloc alimentation + explication habilitation électrique.<br><br>
+
[[Fichier:AlimBras.JPG|250px|left]]<br><br>
Après discussions avec Monsieur FLAMEN, j'ai dû changer la position de mon bloc d'alimentation. En effet, celui-ci était placé trop proche du bord de la planche sous le robot et présentait des risques de blessures par électrocution. J'ai donc décider de la placer plus profondément sous la plaque de telle façon à ce que personne ne puisse toucher le bloc d'alimentation ou le convertisseur en voulant soulever le robot. Des cavaliers ont également installés afin de prévenir l'arrachage des câbles.
+
Après discussions avec Monsieur FLAMEN, j'ai dû changer la position de mon bloc d'alimentation. En effet, celui-ci était placé trop proche du bord de la planche sous le robot et présentait des risques de blessures par électrocution. J'ai donc décider de la placer plus profondément sous la plaque de telle façon à ce que personne ne puisse toucher le bloc d'alimentation ou le convertisseur en voulant soulever le robot. Des cavaliers ont également installés afin de prévenir l'arrachage des câbles.<br><br><br><br><br><br><br>
 
Les moteurs sont donc installés et le câblage fait et protégé. Le bras est donc prêt à être utilisé de façon perenne sans risque de dégradation matérielle. Il me faut maintenant commencer le codage du robot via ma carte arduino MEGA 2560.<br><br>
 
Les moteurs sont donc installés et le câblage fait et protégé. Le bras est donc prêt à être utilisé de façon perenne sans risque de dégradation matérielle. Il me faut maintenant commencer le codage du robot via ma carte arduino MEGA 2560.<br><br>
//Photo d'ensemble du robot réel.
+
[[Fichier:BrasFinal.JPG|300px|center]]<br>
  
 
==Partie 1: Base du mouvement==
 
==Partie 1: Base du mouvement==
Ligne 214 : Ligne 214 :
 
Ce programme fait bouger la base du bras. L'opérateur le met dans une position initiale prédéfinie, puis le bras fait une rotation pour se mettre dans la position 'HOME'. Un arrêt d'urgence a été implémenté afin de stopper le Homing en cas de problèmes. Il suffira à l'utilisateur d'envoyer un 1 sur le port série d'Arduino. Ce dernier est utilisé afin de visualiser la valeur des variables ainsi que l'avancée du programme.<br>
 
Ce programme fait bouger la base du bras. L'opérateur le met dans une position initiale prédéfinie, puis le bras fait une rotation pour se mettre dans la position 'HOME'. Un arrêt d'urgence a été implémenté afin de stopper le Homing en cas de problèmes. Il suffira à l'utilisateur d'envoyer un 1 sur le port série d'Arduino. Ce dernier est utilisé afin de visualiser la valeur des variables ainsi que l'avancée du programme.<br>
 
Le problème majeur du moteur pas-à-pas, est qu'il ne connait pas sa position au démarrage. Ainsi lorsque le moteur démarre, sa position est donc considérée comme la position 0. Le robot ne peut donc pas bouger pour se mettre en position HOME quelle que soit sa position initiale. En effet, si le robot commence en bout de course, il cherchera à continuer à tourner, forçant sur la poulie et la courroie pour continuer sa rotation.<br><br>
 
Le problème majeur du moteur pas-à-pas, est qu'il ne connait pas sa position au démarrage. Ainsi lorsque le moteur démarre, sa position est donc considérée comme la position 0. Le robot ne peut donc pas bouger pour se mettre en position HOME quelle que soit sa position initiale. En effet, si le robot commence en bout de course, il cherchera à continuer à tourner, forçant sur la poulie et la courroie pour continuer sa rotation.<br><br>
===Mouvement du bras en chaine cinématique ouverte===
+
===Mouvement du bras en chaine cinématique directe===
Maintenant que le mouvement sur la base et maitrisée et que la bibliothèque AccelStepper est maitrisée. Je peux étendre mon programme à l'ensemble du bras robotique.
+
{| class="wikitable alternance right"
 +
!Moteur      !!     Code Switch TB6560 !! Nombre de pas !! nombre de degrés !! vitesse                 
 +
|-
 +
| Base
 +
| 111 101100
 +
|      7800
 +
|      180°
 +
|      2000
 +
|-
 +
| Épaule
 +
| 100 001100
 +
|      4360
 +
|      180°
 +
|      1000
 +
|-
 +
| Coude
 +
| 101 001000
 +
|      5946
 +
|      225°
 +
|      1000
 +
|-
 +
| Rotation poignet
 +
| 101 001100
 +
|      2100
 +
|      450°
 +
|      500
 +
|
 +
|-
 +
| Poignet
 +
| 011 001100
 +
|      4300
 +
|      235°
 +
|      1000
 +
|-
 +
|}
 +
Maintenant que le mouvement sur la base est maitrisé et que la bibliothèque AccelStepper est maitrisée. Je peux étendre mon programme à l'ensemble du bras robotique.
 
L'idée est, comme pour la base, de créer un programme où l'ensemble du robot se met en position HOME. Puis l'utilisateur peut faire bouger chacun des axes à son envie et peux également le faire revenir à sa position de repos. Il faudra également gérer les sorties de la zone d'activité.<br>
 
L'idée est, comme pour la base, de créer un programme où l'ensemble du robot se met en position HOME. Puis l'utilisateur peut faire bouger chacun des axes à son envie et peux également le faire revenir à sa position de repos. Il faudra également gérer les sorties de la zone d'activité.<br>
 +
Je décide donc de créer ma propre librairie arduino que je nomme 'Moveo'. Elle contiendra l'ensemble des fonctions dont j'aurai besoin pour faire bouger mon robot. Voici la classe que je créé:<br>
 +
[[Fichier:ClassMoveo.JPG|left|450px]]<br><br>
 +
On retrouve les fonctions suivantes:<br>
 +
- Une fonction de récupération de l'axe demandé.<br>
 +
- Les fonctions de mouvement de chaque axe.<br>
 +
- Les fonctions de récupération des positions des moteurs.<br>
 +
- Les fonctions de retour en position HOME et de repos.<br>
 +
- La fonction de calcul des zones impossible à atteindre pour les moteurs.<br><br>
 +
On peut donc appeler ces fonctions en écrivant 'moveo.PositionP()' pour récupérer la position du poignet.<br>
 +
<br><br><br>
 +
L'utilisateur communique donc par le biais de la liaison série avec le bras robotique. Chacune des positions est rappelée et il n'y a aucun risque que le robot soit endommagé par un mauvais ordre de mouvement.<br><br>
 +
[[Fichier:Moniteur.JPG|left|450px]]<br><br>
 +
Au dessus, vous pouvez voir l'affichage sur le port série du début du programme jusque à la mise en position HOME. La vidéo ci-dessous montre quant à elle les mouvement du robot durant ces phases.<br><br>
 +
Video de mise en position HOME: [[Fichier:Homing.mp4]]
 +
<br><br><br><br><br><br><br><br><br><br>
 +
'''REMARQUE:'''Le robot rencontre un problème majeur, un souci thermique dû à l'échauffement des moteurs vient gêner la rotation des poulies. En effet, pour garder un couple de maintien, je dois continuer d'envoyer du courant dans les moteurs. Lorsque le moteur bouge, cette énergie est transformée majoritairement en mouvement, et un peu en chaleur. Mais lorsque le moteur est à l'arrêt, cette énergie est majoritairement dissipée en chaleur. Cela résulte en une grosse hausse de chaleur dans le moteur et dans son axe. Si le moteur est alimenté pendant trop longtemps, la poulie en PLA commence à se déformer et à se désaxer. Ce qui fait que je ne peux plus me servir des axes au poulies déformée.<br>
 +
La solution apportée est donc de monter un dissipateur sur le moteur couplé à un ventilateur. Le ventilateur serait commandé par le Ramps 1.4 qui possède des entrées de contrôle pour ventilateur.<br>
 +
''' C'est le robot avec le programme à cet avancement du projet qui sera présenté aux journées portes ouvertes de Polytech Lille ainsi qu'à l'évènement "Maker Faire" du 9-10-11 février 2018.'''<br>
 +
'''Ce programme ainsi que la bibliothèque créée sont consultables dans la partie des livrables.''
 +
 +
== Partie 2: Mode collaboratif sur 1 axe==
 +
=== Détection d'un obstacle sur le premier axe ===
 +
Le robot est désormais capable de se mouvoir comme voulu via la liaison série. Mais ce n'est pas encore un robot collaboratif. Pour cela, il doit être capable de détecter une collision, ce qui va maintenant être le nouvel objectif de mon projet.<br>
 +
Pour détecter ces collisions, je décide de regarder du coté des moteurs. En effet, en cas de rencontre avec un obstacle, il y aura forcement une hausse du couple dans le moteur de l'articulation. Je décide donc de monitorer mon courant via une sonde de courant. Ce dernier est relié au couple par la relation Cm = Kc.Im, avec Cm le couple moteur, Kc la constante de couple et Im le courant traversant le moteur.<br>
 +
Pour commencer, j'utilise un oscilloscope afin de voir "la tête" du courant présent dans l'une des phases du moteur du coude. Les résultats sont les suivants :<br><br>
 +
[[Fichier:Coude Sans Obstacle.jpg|400px]]
 +
[[Fichier:PWM Coude SsObstacle.jpg|400px]]<br><br>
 +
je vais maintenant mettre un obstacle sur la trajectoire de mon robot lors d'une levée du coude. Le but est de visualiser les hausses de courant dans le moteur.
 +
[[Fichier:Coude Obstacle.jpg|400px|center]]<br><br>
 +
On peut remarquer des sinusoïdes plus grandes que d'autres. Ce sont les hausses de couple qui l'entrainent. Mais ce pics ne reste pas sur plusieurs période car lorsque le moteur rencontre un obstacle en montant, il redescend puis remonte jusque à re-rencontrer l'obstacles. Ce pics d'une amplitude de 1.9A s'élève de 0.3A au dessus des cycles normaux (1.6A). Je vais donc essayer de détecter ces pics.<br>
 +
Je n'arrive pas encore a récupérer de données sur les PINs auxiliaires du Ramps. J'utilise donc une arduino UNO pour l'instant afin de récupérer les données des transducteurs de courant. En effet, les documentations restent assez vague quant aux numéros de PINs de la partie AUX ou SERVO ([http://s14.postimg.org/4787ei435/probe.png])<br>
 +
Je lance un programme qui fait tourner la base en continu. Puis je lance un programme sur mon arduino UNO qui est connectée au transducteur de courant qui visualise le courant de la base. J'utilise alors l'outil 'Traceur Série' de l'IDE arduino pour visualiser le courant mesuré. Le programme en question affiche les formes d'onde du courant dans le moteur ainsi qu'un signal d'alarme. Lorsque un pic de courant est détecté, le signal d'alarme passe à 255 comme sur l'image ci-dessous:<br>
 +
[[Fichier:ObstacleDetection.GIF|left|250px]] <br>
 +
A gauche, en bleu, le courant dans le moteur, en rouge le signal d'alarme. Lorsque je place ma main pour bloquer le bras, un pic ( positif ou négatif selon le sens de rotation ) apparait. Le signal d'alarme rouge passe donc à 255.
 +
La détection d'obstacle est donc réussie.<br><br>
 +
Pour clore cette partie, je vais me pencher sur un moyen de n'utiliser que le Ramps et non la carte arduino UNO couplée au ramps pour détecter l'obstacle. Je pourrai alors faire un programme combinant la détection d'obstacle sur la rotation de la base et le mouvement, sujet de la prochaine partie.<br><br>
 +
'''Remarque: ''' Le monitoring du courant se fait via un capteur à induction LEM qui est installé sur la phase B- du moteur. Le fait de monitorer sur plusieurs phases ajoute du bruit dans le signal qui ne devient plus exploitable.
 +
<br><br><br><br><br><br><br><br><br>
 +
 +
=== Reprise du mouvement après obstacle ===
 +
J'ai fait plusieurs recherches autour du ramps, 4 possibilités s'offraient à moi pour récupérer le courant du moteurs:<br>
 +
* La première était d'utiliser une arduino UNO sur laquelle brancher toutes les sondes, puis si une collision était détectée, la carte enverrait une donnée à l'arduino MEGA pour lui dire de stopper le mouvement. <br>
 +
* La deuxième solution était d'utiliser des PINs inutilisés du ramps comme le X_MIN_PIN, de le convertir en entrée pour lire la donnée dessus.<br>
 +
* La troisième était d'utiliser les PINs AUX du ramps. Certains étant analogiques, la possibilité de récupérer la donnée semblait viable. <br>
 +
* La dernière solution était d'utiliser les entrées associées aux sondes de températures pour récupérer la mesure.<br><br>
 +
La solution que j'ai finalement retenu est la dernière. En effet la première est viable, mais l'utilisation d'une carte qui communiquerai avec la MEGA n'est pas optimale. Elle pourrait néanmoins selon moi être revue dans le cas où on utilise plus de capteurs. En rajoutant les capteurs de proximité, les capteurs laser, l'accéléromètre et les transducteurs, on peut facilement imaginer la UNO avec un programme interne qui gèrera les capteurs, calculera les risques et qui enverra les données si nécessaires à la MEGA. La deuxième solution n'a pas non plus été retenue car elle ne retourne rien, en effet j'ai essayé de tourner les PINs en sortie mais la seule chose que je pouvais lire n'était que du bruit. La troisième solution, qui était d'utiliser les AUX de la ramps pour lire les mesures, n'a pas été retenue car je n'arrivais pas à retrouver les PINs de la MEGA correspondants aux PINs de la ramps. Je n'ai donc pas pu utiliser cette solution car ces PINs sont pour la plupart utilisé pour le branchement de cartes SD, écrans LCD... La ramps étant principalement conçue pour les imprimante 3D, elle n'a pas été designé pour qu'on puisse rajouter des capteurs.<br><br>
 +
[[Fichier:PIN thermo.JPG|right]]
 +
J'utilise donc les entrées faites pour les sondes de température sur la ramps. Le seul bémol étant que je n'ai que trois entrées, cela me permet d'au moins contrôler la rotation de la base, l'épaule et le coude. La rotation du poignet étant mécaniquement défectueux et le poignet étant hors service pour cause thermique. Les trois entrées sont donc largement suffisantes.<br>
 +
J'alimente donc ma sondes avec les 5V que fourni le ramps et je met le GND et la sortie sur les pins du premier capteur de température. <br><br>
 +
Je commence donc la création d'un programme simple pour la base: Une rotation de 90° dans un sens, puis de 90° dans l'autre en continu. Pour cela, aucun problèmes, je maitrise la bibliothèque de mouvement des moteurs.<br>
 +
Pour l'instant, j'utilisais la commande 'stepperX.move(value)' suivie d'un 'stepperX.run()' dans un while pour bouger le moteur. Le code que je vais rajouter va se trouver dans la boucle:
 +
[[Fichier:Mouvement detectionCollision.JPG|left|700px]]<br><br><br><br><br><br><br><br><br><br><br><br><br><br><br><br><br><br><br><br>
 +
Le code est simple, je lui donne le nombre de pas à effectuer, ici 90 degrés (1 degré = 43.33 pas; cf: Mouvement du bras en chaine cinématique directe). Puis je lance le mouvement, dans la boucle, j'effectue un pas et je fais l'acquisition du courant. Si j'ai atteint la position voulue, je sors du while. Si un pic de courant est détecté, je le dis, j'affiche la position où a eu lieu la collision et je lance la fonction 'test_collision' d'où je ne sortirai que lorsque l'obstacle ne sera plus présent.<br>
 +
Le contenu de la fonction est le suivant:<br>
 +
[[Fichier:CodeArduino detectionCollision.JPG|left|700px]]<br><br><br><br><br><br><br><br><br><br><br><br><br><br><br><br>
 +
Lorsque une collision est détectée, j'ai eu l'idée d'agir comme un aveugle le ferai. Une fois la collision détectée, je me stoppe pendant 1 seconde puis je regarde toutes les 500ms si l'obstacle est toujours présent. Ainsi le bras tourne et si il ne rencontre plus rien sur 300 pas, il considère l'obstacle comme disparu. Il reprend donc sa tâche. Si l'obstacle est toujours présent, il faudra quelques pas pour détecter de nouveau la hausse de courant dans le moteur. C'est pour cela que si l'obstacle est détecté dans les 400 pas, il est compté comme étant toujours présent, et la position est réinitialisée à sa position au départ qui est mise en entrée de la fonction.<br><br>
 +
 +
Il faut maintenant vérifier que le robot répond bien aux normes en vigueur. Ces normes sont données par l'INRS au paragraphe 4.5 de la brochure: [[Fichier:Securité des equipements Prévention des risques mécaniques.pdf]].<br>
 +
Ce paragraphe se résume dans le tableau suivant:
 +
[[Fichier:NormeCollaboratif.JPG|center|500px]]<br>
 +
Dans notre cas, nous suivrons la série de valeurs 2 car le robot collaboratif est considéré comme compliant. Il faut donc calculer l'énergie à l'impact créée par le robot:<br>
 +
La vitesse du robot est de 0.24 m/s.<br>
 +
Son poids étant de 4.8 Kg pour la partie mobile.<br>
 +
Son énergie à l'impact est donc de '''0.07J'''.<br>
 +
Le robot rentre donc plus que largement dans les normes. Une si faible énergie est due au fait que le robot soit en PLA et ne se déplace pas à si grande vitesse. La norme a quant à elle été faite pour des robots fait en matières métallique et se déplaçant à des vitesses supérieures au m/s. <br>
 +
'''Le robot peut donc être considéré comme collaboratif sur le premier axe.'''<br>
 +
<br>
 +
== Partie 3: Mode collaboratif sur les 3 axes==
 +
=== Détection d'un obstacle sur le deuxième et troisième axe et Reprise de la tâche ===
 +
Pour ajouter le mode collaboratif sur les 2 autres axes, ceux de l'épaule et du coude, il convient de suivre le même cheminement que pour le premier axe: détection d'obstacle, reprise de tâche puis fusion des 2 programmes.<br>
 +
Je visualise tout d'abord le courant qui passe dans le moteur par le biais de mon transducteur de courant. Ainsi je peux connaitre les valeurs Min et Max du courant dans mon moteur et fixer les seuils d'alarme.<br>
 +
[[Fichier:3 axes.JPG|left|200px]]<br><br>
 +
Ces seuils sont:<br>
 +
*Pour l'épaule, sont de 470 pour la limite basse et 552 pour la limite haut.<br>
 +
*Pour le coude, sont de 470 pour la limite basse et 550 pour la limite haut.<br>
 +
Une fois que je suis capable de détecter l'obstacle et d'arrêter le robot. Le programme pour la reprise de tâche reste fondamentalement le même.<br><br>
 +
Je crée donc 2 fonctions : <br>
 +
*Detection_Collision(): Prends en entrée la valeur du courant de chaque moteur. Puis vérifie que ces valeurs ne dépassent pas les seuils définis. Si valeur > seuil ,  lancement de la fonction test_collision().<br>
 +
*Test_Collision() : Prends en entrée un entier relatif au moteur bloqué ainsi que la position de collision. Vérifie périodiquement si l'obstacle est toujours présent. On ne sort de la fonction qu'une fois qu'il n'y a plus d'obstacles.<br><br><br><br>a
 +
 +
= Bilan =
 +
Afin de clore ce projet, il convient de faire le bilan sur ce dernier. Je parlerais donc dans la suite de ce chapitre du travail qu'il resterait encore à faire si on avait voulu aller jusqu'au bout du projet. Je continuerai ensuite avec les compétences que j'ai pu acquérir lors de ce Projet de Fin d’Études. Enfin, le dernier chapitre sera consacré au remerciements des différents protagoniste qui ont entourés ce projet.<br> 
 +
== Travail Restant ==
 +
Malheureusement, ce projet n'a pas pu être terminé. Il reste encore beaucoup de choses à faire. En effet, l'aspect collaboratif du robot n'est implémenté que sur 3 axes. Il faut donc l'étendre sur les 3 autres axes. Il faut donc rechercher un autre moyen d'acquérir le courant, pour l'instant l'acquisition se fait par le biais des 3 entrées thermistances du Ramps. Il faut donc trouver une méthode pouvant se servir des 6 transducteurs. Il faut également ajouter la partie d'évitement d'obstacles avec les capteurs à ultrasons et les capteurs lasers. Il aurait également fallu installer les accéléromètres sur le robot afin d'avoir une deuxième façon de détecter une collision. <br>
 +
Enfin, il conviendrai de déterminer le modèle du bras robotique Moveo afin de faire sa commande non pas en cinématique directe mais cette fois-ci en cinématique inverse.<br>
 +
 +
== Perspectives ==
 +
De nombreux projets peuvent être imaginés autour du Moveo BCN3D. En effet, ce projet est un projet transversal, on y retrouve de nombreux domaines. On peut imaginer par exemple le contrôle du bras en cinématique inverse via un joystick. Ce contrôle peut se faire soit directement sur le robot, mais on peut aussi penser à un contrôle à distance du bras via une raspberryPi. Un mode apprentissage peut également être pensé. En enregistrant les positions du robot, on pourrait lui faire apprendre une tâche en le manipulant. Le robot serait alors capable de refaire toutes les trajectoires de la tâche. Enfin, on peut penser à des projets de traitement d'images: en connectant une caméra au robot ce dernier pour aller chercher, sur un tapis devant lui, uniquement les objets voulus et reconnus. Un mode de recopie du mouvement humain est alors envisageable soit grâce à cette caméra, soit via une batterie de capteurs sur le bras de l'utilisateur.<br>
 +
 +
== Remerciement ==
 +
Enfin, je tiens à remercier énormément de personnes qui m'ont aidé de septembre à février sur ce projet.<br><br>
 +
Tout d'abords, je tiens à remercier mes tuteurs de projets, Monsieur ASTORI Rodolphe, Monsieur VANTROYS Thomas, Monsieur BOE Alexandre et Monsieur REDON Xavier pour les conseils qu'ils ont pu me prodiguer tout au long de ce travail.<br><br>
 +
Je tiens également à remercier Monsieur FLAMEN Thierry, technicien de la plate-forme électronique, pour les nombreux conseils qu'il a pu me fournir, notamment sur la partie câblage du robot.<br><br>
 +
Je remercie également l'équipe du Fabricarium: les Fab'Managers, pour leur accueil et les compétences qu'ils ont pu me faire acquérir notamment sur les machines telles que l'imprimante 3D, la découpeuse laser ainsi que les nombreuses autres machines disponible au Fabricarium.<br><br>
 +
J’adresse également une pensée pour l'ensemble des étudiants qui m'ont entourés lors de ce projet, me questionnant, me permettant d'avoir un esprit critique sur le travail effectué et qui m'ont accompagné et soutenu dans cheminement.<br>
  
 
=Matériel emprunté=
 
=Matériel emprunté=
Ligne 222 : Ligne 352 :
 
 
 
{| class="wikitable"
 
{| class="wikitable"
!Nom du matériel    !!     Nombre !!    Coût /p    !!       Lien composant !!   Composant reçu? !
+
!Nom du matériel    !!     Nombre !!    Coût /p    !!       Lien composant !!   Composant reçu?  
 
|-
 
|-
 
|'''Matériel pour la motorisation du bras: '''
 
|'''Matériel pour la motorisation du bras: '''
Ligne 236 : Ligne 366 :
 
| Oui (1 sur 1)
 
| Oui (1 sur 1)
 
|-
 
|-
|ARDUINO MEGA 256
+
|ARDUINO MEGA 2560
 
|      1
 
|      1
 
|      X
 
|      X
Ligne 251 : Ligne 381 :
 
|      1
 
|      1
 
|      X
 
|      X
|      Fournie par Monsieur FLAMEN
+
|      https://www.amazon.fr/Lixada-Interrupteur-dalimentation-Transformateur-Aluminium/dp/B00PXMO7TU/ref=sr_1_2?ie=UTF8&qid=1513601258&sr=8-2&keywords=alimentation+24V
 +
 
 
|      Oui (1 sur 1)
 
|      Oui (1 sur 1)
 
|-
 
|-
Ligne 351 : Ligne 482 :
 
|-
 
|-
 
|}
 
|}
=Livrable=
+
 
 +
=Livrables=
 +
Évaluation intermédiaire(21/12/2017):<br>
 +
- Mémoire Intermédiaire: [[Fichier:RapportIntermédiaire_PFE25_HART.pdf]]<br>
 +
- Soutenance intermédiaire: [[Fichier:Soutenance Intermédiaire PFE25 HART.pdf]]<br>
 +
<br>
 +
Évaluation finale(22/02/2018):<br>
 +
- Mémoire Final:[[Fichier:Mémoire Final PFE25 HART.pdf]]<br>
 +
- Soutenance Finale: ''Non disponible''<br>
 +
<br>
 +
Programme mouvement en cinématique directe:
 +
[[Fichier:Programme PFE25 Moveo.zip]]<br>
 +
(Programme + bibliothèque <Moveo.h>)<br>
 +
<br>
 +
Programme final sans la détection d'obstacles:
 +
//Insérer fichiers
 +
(Programme + bibliothèque <Moveo.h>)<br>
 +
<br>
 +
Programme de la détection d'obstacles et de la reprise de tâche:
 +
// insérer fichiers<br>
 +
(Programme sur axes + bibliothèque <Moveo.h>)<br>
 +
<br>
 +
<br><br>
 +
 
 +
'''PROJET DE FIN D’ÉTUDES; POLYTECH LILLE; DÉPARTEMENT INFORMATIQUE MICROÉLECTRONIQUE INFORMATIQUE; PROMOTION 2018'''

Version actuelle datée du 13 avril 2018 à 14:38

Bras robotique Moveo BCN3D

Cahier des charges

Présentation du projet

Le Fablab Lille est un lieu de fabrication ouvert à tous permettant à toute personne ayant un projet de trouver les moyens de le réaliser grâce au nombreuses machines numériques mises à disposition. Impression 3D, découpe laser, personnalisation d'objet, électronique, sont quelques unes des possibilités offertes. C'est un lieu d'échange qui prône le Do It Yourself et où des "makers" d'horizons différents peuvent concrétiser leurs idées. Le but du Fablab : rendre accessible le protypage, l'expérimentation, la personnalisation, et la production en petites série. De ce fait, des personnes de formations et d’horizons différents viennent afin de réaliser leur projet.
L’utilisation d’un cobot, ou robot collaboratif, peut donc s’avérer utile afin d’assister les « makers » en effectuant des tâches simples programmables sans risques de blesser l’utilisateur ou sans endommager son environnement.

Objectif du projet

L'objectif de ce projet est de réaliser un cobot, ou robot collaboratif. Ce robot serait un démonstrateur de bras robotique pouvant être utilisé en interaction avec les humains.
La première étape de ce projet sera tout d'abord de terminer la conception du bras avant de commencer la programmation. Deux modes de fonctionnement sont envisagés pour la réalisation de ce projet:

  • Déplacement axe par axe puis global du bras.
  • Mode d'aide permettant d'amplifier la force appliquée par un humain.
Diagramme 'Bête à corne'
Diagramme 'Pieuvre'

FP1: Assister l'utilisateur dans la réalisation d'une tâche.
FP2: Préserver l'environnement du bras (humain ou matériel).
FC1: Être programmable.
FC2: Interagir avec l'utilisateur.
FC3: Doit savoir soutenir une charge.
FC4: Protéger le câblage apparent.


Choix matériel et logiciel

Justification matérielle par diagramme FAST

Afin de réaliser ce projet, l'utilisation des composants suivants sera envisagé:

  • Le bras robotique open source Moveo BC3ND partiellement monté.
  • Une carte Arduino MEGA 2560afin de pouvoir modifier la position du robot.
  • Un joystick shield arduino afin de pouvoir contrôler le robot et le faire bouger.
  • Des moteurs pas-à-pas afin de motoriser le bras robotique de façon précise.
  • Des cartes de commandes TB6560 afin de contrôler les moteurs par le biais de l'arduino.
  • Des capteurs de types roues codeuses afin de pouvoir récupérer la position du robot.
  • Un écran LCD pour arduino afin de renseigner l'utilisateur sur le mode de fonctionnement.
  • Des capteurs de proximités afin de connaitre l’environnement du robot.
  • Des sondes de courant, afin d'effectuer le monitoring du courant dans les moteurs et détecter une collision.
  • Un accéléromètre afin de détecter une éventuelle détection.



Liste des tâches

La liste des tâches à effectuer pour réaliser ce projet au mieux est la suivante:

Tâches préliminaires:

  • Terminer la conception du bras robotique.
  • Motorisation du bras robotique.


Partie 1: Base du mouvement:

  • Mouvement du bras sur 1 axe en boucle ouverte.
  • Mouvement du bras en chaine cinématique directe.


Partie 2: Mode collaboratif sur 1 axe:

  • Détection d'un obstacle sur le premier axe.
  • Reprise du mouvement après obstacle.


Partie 3: Mode collaboratif sur 2 axes:

  • Détection d'un obstacle sur le deuxième axe.
  • Reprise du mouvement après obstacle.
  • Combinaison programme pour les 2 axes simultanément.


Partie 4: Robot global:

  • Détection sur les autres axes.
  • Reprise du mouvement après obstacle.
  • Combinaison des programmes pour détection sur le robot entier.


Calendrier prévisionnel

Pour la réalisation de ce projet, les tâches et leurs durées (exprimées en jours) sont les suivantes:

TableauTaches.JPG







Le déroulement du projet complet comprenant la liste des tâches à effectuer ainsi que le diagramme de Gantt du projet sont visible sur le fichier PDF suivant:
Fichier:Gantt PFE.pdf







Des durées plus grandes sont accordées pour les premières phases du projet, c'est-à-dire pour le mode collaboratif sur le premier axe. L'hypothèse est faite qu'ensuite, il faudra moins de temps pour réitérer ces tâches sur les autres axes car la méthode pour détecter les obstacles et reprendre le programme sera alors connue.

Bibliographie

Afin de mieux savoir ce qu'est un "cobot" ou robot collaboratif, voici quelques articles intéressants à lire afin de mieux comprendre les avantages d'un robot collaboratif par rapport à un robot industriel:


Les liens suivants présentent 3 robots collaboratifs commercialisés dans l'industrie:
Le robot 'Baxter' de l'entreprise Rethink Robotics:

'Sawyer', le deuxième robot collaboratif de rethink Robotics:

Le robot collaboratif de ABB Robotics, 'YuMi':

Travail Réalisé

Dans cette partie, je vais détailler l'ensemble du travail que j'ai réalisé lors de ces séances de projet.

Partie Préliminaire

Terminer la conception du bras robotique

Afin de terminer la conception du bras robotique Moveo BCN3D présent au Fabricarium, il convient d'achever la création de plusieurs éléments du bras. Il faut entre autre créer le préhenseur venant se placer au bout du bras ainsi que la base sur laquelle viendra se fixer notre robot démonstrateur.

Préhenseur

Pour le préhenseur du bras, je pensais réutiliser le préhenseur que j'ai dû designer lors des séances "d'initiation à la mécatronique" lors du dernier semestre. Ce préhenseur (présenté ci-dessous) à été réalisé sous le logiciel de CAD en ligne 'onshape'. Ce logiciel a pour intérêt de sauvegarder chacune des création sur un cloud, ce qui nous permet d’accéder à nos fichiers depuis n'importe quel PC.
Pince1.JPG Pince2.JPG
Le point fort de ce type de préhenseur est qu'il peut prendre des objets ronds ou plats grâce aux biellettes qui permettent à la pince de se courber pour s'adapter à la forme de l'objet.

Pince1done.JPG Capteur pression.JPG

Ci-dessus, le préhenseur monté après que toutes les pièces aient été imprimé. Des vis sont utilisées afin de servir d'axes. De plus j'ai rajouté des capteurs de force au bout des doigts de la pince (photo de droite). Leur intérêt est de mesurer la force appliquée à l'objet entre les doigts et donc de savoir si on exerce une trop grosse pression sur l'objet. Les 2 câbles de chaque capteurs ont été collés ensemble avec du chatterton afin d'éviter leur dispersion et ainsi diminuer le risque qu'ils s'arrachent durant une tâche.
Cela conclut la partie "réalisation du préhenseur".

Base du robot

Pour ce projet, il faut également créer une base pour accueillir le bras. Cette base devra être assez lourde et assez solide afin de supporter le poids du robot ainsi que de sa charge.Cela devrait suivre l'exemple suivant:

BaseC.JPG





Ci-dessous, le plan de menuiserie pour le perçage de la plaque qui servira de support pour le bras:
Fichier:Support Cobot.pdf



Réalisation des devis

-Devis du 16 octobre 2017:
Le bras robotique ayant déjà été commencé lors de l'année précédente par le fabricarium, une commande pour les moteurs avait déjà été faite. Malheureusement, le fournisseur de ces moteurs est devenu injoignable et n'a pas livré les moteurs. Je dois donc réaliser un devis afin d'acheter tout le nécessaire pour motoriser le bras ainsi que tous les capteurs dont j'aurai besoin pour le transformer en cobot.
Après quelques recherches, le devis qui est ressorti et qui a été validé par les tuteurs du projet est le suivant:
https://drive.google.com/open?id=0ByKP9w_p1fHAMUVXT2txS0hKT2s
Ce devis est également consultable dans la partie 'Matériel Emprunté' consultable en bas de page.

Motorisation du bras Robotique

LocalisationM.JPG

La conception du bras étant terminée. Il faut désormais motoriser le bras afin de le faire bouger. Le bras bouge au travers de 6 moteurs, chacun contrôlé par un driver TB6560. L'ensemble des drivers est contrôlé par un RAMPS qui s'occupe de gérer les ordres pour chaque moteur, pour les ventilateurs mais il peut également gérer un servo-moteur.
Les drivers TB6560 ont pour particularité de laisser un couple de maintien dans les moteurs même lorsque ils ne sont pas utilisés. Cela permet donc que le bras robotique ne s’effondre pas lorsque nous ne commandons plus les moteurs.

CommandeMoteur.JPG

Comme vous pouvez le voir sur la photo de gauche, chacun des moteurs entraine une poulie, également imprimée 3D. Cette poulie entraine une courroie synchrone dentée reliée aux secteurs dentés du bras robotique.
Pour une question d’esthétisme, le bloc d'alimentation 220V->24V a été fixé sous le socle du robot. Une boite a également été réalisée afin de stocker les 6 drivers ainsi que pour stocker le Ramps. Le but étant de cacher ces drivers entourés de câbles tout en les laissant à proximité du bras sans trop les éloigner.
Le schéma de montage adopté pour le branchement du moteur à la TB6560 et du TB6560 au Ramps 1.4 est le suivant:

TbDrive.JPG

RampsFinal.JPG

DriversConnectés.JPG
GaineThermo.JPG






Pour l'ensemble des moteurs, il a fallu agrandir la longueur des fils afin de pouvoir les relier jusque aux drivers. Tous les moteurs possèdent 4 fils: un noir correspondant au A+, un vert correspondant au A-, un rouge correspondant au B+ et un bleu correspondant au B-. Mais pour deux moteurs, celui de la pronation/supination et le moteur du poignet. Il convient donc de faire un tableau d'équivalence des câbles pour signaler quel fil de couleur devient quelle couleur et à quelle phase ils correspondent:

Couleur du fil Nouvelle couleur Phase correspondante
Moteur Poignet:
Rouge Noir A+
Jaune Rouge B+
Bleu Vert A-
Blanc Bleu B-
Couleur du fil Nouvelle couleur Phase correspondante
Moteur Pronation/Supination:
Orange Violet A+
Orange & Blanc blanc A-
Rouge Rouge B+
Rouge & Blanc Marron B-
Noir Noir A-
Noir & Blanc Bleu A+
Jaune Jaune B-
Jaune & Blanc Bleu B+
AlimBras.JPG


Après discussions avec Monsieur FLAMEN, j'ai dû changer la position de mon bloc d'alimentation. En effet, celui-ci était placé trop proche du bord de la planche sous le robot et présentait des risques de blessures par électrocution. J'ai donc décider de la placer plus profondément sous la plaque de telle façon à ce que personne ne puisse toucher le bloc d'alimentation ou le convertisseur en voulant soulever le robot. Des cavaliers ont également installés afin de prévenir l'arrachage des câbles.






Les moteurs sont donc installés et le câblage fait et protégé. Le bras est donc prêt à être utilisé de façon perenne sans risque de dégradation matérielle. Il me faut maintenant commencer le codage du robot via ma carte arduino MEGA 2560.

BrasFinal.JPG

Partie 1: Base du mouvement

Mouvement du bras sur 1 axe en boucle ouverte

Maintenant que le moteur de la base est reliée aux cartes de commandes, nous pouvons commencer à le faire bouger. Pour cela, nous nous servons d'une carte Arduino Mega 2560. Le programme sera implanté sur cette carte et commandera le Ramps 1.4 qui est un shield Arduino et qui vient donc se placer par dessus la carte.
Pour faire bouger le moteur pas-à-pas, une librairie 'stepper' est déjà présente dans les librairies par défaut Arduino, mais cette dernière n'est pas très adaptée pour la commande de plusieurs moteurs. C'est pour cela que je me sers de la librairie 'AccelStepper[1]' qui simplifie le code pour ajuster plus précisément la vitesse du moteur, l’accélération ou effectuer des mouvements complexes.
Le code et le résultat sortant est le suivant:

Homing Base.JPG


Ce programme fait bouger la base du bras. L'opérateur le met dans une position initiale prédéfinie, puis le bras fait une rotation pour se mettre dans la position 'HOME'. Un arrêt d'urgence a été implémenté afin de stopper le Homing en cas de problèmes. Il suffira à l'utilisateur d'envoyer un 1 sur le port série d'Arduino. Ce dernier est utilisé afin de visualiser la valeur des variables ainsi que l'avancée du programme.
Le problème majeur du moteur pas-à-pas, est qu'il ne connait pas sa position au démarrage. Ainsi lorsque le moteur démarre, sa position est donc considérée comme la position 0. Le robot ne peut donc pas bouger pour se mettre en position HOME quelle que soit sa position initiale. En effet, si le robot commence en bout de course, il cherchera à continuer à tourner, forçant sur la poulie et la courroie pour continuer sa rotation.

Mouvement du bras en chaine cinématique directe

Moteur Code Switch TB6560 Nombre de pas nombre de degrés vitesse
Base 111 101100 7800 180° 2000
Épaule 100 001100 4360 180° 1000
Coude 101 001000 5946 225° 1000
Rotation poignet 101 001100 2100 450° 500
Poignet 011 001100 4300 235° 1000

Maintenant que le mouvement sur la base est maitrisé et que la bibliothèque AccelStepper est maitrisée. Je peux étendre mon programme à l'ensemble du bras robotique. L'idée est, comme pour la base, de créer un programme où l'ensemble du robot se met en position HOME. Puis l'utilisateur peut faire bouger chacun des axes à son envie et peux également le faire revenir à sa position de repos. Il faudra également gérer les sorties de la zone d'activité.
Je décide donc de créer ma propre librairie arduino que je nomme 'Moveo'. Elle contiendra l'ensemble des fonctions dont j'aurai besoin pour faire bouger mon robot. Voici la classe que je créé:

ClassMoveo.JPG


On retrouve les fonctions suivantes:
- Une fonction de récupération de l'axe demandé.
- Les fonctions de mouvement de chaque axe.
- Les fonctions de récupération des positions des moteurs.
- Les fonctions de retour en position HOME et de repos.
- La fonction de calcul des zones impossible à atteindre pour les moteurs.

On peut donc appeler ces fonctions en écrivant 'moveo.PositionP()' pour récupérer la position du poignet.



L'utilisateur communique donc par le biais de la liaison série avec le bras robotique. Chacune des positions est rappelée et il n'y a aucun risque que le robot soit endommagé par un mauvais ordre de mouvement.

Moniteur.JPG


Au dessus, vous pouvez voir l'affichage sur le port série du début du programme jusque à la mise en position HOME. La vidéo ci-dessous montre quant à elle les mouvement du robot durant ces phases.

Video de mise en position HOME:









REMARQUE:Le robot rencontre un problème majeur, un souci thermique dû à l'échauffement des moteurs vient gêner la rotation des poulies. En effet, pour garder un couple de maintien, je dois continuer d'envoyer du courant dans les moteurs. Lorsque le moteur bouge, cette énergie est transformée majoritairement en mouvement, et un peu en chaleur. Mais lorsque le moteur est à l'arrêt, cette énergie est majoritairement dissipée en chaleur. Cela résulte en une grosse hausse de chaleur dans le moteur et dans son axe. Si le moteur est alimenté pendant trop longtemps, la poulie en PLA commence à se déformer et à se désaxer. Ce qui fait que je ne peux plus me servir des axes au poulies déformée.
La solution apportée est donc de monter un dissipateur sur le moteur couplé à un ventilateur. Le ventilateur serait commandé par le Ramps 1.4 qui possède des entrées de contrôle pour ventilateur.
C'est le robot avec le programme à cet avancement du projet qui sera présenté aux journées portes ouvertes de Polytech Lille ainsi qu'à l'évènement "Maker Faire" du 9-10-11 février 2018.
'Ce programme ainsi que la bibliothèque créée sont consultables dans la partie des livrables.

Partie 2: Mode collaboratif sur 1 axe

Détection d'un obstacle sur le premier axe

Le robot est désormais capable de se mouvoir comme voulu via la liaison série. Mais ce n'est pas encore un robot collaboratif. Pour cela, il doit être capable de détecter une collision, ce qui va maintenant être le nouvel objectif de mon projet.
Pour détecter ces collisions, je décide de regarder du coté des moteurs. En effet, en cas de rencontre avec un obstacle, il y aura forcement une hausse du couple dans le moteur de l'articulation. Je décide donc de monitorer mon courant via une sonde de courant. Ce dernier est relié au couple par la relation Cm = Kc.Im, avec Cm le couple moteur, Kc la constante de couple et Im le courant traversant le moteur.
Pour commencer, j'utilise un oscilloscope afin de voir "la tête" du courant présent dans l'une des phases du moteur du coude. Les résultats sont les suivants :

Coude Sans Obstacle.jpg PWM Coude SsObstacle.jpg

je vais maintenant mettre un obstacle sur la trajectoire de mon robot lors d'une levée du coude. Le but est de visualiser les hausses de courant dans le moteur.

Coude Obstacle.jpg


On peut remarquer des sinusoïdes plus grandes que d'autres. Ce sont les hausses de couple qui l'entrainent. Mais ce pics ne reste pas sur plusieurs période car lorsque le moteur rencontre un obstacle en montant, il redescend puis remonte jusque à re-rencontrer l'obstacles. Ce pics d'une amplitude de 1.9A s'élève de 0.3A au dessus des cycles normaux (1.6A). Je vais donc essayer de détecter ces pics.
Je n'arrive pas encore a récupérer de données sur les PINs auxiliaires du Ramps. J'utilise donc une arduino UNO pour l'instant afin de récupérer les données des transducteurs de courant. En effet, les documentations restent assez vague quant aux numéros de PINs de la partie AUX ou SERVO ([2])
Je lance un programme qui fait tourner la base en continu. Puis je lance un programme sur mon arduino UNO qui est connectée au transducteur de courant qui visualise le courant de la base. J'utilise alors l'outil 'Traceur Série' de l'IDE arduino pour visualiser le courant mesuré. Le programme en question affiche les formes d'onde du courant dans le moteur ainsi qu'un signal d'alarme. Lorsque un pic de courant est détecté, le signal d'alarme passe à 255 comme sur l'image ci-dessous:

ObstacleDetection.GIF

A gauche, en bleu, le courant dans le moteur, en rouge le signal d'alarme. Lorsque je place ma main pour bloquer le bras, un pic ( positif ou négatif selon le sens de rotation ) apparait. Le signal d'alarme rouge passe donc à 255. La détection d'obstacle est donc réussie.

Pour clore cette partie, je vais me pencher sur un moyen de n'utiliser que le Ramps et non la carte arduino UNO couplée au ramps pour détecter l'obstacle. Je pourrai alors faire un programme combinant la détection d'obstacle sur la rotation de la base et le mouvement, sujet de la prochaine partie.

Remarque: Le monitoring du courant se fait via un capteur à induction LEM qui est installé sur la phase B- du moteur. Le fait de monitorer sur plusieurs phases ajoute du bruit dans le signal qui ne devient plus exploitable.








Reprise du mouvement après obstacle

J'ai fait plusieurs recherches autour du ramps, 4 possibilités s'offraient à moi pour récupérer le courant du moteurs:

  • La première était d'utiliser une arduino UNO sur laquelle brancher toutes les sondes, puis si une collision était détectée, la carte enverrait une donnée à l'arduino MEGA pour lui dire de stopper le mouvement.
  • La deuxième solution était d'utiliser des PINs inutilisés du ramps comme le X_MIN_PIN, de le convertir en entrée pour lire la donnée dessus.
  • La troisième était d'utiliser les PINs AUX du ramps. Certains étant analogiques, la possibilité de récupérer la donnée semblait viable.
  • La dernière solution était d'utiliser les entrées associées aux sondes de températures pour récupérer la mesure.

La solution que j'ai finalement retenu est la dernière. En effet la première est viable, mais l'utilisation d'une carte qui communiquerai avec la MEGA n'est pas optimale. Elle pourrait néanmoins selon moi être revue dans le cas où on utilise plus de capteurs. En rajoutant les capteurs de proximité, les capteurs laser, l'accéléromètre et les transducteurs, on peut facilement imaginer la UNO avec un programme interne qui gèrera les capteurs, calculera les risques et qui enverra les données si nécessaires à la MEGA. La deuxième solution n'a pas non plus été retenue car elle ne retourne rien, en effet j'ai essayé de tourner les PINs en sortie mais la seule chose que je pouvais lire n'était que du bruit. La troisième solution, qui était d'utiliser les AUX de la ramps pour lire les mesures, n'a pas été retenue car je n'arrivais pas à retrouver les PINs de la MEGA correspondants aux PINs de la ramps. Je n'ai donc pas pu utiliser cette solution car ces PINs sont pour la plupart utilisé pour le branchement de cartes SD, écrans LCD... La ramps étant principalement conçue pour les imprimante 3D, elle n'a pas été designé pour qu'on puisse rajouter des capteurs.

PIN thermo.JPG

J'utilise donc les entrées faites pour les sondes de température sur la ramps. Le seul bémol étant que je n'ai que trois entrées, cela me permet d'au moins contrôler la rotation de la base, l'épaule et le coude. La rotation du poignet étant mécaniquement défectueux et le poignet étant hors service pour cause thermique. Les trois entrées sont donc largement suffisantes.
J'alimente donc ma sondes avec les 5V que fourni le ramps et je met le GND et la sortie sur les pins du premier capteur de température.

Je commence donc la création d'un programme simple pour la base: Une rotation de 90° dans un sens, puis de 90° dans l'autre en continu. Pour cela, aucun problèmes, je maitrise la bibliothèque de mouvement des moteurs.
Pour l'instant, j'utilisais la commande 'stepperX.move(value)' suivie d'un 'stepperX.run()' dans un while pour bouger le moteur. Le code que je vais rajouter va se trouver dans la boucle:

Mouvement detectionCollision.JPG




















Le code est simple, je lui donne le nombre de pas à effectuer, ici 90 degrés (1 degré = 43.33 pas; cf: Mouvement du bras en chaine cinématique directe). Puis je lance le mouvement, dans la boucle, j'effectue un pas et je fais l'acquisition du courant. Si j'ai atteint la position voulue, je sors du while. Si un pic de courant est détecté, je le dis, j'affiche la position où a eu lieu la collision et je lance la fonction 'test_collision' d'où je ne sortirai que lorsque l'obstacle ne sera plus présent.
Le contenu de la fonction est le suivant:

CodeArduino detectionCollision.JPG
















Lorsque une collision est détectée, j'ai eu l'idée d'agir comme un aveugle le ferai. Une fois la collision détectée, je me stoppe pendant 1 seconde puis je regarde toutes les 500ms si l'obstacle est toujours présent. Ainsi le bras tourne et si il ne rencontre plus rien sur 300 pas, il considère l'obstacle comme disparu. Il reprend donc sa tâche. Si l'obstacle est toujours présent, il faudra quelques pas pour détecter de nouveau la hausse de courant dans le moteur. C'est pour cela que si l'obstacle est détecté dans les 400 pas, il est compté comme étant toujours présent, et la position est réinitialisée à sa position au départ qui est mise en entrée de la fonction.

Il faut maintenant vérifier que le robot répond bien aux normes en vigueur. Ces normes sont données par l'INRS au paragraphe 4.5 de la brochure: Fichier:Securité des equipements Prévention des risques mécaniques.pdf.
Ce paragraphe se résume dans le tableau suivant:

NormeCollaboratif.JPG

Dans notre cas, nous suivrons la série de valeurs 2 car le robot collaboratif est considéré comme compliant. Il faut donc calculer l'énergie à l'impact créée par le robot:
La vitesse du robot est de 0.24 m/s.
Son poids étant de 4.8 Kg pour la partie mobile.
Son énergie à l'impact est donc de 0.07J.
Le robot rentre donc plus que largement dans les normes. Une si faible énergie est due au fait que le robot soit en PLA et ne se déplace pas à si grande vitesse. La norme a quant à elle été faite pour des robots fait en matières métallique et se déplaçant à des vitesses supérieures au m/s.
Le robot peut donc être considéré comme collaboratif sur le premier axe.

Partie 3: Mode collaboratif sur les 3 axes

Détection d'un obstacle sur le deuxième et troisième axe et Reprise de la tâche

Pour ajouter le mode collaboratif sur les 2 autres axes, ceux de l'épaule et du coude, il convient de suivre le même cheminement que pour le premier axe: détection d'obstacle, reprise de tâche puis fusion des 2 programmes.
Je visualise tout d'abord le courant qui passe dans le moteur par le biais de mon transducteur de courant. Ainsi je peux connaitre les valeurs Min et Max du courant dans mon moteur et fixer les seuils d'alarme.

3 axes.JPG


Ces seuils sont:

  • Pour l'épaule, sont de 470 pour la limite basse et 552 pour la limite haut.
  • Pour le coude, sont de 470 pour la limite basse et 550 pour la limite haut.

Une fois que je suis capable de détecter l'obstacle et d'arrêter le robot. Le programme pour la reprise de tâche reste fondamentalement le même.

Je crée donc 2 fonctions :

  • Detection_Collision(): Prends en entrée la valeur du courant de chaque moteur. Puis vérifie que ces valeurs ne dépassent pas les seuils définis. Si valeur > seuil , lancement de la fonction test_collision().
  • Test_Collision() : Prends en entrée un entier relatif au moteur bloqué ainsi que la position de collision. Vérifie périodiquement si l'obstacle est toujours présent. On ne sort de la fonction qu'une fois qu'il n'y a plus d'obstacles.



    a

Bilan

Afin de clore ce projet, il convient de faire le bilan sur ce dernier. Je parlerais donc dans la suite de ce chapitre du travail qu'il resterait encore à faire si on avait voulu aller jusqu'au bout du projet. Je continuerai ensuite avec les compétences que j'ai pu acquérir lors de ce Projet de Fin d’Études. Enfin, le dernier chapitre sera consacré au remerciements des différents protagoniste qui ont entourés ce projet.

Travail Restant

Malheureusement, ce projet n'a pas pu être terminé. Il reste encore beaucoup de choses à faire. En effet, l'aspect collaboratif du robot n'est implémenté que sur 3 axes. Il faut donc l'étendre sur les 3 autres axes. Il faut donc rechercher un autre moyen d'acquérir le courant, pour l'instant l'acquisition se fait par le biais des 3 entrées thermistances du Ramps. Il faut donc trouver une méthode pouvant se servir des 6 transducteurs. Il faut également ajouter la partie d'évitement d'obstacles avec les capteurs à ultrasons et les capteurs lasers. Il aurait également fallu installer les accéléromètres sur le robot afin d'avoir une deuxième façon de détecter une collision.
Enfin, il conviendrai de déterminer le modèle du bras robotique Moveo afin de faire sa commande non pas en cinématique directe mais cette fois-ci en cinématique inverse.

Perspectives

De nombreux projets peuvent être imaginés autour du Moveo BCN3D. En effet, ce projet est un projet transversal, on y retrouve de nombreux domaines. On peut imaginer par exemple le contrôle du bras en cinématique inverse via un joystick. Ce contrôle peut se faire soit directement sur le robot, mais on peut aussi penser à un contrôle à distance du bras via une raspberryPi. Un mode apprentissage peut également être pensé. En enregistrant les positions du robot, on pourrait lui faire apprendre une tâche en le manipulant. Le robot serait alors capable de refaire toutes les trajectoires de la tâche. Enfin, on peut penser à des projets de traitement d'images: en connectant une caméra au robot ce dernier pour aller chercher, sur un tapis devant lui, uniquement les objets voulus et reconnus. Un mode de recopie du mouvement humain est alors envisageable soit grâce à cette caméra, soit via une batterie de capteurs sur le bras de l'utilisateur.

Remerciement

Enfin, je tiens à remercier énormément de personnes qui m'ont aidé de septembre à février sur ce projet.

Tout d'abords, je tiens à remercier mes tuteurs de projets, Monsieur ASTORI Rodolphe, Monsieur VANTROYS Thomas, Monsieur BOE Alexandre et Monsieur REDON Xavier pour les conseils qu'ils ont pu me prodiguer tout au long de ce travail.

Je tiens également à remercier Monsieur FLAMEN Thierry, technicien de la plate-forme électronique, pour les nombreux conseils qu'il a pu me fournir, notamment sur la partie câblage du robot.

Je remercie également l'équipe du Fabricarium: les Fab'Managers, pour leur accueil et les compétences qu'ils ont pu me faire acquérir notamment sur les machines telles que l'imprimante 3D, la découpeuse laser ainsi que les nombreuses autres machines disponible au Fabricarium.

J’adresse également une pensée pour l'ensemble des étudiants qui m'ont entourés lors de ce projet, me questionnant, me permettant d'avoir un esprit critique sur le travail effectué et qui m'ont accompagné et soutenu dans cheminement.

Matériel emprunté

Nom du matériel Nombre Coût /p Lien composant Composant reçu?
Matériel pour la motorisation du bras:
Stepper Motor SM42HT47-1684 1,8º step, 1,6 A, 3600 g·cm 1 39.50€ https://www.gotronic.fr/art-moteur-17hs19-2004s-18355.htm Oui (1 sur 1)
ARDUINO MEGA 2560 1 X Fournie par Madame PICHONAT Oui (1 sur 1)
Power Supply 12V 320W 1 59.49€ http://www.mouser.fr/ProductDetail/Mean-Well/RSP-320-12/?qs=sGAEpiMZZMsPs3th5F8koKpK7QW2TQkWfp7IWYmZbVQ%3d Oui (1 sur 1)
Power Supply 24V 1 X https://www.amazon.fr/Lixada-Interrupteur-dalimentation-Transformateur-Aluminium/dp/B00PXMO7TU/ref=sr_1_2?ie=UTF8&qid=1513601258&sr=8-2&keywords=alimentation+24V Oui (1 sur 1)
Stepper Driver tb6560 6 13.90€ https://www.amazon.fr/Gaoxing-Tech-Commutateur-Controller-Stepping/dp/B06XS1JFZV/ref=sr_1_1?ie=UTF8&qid=1510843843&sr=8-1&keywords=tb6560&dpID=515nGxW0BpL&preST=_SX300_QL70_&dpSrc=srch Oui (6 sur 6)
RAMPS V1.4 1 21.50€ https://www.gotronic.fr/art-shield-reprap-v1-4-ef02035-23540.htm Oui (1 sur 1)
Gear Ratio 5:1 Planetary Gearbox Nema 17 Stepper 17HS19-1684S-P 1 26,88$ https://www.amazon.com/Nema-Geared-Stepper-Motor-Ratio/dp/B00QA5WSDG Oui (1 sur 1)
Nema 23, 112mm, Ø8mm flat shaft SM57HT112-3004A, step 1,8º, 3A,28Kg·c 2 39.50€ https://www.gotronic.fr/art-moteur-23hs41-1804s-23050.htm Oui (2 sur 2)
Stepper Motor SM35HT36-1004A, 1,8º step, 1A, 1400g·c 1 51.89€ http://www.mouser.fr/ProductDetail/Applied-Motion/5014-042/?qs=sGAEpiMZZMsuSxY5Q00ZeTvKiImgkL1Dp1SSrO1T724%3d Oui (1 sur 1)
Stepper Motor nema 17 SM42HT33-1334, 1,8º step, 1,33A, 2200 g·c 1 35.77€ http://www.mouser.fr/ProductDetail/Applied-Motion/HT17-268/?qs=sGAEpiMZZMu0WtFXTgs3LjG5BN%2ffSKbGIxSJgTc2ESU%3d Oui (1 sur 1)
Breco belt T5, 16mm width, L 180cm 2m 20,17£ http://fr.rs-online.com/web/p/courroies-synchrones/4746053/ Oui (1 sur 1)
Power supply cable IEC 1,8m 1 6.88€ http://www.mouser.fr/ProductDetail/Qualtek/364002-D01/?qs=sGAEpiMZZMvXcJVS4l7FP2sIAhhtkKRCT8KLiX%2fC6pE%3d Oui (1 sur 1)
Servo moteur 24,5 à 30,1 Kg.cm 1 41.90€ https://www.gotronic.fr/art-servo-analogique-renforce-fs6530m-25837.htm Oui (1 sur 1)
Matériel pour la détection d'obstacles:
Transcducteur de courant 6 11.7€ http://fr.rs-online.com/web/p/transducteurs-de-courant/4362330/ Oui (6 sur 6)
Accéléromètre 1 X Fourni par monsieur Redon Oui (1 sur 1)
Capteurs à ultrasons 8 4.28€ http://fr.rs-online.com/web/p/capteurs-de-proximite-ultrasoniques/2370783/ Non (0 sur 8)
Capteur laser VL53L0X 4 12.71€ http://www.mouser.fr/ProductDetail/Adafruit/3317/?qs=%2fha2pyFaduidPXPXSuFTA9ZVIGxCC2z%2fV%252boS69d4h2XnmSaEMyLZBw Oui (4 sur 4)
Breadboard 1 X Fourni par monsieur Boe Oui (1 sur 1)

Livrables

Évaluation intermédiaire(21/12/2017):
- Mémoire Intermédiaire: Fichier:RapportIntermédiaire PFE25 HART.pdf
- Soutenance intermédiaire: Fichier:Soutenance Intermédiaire PFE25 HART.pdf

Évaluation finale(22/02/2018):
- Mémoire Final:Fichier:Mémoire Final PFE25 HART.pdf
- Soutenance Finale: Non disponible

Programme mouvement en cinématique directe: Fichier:Programme PFE25 Moveo.zip
(Programme + bibliothèque <Moveo.h>)

Programme final sans la détection d'obstacles: //Insérer fichiers (Programme + bibliothèque <Moveo.h>)

Programme de la détection d'obstacles et de la reprise de tâche: // insérer fichiers
(Programme sur axes + bibliothèque <Moveo.h>)



PROJET DE FIN D’ÉTUDES; POLYTECH LILLE; DÉPARTEMENT INFORMATIQUE MICROÉLECTRONIQUE INFORMATIQUE; PROMOTION 2018