BIOLOID commandé par Arduino : Différence entre versions

De Wiki d'activités IMA
(Premières fonctions de commande)
(Premières fonctions de commande)
Ligne 137 : Ligne 137 :
 
Une fois les prototypes et classes déclarés, nous pouvons désormais passer à la programmation des fonctions de commande. Pour cela nous nous sommes d'abord renseignés sur la manière de commander le servo-moteur via notre code (sans passer par le logiciel Bioloid). Nous avons trouvé des informations très intéressantes sur un site dédié à l'[https://github.com/7Robot/Eurobot-2012/tree/master/Arduino Eurocop 2012]  où quelques exemples d'utilisation des moteurs sont présentés. On y trouve notamment des informations sur la gestion du pin de contrôle de buffer en fonction des actions désirées et des fonctions utilisées.<br/>
 
Une fois les prototypes et classes déclarés, nous pouvons désormais passer à la programmation des fonctions de commande. Pour cela nous nous sommes d'abord renseignés sur la manière de commander le servo-moteur via notre code (sans passer par le logiciel Bioloid). Nous avons trouvé des informations très intéressantes sur un site dédié à l'[https://github.com/7Robot/Eurobot-2012/tree/master/Arduino Eurocop 2012]  où quelques exemples d'utilisation des moteurs sont présentés. On y trouve notamment des informations sur la gestion du pin de contrôle de buffer en fonction des actions désirées et des fonctions utilisées.<br/>
 
Nous avons donc appliqués ces méthodes pour coder nos fonctions, celles-ci nous permettront de contrôler directement les servos en position et en vitesse.
 
Nous avons donc appliqués ces méthodes pour coder nos fonctions, celles-ci nous permettront de contrôler directement les servos en position et en vitesse.
 
+
<br />
[[Fichier:moveSpeed.jpg‎|400px|alt=Texte alternatif|Code]]
+
[[Fichier:moveSpeed.jpg‎|500px|alt=Texte alternatif|Code]]
 
<br />
 
<br />
  
Ligne 144 : Ligne 144 :
 
Pour cela, étant donné que le moteur reçoit des consignes entre 0~1023 correspondant à 0~90°, on étalonne d'abord nos instructions via la fonction map.
 
Pour cela, étant donné que le moteur reçoit des consignes entre 0~1023 correspondant à 0~90°, on étalonne d'abord nos instructions via la fonction map.
 
On choisit ensuite des délais d'attente de 3 secondes pour bien voir les rotations. Le test s'est avéré opérationnel, nous pouvons désormais réfléchir à la conception de l'horloge robotique.
 
On choisit ensuite des délais d'attente de 3 secondes pour bien voir les rotations. Le test s'est avéré opérationnel, nous pouvons désormais réfléchir à la conception de l'horloge robotique.
 
+
<br/>
 
[[Fichier:test_dyna.jpg‎|300px|alt=Texte alternatif|Code]]
 
[[Fichier:test_dyna.jpg‎|300px|alt=Texte alternatif|Code]]

Version du 20 février 2016 à 14:31

Cahier des charges

Encadrant

Blaise Conrard
Pour le projet, nous avons directement pris rendez-vous avec Blaise Conrard afin de discuter de nos idées.

Présentation du projet

Les kits Bioloid sont des kits robotiques programmables qui se basent sur les servomoteurs intelligents Dynamixel. Ces servomoteurs Dynamixel sont reconnus comme les servomoteurs les plus performants pour la robotique personnelle et éducative. Nous avons eu l'opportunité en IMA3 de développer des programmes sur ces robots via le logiciel RoboPlus et son interface type grafcet. Pour ce projet nous avons l'opportunité d'aller plus loin en programmant directement avec une carte Arduino.

Objectif

Le but de notre projet, est de de développer une application permettant à notre robot Bioloid, commandé par Arduino, d'écrire l'heure sur une ardoise magnétique.

Description du projet

Notre robot pourra être utiliser par toutes personnes souhaitant connaître l'heure. Il indiquera l'heure d'une façon originale, puisqu'il l'écrira, chaque minute, sur une ardoise magnétique. L'horloge robotique, rendra donc un service de type informatif. Par soucis de lisibilité et d'esthétique, le robot ainsi que l'ardoise seront fixés sur une surface plane (verticale ou horizontale). De plus, le robot sera positionné à moins de 10 cm en dessous de l'ardoise. Etant donné que la carte arduino devra être alimenté de 12 Volts, il est nécessaire de disposer d'une prise secteur et d'un transfo à proximité du robot.

Pour mener à bien ce projet, nous avons établi plusieurs contraintes, à savoir :

- L'heure est écrite de la même façon que les afficheurs 7 segments
- Le robot possède deux bras, l'un pour écrire et l'autre pour effacer
- Le stylo aimanté est fixé à un bras, tout comme le levier d'effacement

Afin de se faire une image plus représentative du projet, voici un croquis du robot :

Logo jo.png
Nous avons pu également fixer des limites de temps :

- Toutes les 60 secondes l'ardoise magnétique s'efface
- Le temps pour nettoyer la surface doit être relativement court, de l'ordre de 2 secondes
- Le robot doit écrire l'heure en moins de 50 secondes

Contraintes électroniques :

- Alimenter la carte entre 9-12V
- Utiliser un buffer 3 états afin que la liaison TX/RX ne circule que sur un bus de données vers le servo.

Notre Bioloid, sera donc composés de deux bras commandés par les servos-moteurs AX12, directement programmés par l'Arduino. Dans un premier temps, nous réaliserons des fonctions élémentaires afin de bien comprendre l’interaction entre l'Arduino et les servos, puis nous passerons à la réalisation de l'application.
Nous avons choisi de programmer à l'aide de l'IDE Arduino en C++ afin d'utiliser les éléments de la programmation objet, ceci dans le but d'utiliser les notions étendues du langage au sujet des instances, classes et fonctions.

Matériel nécessaire

Matériel A commander Commentaires
Carte Arduino 0
Servos-moteurs AX12 0
Non inverting buffer 74HC126 2 Fournisseur : [1]
Résistance 50 Ohms 0
Résistance 10kOhms 0
Ardoise magnétique 1 Ardoise nécessaire pour l'application finale
Transfo 220V / 9V 0 Alim Arduino

Avancement du projet

Définition du sujet (Semaine du 25 janvier)

Pour répondre à la problématique énoncé dans le cahier des charges, nous devrons définir une méthode de programmation intuitive pour commander les servos-moteurs en temps réel. Pour cela, nous programmerons directement l'arduino qui contrôlera les servos-moteurs.

Arduino uno ax12.jpg

Les différentes étapes du projet seront :

1) Adapter électriquement l'arduino aux servos-moteurs (alimentation,commande...)
2) Créer des fonctions pour commander les moteurs
3) Incorporer une gestion du temps
4) Réfléchir à l'application finale (fonctions, contraintes ...)
5) Réaliser cette application

