Premier programme avec Arduino : Evitement d’obstacle – Partie 2

Mis en avant

Voici la seconde partie de l’article concernant l’évitement d’obstacle.

Etape 4 : Programme d’évitement d’obstacle

Le code est plus ou moins proche d’une version fonctionnelle et finale. Voici tout d’abord le code source :

motor.c : Ce fichier définit les fonctions permettant de commander les moteurs à travers des fonctions associées à différents types de mouvement.

#include "motor.h"

void move_forward()
{
  analogWrite (E2, SPEED);
  digitalWrite(M2,LOW);
  analogWrite (E1, SPEED);
  digitalWrite(M1,HIGH);
}

void move_backward()
{
  analogWrite (E2, SPEED);
  digitalWrite(M2,HIGH);
  analogWrite (E1, SPEED);
  digitalWrite(M1,LOW);
}

void turn_right ()
{
  analogWrite (E2, 0);
  digitalWrite(M2,LOW);
  analogWrite (E1, SPEED);
  digitalWrite(M1,HIGH);
}

void turn_left ()
{
  analogWrite (E2, SPEED);
  digitalWrite(M2,LOW);
  analogWrite (E1, 0);
  digitalWrite(M1,HIGH);
}

void rotate_right ()
{
  analogWrite (E2, SPEED);
  digitalWrite(M2,HIGH);
  analogWrite (E1, SPEED);
  digitalWrite(M1,HIGH);
}

void rotate_left ()
{
  analogWrite (E2, SPEED);
  digitalWrite(M2,LOW);
  analogWrite (E1, SPEED);
  digitalWrite(M1,LOW);
}

void stop_motor ()
{
  analogWrite (E1, 0);
  analogWrite (E2, 0);
}

sensor.c : Gestion des obstacles.

#include "sensor.h"

int static r = 0;

void handle_obstacle ()
{
   int i;
   int left_avg = 0;
   int right_avg = 0;

   if (r == 1024)
   r = 0;

   for (i = 0; i < 5; i++)
      left_avg += analogRead(LEFT_SENSOR);

   for (i = 0; i < 5; i++)
      right_avg += analogRead(RIGHT_SENSOR);

   left_avg = left_avg / 5;
   right_avg = right_avg / 5;

   // zero obstacle in the both side
   if (left_avg < CONF_SENSOR && right_avg < CONF_SENSOR)   
   {
      move_forward();
      delay (300);
   } 
   // one obstacle on the left side   
   else if (left_avg >= CONF_SENSOR && right_avg < CONF_SENSOR)   
   {     
      turn_right ();  
      delay (300);   
   }   
   // one obstacle on the right side  
   else if (right_avg >= CONF_SENSOR && left_avg < CONF_SENSOR)
   {
      turn_left ();
      delay (300);
   }
   else
   {
      stop_motor();
      move_backward();
      delay(500);
      if (r % 2)
         rotate_left();
      else
         rotate_right();
      r++;
      delay (1500);
   }
}

Enfin le “main” de mon programme :

romeo.c : Fonction main du programme

#include "motor.h"
#include "sensor.h"

