Youpi, testons les moteurs !
30 décembre 2009 Bricolage 2 commentairesJ’avais longuement expliqué dans cet article les étapes de fabrication d’un câble parallèle pour relier le robot Youpi à un PC standard.
Aujourd’hui je vais comme promis diffuser les quelques lignes de code permettant de tester l’ensemble des moteurs. Le programme est grandement inspiré de celui que l’on peut trouver sur le site du BTS-IRIS de Niort.
C’est un programme développé à la va-vite en C. Il pourra servir de base pour tous ceux qui comme moi souhaitent vérifier que tous les moteurs sont en bon état de fonctionnement.
Le code
robotest.c :
/*
Youpi Robot Test program
------------------------
This program has to be run as root
or with sufficient credentials (suid...)
*/
#include <stdio.h>
#include <stdlib.h>
#include <fcntl.h>
#include <unistd.h>
#include <sys/io.h>
// Change this to your parallel port
#define LPT 0x378
// Defines the byte type
typedef unsigned char byte;
/*
This functions writes a byte to the parallel port
Do not use any other way to do it as the robot needs to pause
between each instruction.
*/
void writelpt(byte b) {
int tempo = 1500;
outb(b, LPT);
usleep(tempo);
}
/*
This is the main function
*/
int main() {
//Variables
int i,j;
int steps = 600;
//Welcome message
printf("*** YOUPI ROBOT TEST PROGRAM ***\n");
//Tries to access parallel port
if(ioperm(LPT, 1, 1) != 0) {
perror("ioperm");
return 1;
}
//Initializes the robot
printf(" * Initialization\n");
writelpt(0x47);
writelpt(0x00);
//Orders earch motor to rotate
for(j=0; j<6; j++) {
printf(" * Test of motor %d\n", j);
//...into one direction
writelpt(0x80);
writelpt(0x00);
for(i=0; i<steps; i++) {
writelpt(0x40+j);
writelpt(0x00+j);
}
//...into the opposite direction
writelpt(0xBF);
writelpt(0x3F);
for(i=0; i<steps; i++) {
writelpt(0x40+j);
writelpt(0x00+j);
}
}
return 0;
}
Et le Makefile qui va avec :
CC=gcc CFLAGS=-W -Wall -O all: robotest robotest: robotest.c $(CC) $(CFLAGS) -o $@ $< clean: rm robotest
Quelques explications
Le manuel indique une vitesse de rotation maximale de 40°/s pour tous les moteurs, avec une résolution maximale de 0.03° par 1/2 pas. Chaque 1/2 pas est effectué grâce à l’envoi de 2 instructions par le port parallèle. Pour faire avancer le robot à cette vitesse maximale, il est nécessaire d’espacer chaque instruction d’un temps T en secondes, calculé ci-dessous :
Il faut donc espacer chaque instruction de 1500 µs, ce qui explique les 1500 à la ligne 27 du code. Descendre en dessous de cette limite est susceptible de provoquer des catastrophes inconnues, donc si vous essayez, cela sera à vos risques et périls.
Bugs connus
Avec un sommeil de 1500 µs entre chaque instruction, le programme devrait théoriquement être terminé en approximativement 2+6*(2+600*2)*2*0.0015 = 22 secondes, en négligeant le temps nécessaires aux autres instructions. Hors j’obtiens en moyenne un temps d’exécution à 58 secondes.
Ce phénomène est expliqué en partie par le paragraphe suivant, tiré de la page man 3 de usleep :
La période de sommeil peut être allongée par la charge système, par le temps passé à traiter l’appel de fonction, ou par la granularité des temporisations système.
En résumé, lors de mon test, la vitesse de rotation de chaque moteur n’est pour le moment pas optimale. J’avais fait d’autres essais en réduisant significativement cette temporisation à quelques µs, ou en utilisant nanosleep afin d’avoir une granularité plus fine, mais le temps d’exécution total n’est jamais descendu en dessous de ces 58 secondes. Je ne sais pas encore comment optimiser cette vitesse, cela fait appel à des notions d’architecture système et de programmation temps réel qui me manquent à l’heure actuelle. Dans tous les cas, même si la vitesse est à l’heure actuelle bridée, le programme est néanmoins capable de démontrer le fonctionnement correct de chaque moteur.
Informations complémentaires
J’en profite pour placer un rappel : au lieu de me contacter personnellement pour me demander de l’aide à propos de ce robot, merci d’effectuer cette démarche en laissant un commentaire sur ce site afin que les questions et réponses profitent à tout le monde.
NB : vous pourrez maintenant trouver en un seul clic tous les articles de ce site relatifs au robot Youpi grâce au tag Youpi.
De formation ingénieur en télécoms, je suis passionné par les technologies de l'informatique et de l'internet. Toujours prêt à réaliser des créations et à offrir des services sortant de l'ordinaire dans ces domaines, je présente ici les projets qui me tiennent à coeur. En présentant leurs difficultés mais aussi leurs succès, j'espère partager quelques astuces et idées. Je suis également l'administrateur du serveur qui diffuse la page que vous lisez :)