Partie électronique (Du 1er au 15 février)

Pour ce projet, nous devons remplacer le CM5 par une carte arduino, ceci afin d'avoir des possibilités de programmation étendue. Avant toute chose , étudions les caractéristiques électroniques du CM5.


Texte alternatif


Après avoir étudié ces caractéristiques, nous avons remarqué que l'on pourrait directement passer par les ports RX et TX de l'arduino pour le contrôle des servos-moteurs, il suffirait juste d'ajouter un composant 74HC126D pour les contrôles alternatifs de TX et RX. En effet ce buffer trois états permettrait de faire passer alternativement Rx ou Tx en état d'haute impédance, ceci dans le but de n'avoir qu'une unique information sur le bus data vers le servo.

Entrées Sortie
A B C
0 0 Z
1
0 1 0
1 1 1


Enfin, pour ce qui concerne l'alimentation, nous avons remarqué en lisant les caractéristiques de l'AX12 qu'il était nécessaire d'avoir environ 9V pour une alimentation correcte. Nous avons donc conclu qu'il serait nécessaire d'utiliser un transformateur 9V pour alimenter l'arduino, celui-ci pourra ainsi délivrer 9V par l'intermédiaire du pin VIN.

Après étude des caractéristiques du buffer 74HC126, et par soucis de matériel, nous avons choisi de remplacer ce composant par un buffer non inverseur SN74LS241N. Nous avons réalisé les branchements entre l'arduino et les servos via ce composant en nous aidant de la datasheet du CM5. De cette façon, il sera possible de se substituer du CM5 et de commander directement les servos via l'arduino.

Nous avons effectué quelques tests en connectant les ports TX et RX de l'arduino sur les différentes entrées du buffer 3 états. Nous avons finalement choisi de brancher TX sur la partie non inverseuse et RX sur la partie inverseuse du composant.

Texte alternatif

Ce qui donne pour notre circuit, la figure ci-dessous :

Texte alternatif


Premières fonctions de commande


Une fois la communication entre l'arduino et les servos rendu possible, nous allons désormais chercher à créer des fonctions dans le but de commander les servos moteurs en position et en vitesse. La première étape consiste à créer un fichier header dans lequel nous définirons les adresses des servos-moteurs.
Nous créerons également une classe Dynamixel dans laquelle nous spécifierons les différentes variables et méthodes nécessaires au contrôle des servos.

Texte alternatif

Une fois les prototypes et classes déclarés, nous pouvons désormais passer à la programmation des fonctions de commande. Pour cela nous nous sommes d'abord renseignés sur la manière de commander le servo-moteur via notre code (sans passer par le logiciel Bioloid). Nous avons trouvé des informations très intéressantes sur un site dédié à l'Eurocop 2012 où quelques exemples d'utilisation des moteurs sont présentés. On y trouve notamment des informations sur la gestion du pin de contrôle de buffer en fonction des actions désirées et des fonctions utilisées.
Nous avons donc appliqués ces méthodes pour coder nos fonctions, celles-ci nous permettront de contrôler directement les servos en position et en vitesse.
Texte alternatif

De cette façon nous avons pu effectuer notre premier test. Nous avons choisi d'effectuer une rotation de 90 degres en aller/retour. Pour cela, étant donné que le moteur reçoit des consignes entre 0~1023 correspondant à 0~90°, on étalonne d'abord nos instructions via la fonction map. On choisit ensuite des délais d'attente de 3 secondes pour bien voir les rotations. Le test s'est avéré opérationnel, nous pouvons désormais réfléchir à la conception de l'horloge robotique.
Texte alternatif