void setup(void)
{
  int i;
  for (i = 6; i     pinMode(i, OUTPUT);

  Serial.begin(19200);
  move_forward();
}
void loop(void)
{
  handle_obstacle();
  move_forward();
  delay(15);
}

Ainsi dans le fichier sensor.c, nous retrouvons le code correspondant à la gestion des obstacles. Nous avons deux capteurs actuellement sur la plateforme mobile.

TODO : AJOUTER PHOTO ROBOT + CAPTEURS + AJOUT CONE VISIBILITE

Le code ici reste très simple, nous allons récupérer 5 fois les valeurs sur nos capteurs et nous calculons la moyenne des valeurs obtenues. Cette étape permet d’augmenter la précision puisque les capteurs peuvent parfois renvoyer des valeurs erronées.

Ensuite nous avons 3 cas à gérer :

  1. Aucun obstacle détecté par nos capteurs : J’avance tout droit
  2. Un obstacle détecté sur l’un des capteurs : Je me dirige dans la direction opposé a l’obstacle détecté
  3. Les deux capteurs détectent un obstacle : Je recule, effectue une rotation à 90° sur la gauche ou la droite.

Les résultats sont plutot encourageants comme vu lors d’un article précédent.

Ajout d’un repo pour le projet et avancement

Suite au conseil qu’on m’a donné, j’ai opté pour deux capteurs disposés a l’avant de façon à détecter les objets sur la gauche et sur la droite à 45 degrés de l’avant de ma plateforme. Les résultats sont plutot encourageant. La Snowball sera commandée d’ici quelques jours.

En attendant j’ai mis mon code sous git et ajouter un repo à github pour me faciliter la vie.
Lien du gitweb : https://github.com/Evanok/telesurveillance

De plus en ayant marre de toutes ces windowseries et de java, je développe dorénavant sur ma debian squeeze, surtout que je ne peux travailler sur ma snowball que depuis un linux.

Enfin la encore pour une meilleur lisibilitée, l’IDE Arduino direction la poubelle pour être remplacé par un bon vieux Makefile.

La prochaine étape est la mise en place d’un Bus I2C entre ma carte arduino Romeo et la snowball n’ayant pas de RS232 sous la main. Pour cela je me suis procuré des résistances et une plaque d’essai. Le cablage semble simple, le plus dur étant surment le software surtout coté Snowball ou il n’existe probablement pas de bibliothèque de haut niveau qui gère l’I2C. Au moins ca m’apportera une bonne compréhension du protocole.

Voici une vidéo de la plateforme en action après l’intégration d’un second capteur :

Il commence à bien gérer les obstacles mais il est beaucoup plus lent.

Pour finir, vous trouverez un lien vers le repo dans le menu sur la droite grace à une magnifique extension WordPress nommée Github WordPress Widget.

Premier programme avec Arduino : Moteur, Capteur et évitement d’obstacle

Mis en avant


Etape 1 : Mise en place de l’environnement

Sur Windaub rien de plus simple, il suffit de télécharger l’IDE Arduino ici

Concernant la configuration la encore c’est très simple, il suffit de :

  • Choisir le modèle de sa carte dans la liste disponible du menu Tools > board
  • Définir le port de communication utilisé dans Tools >Serial Port

De plus il existe un système de débug via le port série via le menu Tools >Serial Monitor, celui ci permet de debugguer son programme assez facilement a l’aide de la fonction Serial.write (XXX). Nous pouvons même simuler l’envoi de commande via une entrée standard toute prête.

Etape 2 : Premier programme : Test des moteurs

Voici un petit code permettant de tester vos branchements moteurs

int E1 = 5; //M1 Speed Control
int E2 = 6; //M2 Speed Control
int M1 = 4; //M1 Direction Control
int M2 = 7; //M2 Direction Control

int speed = 200;

void run_motor()
{
analogWrite (E2, speed);
digitalWrite(M2,LOW);
analogWrite (E1, speed);
digitalWrite(M1,HIGH);
}
void setup(void)
{
int i;
for(i=6;i<=9;i++)
pinMode(i, OUTPUT);

Serial.begin(19200); //Set Baud Rate
}
void loop(void)
{
run_motor();
}

Un programme arduino se compose de deux fonctions principales. Une fonction setup correspondant a l’initialisation et une fonction loop correspondant au programme qui sera exécuté comme son nom l’indique en continue.

Dans la fonction setup, nous définissons que les pin correspondant aux commandes moteurs sont en mode output. En effet nous avons besoin d’envoyer des valeurs a nos moteurs, donc en toute logique nous choisissons le mode output. Ici les pins correspondant aux moteurs vont de 4 a 7, attention selon la version de votre board, ces pins peuvent être différents, ceci est a déterminer a l’aide des indications sur les datasheets ou plus simplement directement sur la carte. Enfin le serial.begin permet de définir la vitesse de transmission du port série. Celle ci doit être la même dans le mode sérial monitor si vous voulez communiquer de façon correcte avec votre carte.

Dans la fonction loop, nous appelons la fonction qui active les moteurs. AnalogWrite comme son nom l’indique permet d’écrire sur un pin analogique tandis que le DigitalWrite permet d’écrire sur un pin digitale. Ainsi sur le pin de direction on peut envoyer LOW ou HIGH selon que vous vouliez mettre vos moteurs en marche arrière ou avant, ensuite pour ce qui est des pins de vitesse, on y définit une vitesse celle ci étant en bytes la fourchette de valeur est 0 – 255.

Vous allez me dire qu’il y a un problème dans mon code ? Et bien oui mes deux moteurs ne semblent pas tourner dans le même sens. Et bien pas vraiment, au cours de mon montage j’ai donc branché deux moteurs en parallèles sur chaque contrôleur moteur ( Il y en a que deux sur la carte, 4 moteurs donc pas le choix). Cependant j’ai fait mes soudures au hasard, ainsi il s’est avéré que mes deux moteurs ne sont pas branchés dans le même sens de polarité. Ainsi si je veux aller en marche avant avec l’un je dois lui envoyer LOW, tandis que l’autre a besoin de HIGH. Ceci n’est pas très gênant étant donné qu’on programme notre petite fonction une fois et qu’après on n’y touche plus.

Pour tester le programme rien de plus simple, il y a un bouton upload. Attention sur certaine carte dont la Romeo, il est nécessaire de reset la carte entre chaque nouveau upload de code. Pour cela, il y a en général un bouton sur la carte. Ainsi il vous suffira d’appuyer sur le bouton de reset brièvement juste avant de lancer l’upload.

Finalement, on débranche son robot, on enclenche l’interrupteur et on espère que cela fonctionne, sinon a vous la chasse au faux contact, mauvaise soudure, etc..

Etape 3 : Intégration de capteur et arrêt de la plateforme a la rencontre d’un obstacle

capteur utilisé :  Module capteur de distance infrarouge Sharp GP2Y0A21  (datasheet)

Nous allons tout d’abord brancher notre capteur. Celui que nous utilisons est analogique, nous allons donc le brancher sur les pins analogique. Cependant votre bon sens vous dira que si celui ci est digital vous devrez utiliser les pins correspondant. Concernant notre cher capteur, pour le brancher rien de plus simple, un connecteur JST est deja plugguer sur le capteur, donc plus qu’a le brancher de façon très simple. Tout d’abord en lisant notre datasheet, nous repérons que le cable rouge est le plus (Vcc sur le schéma), Nous devons brancher ce Vcc sur le pin 5V de l’analogique, le Gnd sur le Gnd et enfin le Vo sur le S. Dans mon cas, j’ai branché mon capteur sur le pin 0.

extrait du datasheet du capteur sharp

Voici un petit programme très simple permettant de tester son bon fonctionnement :


//Standard PWM DC control

int E1 = 5; //M1 Speed Control
int E2 = 6; //M2 Speed Control
int M1 = 4; //M1 Direction Control
int M2 = 7; //M2 Direction Control

int front_sensor = 0; // pin analog 0
int speed = 200;

// mootor functions

void run_motor()
{
 analogWrite (E2, speed);
 digitalWrite(M2,LOW);
 analogWrite (E1, speed);
 digitalWrite(M1,HIGH);
}

void stop_motor ()
{
 analogWrite (E1, 0);
 analogWrite (E2, 0);
}

// sensor functions

boolean detect_obstacle (int sensor)
{
 if (analogRead(sensor) > 200)
 return true;
 return false;
}

void setup(void)
{
 int i;
 for(i=6;i<=9;i++)
 pinMode(i, OUTPUT);

Serial.begin(19200); //Set Baud Rate
}
void loop(void)
{

if (detect_obstacle (front_sensor) == false)
 {
 run_motor();
 }
 else
 {
 stop_motor ();
 }
}

Dans ce code, nous avons donc une fonction permettant de détecter les obstacles. Dans le cas ou nous détectons un obstacle, nous stoppons le robot. Le capteur est analogique, nous utilisons donc la fonction AnalogRead, le paramètre qui lui est passé correspondant a la valeur du pin sur lequel est branché le capteur a savoir 0. Enfin on définit le fait de tomber sur un obstacle lorsqu’on est a une certaine distance de celui ci. Il faut savoir que plus la valeur renvoyée par le capteur et plus l’obstacle sera proche. Donc attention la valeur renvoyée est une tension correspondant au voltage .

Etape 4 : Programme d’évitement d’obstacle

Voir l’étape 4 dans la seconde partie de l’article.

Etape 1 : Mise en place de l’environnement

Sur Windaub rien de plus simple, il suffit de télécharger l’IDE Arduino ici

Concernant la configuration la encore c’est très simple, il suffit de :

  • Choisir le modèle de sa carte dans la liste disponible du menu Tools > board
  • Définir le port de communication utilisé dans Tools >Serial Port

De plus il existe un système de débug via le port série via le menu Tools >Serial Monitor, celui ci permet de debugguer son programme assez facilement a l’aide de la fonction Serial.write (XXX). Nous pouvons même simuler l’envoi de commande via une entrée standard toute prête.

Etape 2 : Premier programme : Test des moteurs

Voici un petit code permettant de tester vos branchements moteurs

int E1 = 5; //M1 Speed Control
int E2 = 6; //M2 Speed Control
int M1 = 4; //M1 Direction Control
int M2 = 7; //M1 Direction Control

int speed = 200;

void run_motor()
{
analogWrite (E2, speed);
digitalWrite(M2,LOW);
analogWrite (E1, speed);
digitalWrite(M1,HIGH);
}
void setup(void)
{
int i;
for(i=6;i<=9;i++)
pinMode(i, OUTPUT);

Serial.begin(19200); //Set Baud Rate
}
void loop(void)
{
run_motor();
}

Un programme arduino se compose de deux fonctions principales. Une fonction setup correspondant a l’initialisation et une fonction loop correspondant au programme qui sera exécuté comme son nom l’indique en continue.

Dans la fonction setup, nous définissons que les pin correspondant aux commandes moteurs sont en mode output. En effet nous avons besoin d’envoyer des valeurs a nos moteurs, donc en toute logique nous choisissons le mode output. Ici les pins correspondant aux moteurs vont de 4 a 7, attention selon la version de votre board, ces pins peuvent être différents, ceci est a déterminer a l’aide des indications sur les datasheets ou plus simplement directement sur la carte. Enfin le serial.begin permet de définir la vitesse de transmission du port série. Celle ci doit être la même dans le mode sérial monitor si vous voulez communiquer de façon correcte avec votre carte.

Dans la fonction loop, nous appelons la fonction qui active les moteurs. AnalogWrite comme son nom l’indique permet d’écrire sur un pin analogique tandis que le DigitalWrite permet d’écrire sur un pin digitale. Ainsi sur le pin de direction on peut envoyer LOW ou HIGH selon que vous vouliez mettre vos moteurs en marche arrière ou avant, ensuite pour ce qui est des pins de vitesse, on y définit une vitesse celle ci étant en bytes la fourchette de valeur est 0 – 255.

Vous allez me dire qu’il y a un problème dans mon code ? Et bien oui mes deux moteurs ne semblent pas tourner dans le même sens. Et bien pas vraiment, au cours de mon montage j’ai donc branché deux moteurs en parallèles sur chaque contrôleur moteur ( Il y en a que deux sur la carte, 4 moteurs donc pas le choix). Cependant j’ai fait mes soudures au hasard, ainsi il s’est avéré que mes deux moteurs ne sont pas branchés dans le même sens de polarité. Ainsi si je veux aller en marche avant avec l’un je dois lui envoyer LOW, tandis que l’autre a besoin de HIGH. Ceci n’est pas très gênant étant donné qu’on programme notre petite fonction une fois et qu’après on n’y touche plus.

Pour tester le programme rien de plus simple, il y a un bouton upload. Attention sur certaine carte dont la Romeo, il est nécessaire de reset la carte entre chaque nouveau upload de code. Pour cela, il y a en général un bouton sur la carte. Ainsi il vous suffira d’appuyer sur le bouton de reset brièvement juste avant de lancer l’upload.

Finalement, on débranche son robot, on enclenche l’interrupteur et on espère que cela fonctionne, sinon a vous la chasse au faux contact, mauvaise soudure, etc..

Etape 3 : Intégration de capteur et arrêt de la plateforme a la rencontre d’un obstacle

capteur utilisé :  Module capteur de distance infrarouge Sharp GP2Y0A21  (datasheet)

Nous allons tout d’abord brancher notre capteur. Celui que nous utilisons est analogique, nous allons donc le brancher sur les pins analogique. Cependant votre bon sens vous dira que si celui ci est digital vous devrez utiliser les pins correspondant. Concernant notre cher capteur, pour le brancher rien de plus simple, un connecteur JST est deja plugguer sur le capteur, donc plus qu’a le brancher de façon très simple. Tout d’abord en lisant notre datasheet, nous repérons que le cable rouge est le plus (Vcc sur le schéma), Nous devons brancher ce Vcc sur le pin 5V de l’analogique, le Gnd sur le Gnd et enfin le Vo sur le S. Dans mon cas, j’ai branché mon capteur sur le pin 0.

extrait du datasheet du capteur sharp

Voici un petit programme très simple permettant de tester son bon fonctionnement :


//Standard PWM DC control

int E1 = 5; //M1 Speed Control
int E2 = 6; //M2 Speed Control
int M1 = 4; //M1 Direction Control
int M2 = 7; //M1 Direction Control

int front_sensor = 0; // pin analog 0
int speed = 200;

// mootor functions

void run_motor()
{
 analogWrite (E2, speed);
 digitalWrite(M2,LOW);
 analogWrite (E1, speed);
 digitalWrite(M1,HIGH);
}

void stop_motor ()
{
 analogWrite (E1, 0);
 analogWrite (E2, 0);
}

// sensor functions

boolean detect_obstacle (int sensor)
{
 if (analogRead(sensor) > 200)
 return true;
 return false;
}

void setup(void)
{
 int i;
 for(i=6;i<=9;i++)
 pinMode(i, OUTPUT);

Serial.begin(19200); //Set Baud Rate
}
void loop(void)
{

if (detect_obstacle (front_sensor) == false)
 {
 run_motor();
 }
 else
 {
 stop_motor ();
 }
}

Dans ce code, nous avons donc une fonction permettant de détecter les obstacles. Dans le cas ou nous détectons un obstacle, nous stoppons le robot. Le capteur est analogique, nous utilisons donc la fonction AnalogRead, le paramètre qui lui est passé correspondant a la valeur du pin sur lequel est branché le capteur a savoir 0. Enfin on définit le fait de tomber sur un obstacle lorsqu’on est a une certaine distance de celui ci. Il faut savoir que plus la valeur renvoyée par le capteur et plus l’obstacle sera proche. Donc attention la valeur renvoyée est une tension correspondant au voltage .

Etape 4 : Programme d’évitement d’obstacle

Voir l’étape 4 dans la seconde partie de l’article.