Open Bidouille Robot : Différence entre versions

De Les Fabriques du Ponant
Aller à : navigation, rechercher
(Bibliothèque de communication OBR en C)
(Bibliothèque de communication OBR en C)
Ligne 213 : Ligne 213 :
 
         return 0;
 
         return 0;
 
     }
 
     }
 
+
 
     if(Debug)
 
     if(Debug)
 
         printf("OBR Connecte\n");
 
         printf("OBR Connecte\n");
Ligne 276 : Ligne 276 :
 
     return 0;
 
     return 0;
 
  }
 
  }
 
+
 
  void Commande_Console(char* Buffer, Commande_OBR *Commande)
 
  void Commande_Console(char* Buffer, Commande_OBR *Commande)
 
  {
 
  {
Ligne 301 : Ligne 301 :
 
     }
 
     }
 
  }
 
  }
 
+
 
  int Recup_Commande(Commande_OBR *Commande)
 
  int Recup_Commande(Commande_OBR *Commande)
 
  {
 
  {
Ligne 326 : Ligne 326 :
 
         delay(1);
 
         delay(1);
 
     }
 
     }
 
+
 
     if(!ChainePrete)
 
     if(!ChainePrete)
 
         return 1;
 
         return 1;

Version du 9 novembre 2014 à 20:49

Qu'est-ce qu'Open Bidouille Robot (OBR) ?

Open Bidouille Robot est un micrologiciel pour arduino, permettant la gestion de moteurs, capteurs, servomoteurs, entrée numériques et sorties numériques. En d'autres termes, OBR sert à la création de robot, via un arduino. Une fois compilé et installé sur la carte, il faut configurer OBR (via le PC par exemple) en envoyant une série de commandes. Une fois configuré, on peut toujours le reconfigurer (ajouter/enlever des servomoteurs, changer la vitesse maximum d'un moteur, etc...), mais aussi le piloter. Lorsqu'on demande à un moteur de tourner, OBR va vérifier dans la configuration s'il est lié à d'autres objets (capteurs, entrées, sorties...), et verrouiller ou non le moteur (de même pour une sortie tout ou rien, et un servomoteur). De cette manière, nous pouvons créer des systèmes de fin de courses, en liant plusieurs choses (ex : le moteur ne peut tourner que si le capteur vaut moins que x, et que l'entrée n°y est à 0).

Pourquoi ce projet ?

A la base, j'ai été à l'Open Bidouille Camp (d'où le choix de reprendre ce nom pour le projet) de 2012, où j'ai rencontré une connaissance qui voulais faire un robot démineur sans savoir programmer. Je partais donc avec un engin sur roues, avec un bras motorisé au dessus, mais non pilotable. De base, je devais donc coder un programme sur un arduino Mega2560, permettant de piloter les moteurs inclus dans l'engin. il y a peu, j'ai mis de côté le robot démineur pour me concentrer sur les robots en général. C'est donc de là que m'est venu l'idée de coder un système modulable, et adaptable à tous types de robots.

Communication avec OBR

La communication avec OBR suit une norme qui lui est propre, sous la forme : "[AdresseEnvoyeur|AdresseDestinataire]OBR_COMMANDE-PARAMETRES\n" Le protocole est assez strict, mais simple :

- La communication se fait via les ports séries, en 57600 bauds.
- Le dialogue se fait via des commandes, avec (au max) trois paramètres, et deux adresses (envoyeur et destinataire)
- Toutes les commandes ont un retour, même si ce n'est qu'un "OK"
- Il n'y a aucun espace dans une ligne
- La commande se termine toujours par un retour à la ligne ('\n')
- Les paramètres sont séparés par des tirets ('-')
- Un message peut passer par plusieurs cartes, il y a un système de routage, d'où l'obligation des adresses
- Seul la commande de demande de connexion n'a pas d'adresse, mais la réponse en a une (On ne sais pas à qui on se connecte, mais on sait qui nous répond)
- Le réseau peut se constituer d'un maître, épaulé par deux esclaves (pour augmenter le nombre de PIN), une télécommande, et un PC.
- Il y a donc 5 adresses : 1=PC, 2=Télécommande, 3=Maître, 4=Esclave1 et 5=Esclave2.
- Il ne peut pas y avoir deux périphériques du même type, comme deux PC, ou deux télécommandes.
- Le maître, l'esclave1 et l'esclave2 sont distincts, et ne peuvent pas changer (définit à la compilation). De ce fait, les adresses des PIN allant jusqu'à 255, on peut déterminer le N° du PIN (pour 234, c'est 34) et le N° de la carte (pour 234, c'est l'eclave2).
- Les connexions peuvent se faire en série, les commandes seront routées pour arriver à bon port.

Exemple de connexion entre le PC et le maître : PC <===========> {Esclave2 <=> esclave1 <=> Maître} : L'esclave2 recevra le message, le transmettra à l'esclave1, qui le transmettra au maître. c'est le chemin inverse que fera la réponse.

Ce qu'OBR sait faire pour le moment

Pour le moment (version 0.4), OBR ne sait pas faire grand chose, si ce n'est gérer les connexions entre arduinos, télécommandes et PC. Les commandes sont fonctionnelles, et on peut connaître le nom du robot, ainsi que sa version d'OBR installé. Une session administrateur est gérée, on peut l'utiliser (mot de passe par défaut : 2560) pour configurer le robot. Lorsque l'administrateur se connecte, la LED 13 s'allume pour dire que la configuration est susceptible d'être modifiée.

Ce qu'il sera sensé faire plus tard

Dans le futur (version 1.0), OBR devra toujours gérer les connexions automatiquement et à chaud, mais aussi enregistrer les configurations dans l'EEPROM, pour s'en servir lors du pilotage (l'EEPROM sera copié dans différents tableaux en RAM au démarrage). Le maître saura gérer les deux esclaves (si présents), pour piloter ses entrées/sorties. OBR devra gérer les batteries, et se désactiver si nécessaire. Un système de WatchDog fonctionnera sur les ports séries, pour détecter la déconnexion d'un périphérique.

TeC'OBiR (Terminal Configuration pour Open Bidouille Robot), un programme PC pour configurer OBR

Le Terminal TeC'OBiR est codé en C, en console, et permet de communiquer aisément avec un arduino tournant sous OBR. TeC'OBiR intègre la bibliothèque de communication OBR, ce qui lui permet de dialoguer avec OBR (un maître, un esclave ou une télécommande) facilement. Lorsqu'on lance TeC'OBiR, les 10 premiers ports séries sont scannés en boucle, tant qu'une carte sous OBR n'est pas connectée. Les avantages d'utiliser TeC'OBiR plutôt qu'un terminal série quelconque, sont multiples :

- La connexion se fait toute seule en arrière plan, aucune commande n'est à taper
- Une fois connectée, on a le nom du robot, et la version d'OBR installée.
- Les commandes que l'on tape sont mises en norme : Toutes les lettres sont mises en majuscule, les espaces sont remplacées par des tirets, les adresses sont automatiquement ajoutées, ainsi que le "OBR_" au début de la commande.
- L'adresse est automatiquement définie selon la carte sur laquelle nous sommes connectés (maître, esclave, télécommande).
- Il est possible de choisir sont destinataire en ajoutant 'x:' avant la commande, x étant variable (p: pour le PC, t: pour la télécommande, m: pour le maître, e1: pour l'esclave1 et e2 pour l'esclave2).
- Si le mot de passe est 2560, la connexion en tant qu'administrateur se fait automatiquement, sinon, le mot de passe est demandée, pour une connexion automatique.
- Entre chaque commande envoyée, le programme vérifie la connexion avec OBR, et se déconnecte si la carte est débranchée.

Exemple de commandes qu'on peut écrire avec TeC'OBiR, pour connaître le nom du maitre :

- "[1|3]OBR_NOM\n"
- "OBR_nOm"
- "nom"
- "m:nom"

Code Arduino

Code C de TeC'OBiR

Bibliothèque de communication OBR en C

Une bibliothèque a été créée pour faciliter la communication entre un programme codé en C, et un arduino tournant sous OBR. Cette bibliothèque est dépendant d'une autre, qui gère les connexions séries. Les deux bibliothèques (OBR.h et Serial.h) seront disponible au téléchargement dès que possible.

Code OBR.h :

/**

Copyright (C) 2014 Fragni Dorian

This program is free software; you can redistribute it and/or modify
it under the terms of the GNU General Public License as published by
the Free Software Foundation; either version 2 of the License, or
(at your option) any later version.

This program is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
GNU General Public License for more details.

You should have received a copy of the GNU General Public License along
with this program; if not, write to the Free Software Foundation, Inc.,
51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.

*/

#ifndef OBR_H_INCLUDED
#define OBR_H_INCLUDED

#ifndef SERIAL_H_INCLUDED
#error "Aucune fonction de lecture du port série n'est disponible !!!"
#error "Veuillez inclure Serial.h"
#endif // SERIAL_H_INCLUDED


/// définition d'une structure de commande
typedef struct Commande_OBR
{
   char* Commande[128]; // Derniere commande reçue
   char* Nom[128]; // Nom du robot
   int PortArduino; // Port série sur lequel est connecté l'arduino
   int NoEnvoyeur; // N° du dernier envoyeur
   int NoDestinataire; // N° du dernier destinataire
   int MAITRE_ESCLAVE; // Définit sur quel type de carte le PC est branché (la variable contient l'adresse)
   int TELECOMMANDE_PC; // 1 si c'est le PC, 2 si c'est la télécommande
   double OBR_Version; // Version de l'OBR installé sur l'arduino
} Commande_OBR;

#define OBR_VERSION "1.3"
#define OBR_PC 1
#define OBR_TELECOMMANDE 2

/// Récupère la commande tapée en console (inutile pour un programme graphique)
void OBR_Commande_Console(char* Buffer, Commande_OBR *Commande);

/// Récupère la dernière commande reçue par l'arduino, retourne l'adresse de l'envoyeur
int OBR_Recup_Commande(Commande_OBR *Commande);

/// Envoie une commande à l'arduino
void OBR_Envoie_Commande(char* Message, Commande_OBR *Commande, int NoDestinataire);

/// Demande à l'arduino s'il est pret, retourne 0 si OK
int OBR_Arduino_Pret(Commande_OBR *Commande);

/// Envoie un message de watchdog pour maintenir la connexion active
void OBR_Maintenir_Connexion(Commande_OBR *Commande);

/// Demande à l'arduino une connexion, en se faisant passer pour un PC (configuration) ou une télécommande (pilotage), retourne l'adresse de la Commande_OBR si connecté
int OBR_Connecter(int NoPort, int TypePeripherique);

/// Deconnecte l'arduino du PC
void OBR_Deconnecter(Commande_OBR *Commande);

/// Faire une pause x ms
void delay(int millis);

#include "OBR.c"
#endif // OBR_H_INCLUDED

Le code de OBR.c :

/**

Copyright (C) 2014 Fragni Dorian

This program is free software; you can redistribute it and/or modify
it under the terms of the GNU General Public License as published by
the Free Software Foundation; either version 2 of the License, or
(at your option) any later version.

This program is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
GNU General Public License for more details.

You should have received a copy of the GNU General Public License along
with this program; if not, write to the Free Software Foundation, Inc.,
51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.

*/

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <time.h>
#define Debug 0

/// Demande à l'arduino une connexion, en précisant si on doit se faire passer pour un PC (Configuration) ou une télécommande (Pilotage), retourne l'adresse de la Commande_OBR si connecté
int OBR_Connecter(int NoPort, int TypePeripherique)
{
   if(TypePeripherique!=OBR_PC && TypePeripherique!=OBR_TELECOMMANDE)
       return 0;

   /// On ouvre le port série en 57600 bauds
   int PortOBR = OuvrirCom(NoPort, 5);
   if(!PortOBR)
       return 0;

   /// On crée une Commande_OBR
   Commande_OBR *Commande = malloc(sizeof(Commande_OBR));
   if(!Commande)
       return -1;

   Commande->PortArduino = PortOBR;

   /// On vérifie la présence de l'OBR sur l'arduino
   // On vide le buffer d'entrée
   Recup_Commande(Commande);

   // Vérification de la présence de l'OBR sur l'arduino
   if(TypePeripherique==OBR_PC)
       Envoie_Commande("OBR_CONNECTER_PC", Commande, 0);
   else
       Envoie_Commande("OBR_CONNECTER_TELECOMMANDE", Commande, 0);
   delay(500);
   Recup_Commande(Commande);

   // Si l'OBR n'est pas présent
   if(strcmp(Commande->Commande, "OK"))
   {
       // On libère la mémoire de la Commande_OBR
       free(Commande);

       // On ferme le port série
       FermerCom(PortOBR);

       // On retourne 0;
       return 0;
   }

   if(Debug)
       printf("OBR Connecte\n");

   /// On récupère l'adresse
   Commande->MAITRE_ESCLAVE = Commande->NoEnvoyeur;
   Commande->TELECOMMANDE_PC = TypePeripherique;

   /// On récupère sa version
   Commande->MAITRE_ESCLAVE = Commande->NoEnvoyeur;
   Envoie_Commande("OBR_VERSION", Commande, Commande->MAITRE_ESCLAVE);
   Recup_Commande(Commande);
   Commande->OBR_Version = atof(Commande->Commande);
   if(Debug)
       printf("Version : %f\n", Commande->OBR_Version);

   /// On récupère son nom
   Envoie_Commande("OBR_NOM", Commande, Commande->MAITRE_ESCLAVE);
   Recup_Commande(Commande);
   strcpy(Commande->Nom, Commande->Commande);
   if(Debug)
       printf("Nom : %s\n", Commande->Nom);

   /// On retourne l'adresse de la Commande_OBR
   return Commande;
}

void OBR_Deconnecter(Commande_OBR *Commande)
{
   if(Commande->OBR_Version>=0.37)
   {
       Envoie_Commande("OBR_DECONNECTER_ADMIN", Commande, Commande->MAITRE_ESCLAVE);
       Envoie_Commande("OBR_DECONNEXION_AUTO-1", Commande, Commande->MAITRE_ESCLAVE);
       Envoie_Commande("OBR_DECONNECTER", Commande, Commande->MAITRE_ESCLAVE);
   }
   else
       Envoie_Commande("OBR_DECONNECTER", Commande, Commande->MAITRE_ESCLAVE);
   FermerCom(Commande->PortArduino);
   free(Commande);
}

int ArduinoPret(Commande_OBR *Commande)
{
   double InitTime = clock();
   double EndTime = InitTime;

   Envoie_Commande("OBR_PRET", Commande, Commande->MAITRE_ESCLAVE);

   while(InitTime+2000 > EndTime)
   {
       Recup_Commande(Commande);
       if(!strcmp(Commande->Commande, "VRAIE") || !strcmp(Commande->Commande, "ADMIN"))
       {
           if(!strcmp(Commande->Commande, "VRAIE"))
               return 1;
           else
               return 2;
       }
       delay(100);
       EndTime = clock();
   }
   return 0;
}

void Commande_Console(char* Buffer, Commande_OBR *Commande)
{
   int NbCaractere = 0;
   char DernierCaractere = NULL;
   strcpy(Buffer, "");

   /// Tant qu'on a pas de "\n", ou qu'on ne dépasse pas les 128 caractères, on attend.
   while(DernierCaractere!='\n' && NbCaractere<128)
   {
       /// On récupère les 128 premiers caractères (ou jusqu'au \n)
       DernierCaractere = getchar();
       if(DernierCaractere!=NULL && DernierCaractere!='\n')
       {
           /// Si c'est une lettre minuscule, on la met en majuscule
           if(DernierCaractere <= 'z' && DernierCaractere >= 'a')
               DernierCaractere-=32;

           Buffer[NbCaractere]=DernierCaractere;
           NbCaractere++;
           Buffer[NbCaractere]='\0';
           DernierCaractere=NULL;
       }
   }
}

int Recup_Commande(Commande_OBR *Commande)
{
   strcpy(Commande->Commande, "");
   char Buffer[130]="";

   /// Tant qu'on a pas de "\n", ou qu'on est pas encore dans les 100ms, on attend.
   unsigned long Delay = clock();
   int ChainePrete = 0;

   /// On récupère caractère par caractère, on s'arrête au '\n'.
   while(!ChainePrete && Delay+200>clock())
   {
       RecevoirCom(Commande->PortArduino, Buffer);

       /// On assemble la chaine
       if(strcmp(Buffer, "") && strlen(Commande->Commande)+strlen(Buffer)<sizeof(Commande->Commande))
           strcat(Commande->Commande, Buffer);
       strcpy(Buffer, "");

       /// On regarde si la ligne est complete
       if(strchr(Commande->Commande, '\n'))
           ChainePrete = 1;
       delay(1);
   }

   if(!ChainePrete)
       return 1;

   /// On séparre la commande, des adresses
   strcpy(Buffer, Commande->Commande);
   sscanf(Buffer, "[%d|%d]%s\n", &Commande->NoEnvoyeur, &Commande->NoDestinataire, Commande->Commande);

   /// On laisse le temps au système pour ne pas le surcharger
   delay(5);

   return 0;
}

void Envoie_Commande(char* Message, Commande_OBR *Commande, int NoDestinataire)
{
   char *Char = NULL, Temp[130]="";
   /// Si on ne demande pas à quitter
   if(strcmp(Message, "EXIT"))
   {
       /// On remplace tous les " " par des "-"
       do
       {
           Char = strchr(Message, ' ');
           if(Char)
               *Char = '-';
       } while(Char!=NULL);

       /// La commande exacte est du type "OBR_[COMMANDE]-[PARAM1]-[PARAM2]-...".
       /// Ici, on peut écrire "_[COMMANDE]-...", voir juste "[COMMANDE]-...", le programme ajoute le "OBR_" devant.

       /// On regarde si la commande commence par une adresse
       if(!strncmp(Message, "M:", 2)) // Maitre
       {
           strcpy(Temp, Message);
           strcpy(Message, Temp+2);
           NoDestinataire = 3;
       }

       if(!strncmp(Message, "E1:", 3)) // Esclave1
       {
           strcpy(Temp, Message);
           strcpy(Message, Temp+3);
           NoDestinataire = 4;
       }

       if(!strncmp(Message, "E2:", 3)) // Esclave2
       {
           strcpy(Temp, Message);
           strcpy(Message, Temp+3);
           NoDestinataire = 5;
       }

       if(!strncmp(Message, "P:", 2)) // PC
       {
           strcpy(Temp, Message);
           strcpy(Message, Temp+2);
           NoDestinataire = 1;
       }

       if(!strncmp(Message, "T:", 2)) // Telecommande
       {
           strcpy(Temp, Message);
           strcpy(Message, Temp+2);
           NoDestinataire = 2;
       }

       /// On regarde si "_" est présent.
       if(!strncmp(Message, "_", 1))
       {
           /// S'il le faut, on lui ajoute "OBR" devant la Commande->
           strcpy(Temp, "OBR");
           strcat(Temp, Message);
           strcpy(Message, Temp);
           strcpy(Temp, "");
       }
       /// On regarde si "OBR_" est absent.
       if(strncmp(Message, "OBR_", 4))
       {
           /// S'il le faut, on lui ajoute "OBR_" devant la Commande->
           strcpy(Temp, "OBR_");
           strcat(Temp, Message);
           strcpy(Message, Temp);
           strcpy(Temp, "");
       }
       /// On ajoute l'adresse à la commande
       sprintf(Commande->Commande, "[%d|%d]%s\n", Commande->TELECOMMANDE_PC, NoDestinataire, Message);

       /// On envoie la commande
       EnvoyerCom(Commande->Commande, Commande->PortArduino);

       /// On laisse le temps au système pour ne pas le surcharger
       delay(5);
   }
}

void MaintenirConnexion(Commande_OBR *Commande)
{

}

void delay(int millis)
{
   double InitTime = clock();
   double DelayTime = InitTime+millis;
   while(DelayTime>clock());
   return;
}

Des suggestions ? Des conseils ? Je suis preneur ;)

Code de TeC'OBiR

Changelog

OBR

0.1 :

- Première version, non fonctionnelle

0.2 :

- Mise en place du système de question/réponse, sous forme de commande de type OBR_COMMANDE-PARAMETRE1-PARAMETRE2-PARAMETRE3
- Ajout du mode administrateur
- Ajout des modes configuration et pilotage
- Première version du calcul du niveau de batterie
- Passage du port série en 57600 bauds
- Ajout du mot de passe, et son système de réinitialisation à "2560"

0.3 :

- Ajout du système d'authentification sur les ports série
- Ajout de la prise en charge des cartes d'extension (jusqu'à deux cartes d'extensions) via RS232 (Mais les cartes seront inactives, sauf pour demander la liste des connexions externes)
- Ajout du mapage réseau, permettant de relier le PC, télécommande et les cartes d'extensions sur n'importe quel port série (de n'importe quelle carte d'extension)
- Ajout du système d'adresse dans les commandes, permettant le routage des données à travers les cartes ([1|2]OBR_...)
- Ajout des constantes de compilation pour définir le nom du robot, et son rôle (maitre/esclave), ainsi que le type (MEGA, UNO...)
- Ajout de la détection de déconnexion série, et déconnexion auto de l'administrateur

0.4 :

- WatchDog plus intelligent, évite la surcharge du réseau lorsque ça discute
- Mise en place de la configuration des cartes d'extension via les ports série, permettant de les utiliser
- Centralisation du pilotage des cartes, via le maitre
- Mise en place des codes d'erreur dans le noyau du système
- Mise en place des fonctions de copie RAM->EEPROM et EEPROM->RAM, contenant les données de fonctionnement (liste des moteurs, capteurs...)

0.5 :

- Ajout des fonctions de mise en place des périphériques (moteurs, capteurs...)
- Ajout de toutes les commandes de pilotage
- Gestion du pilotage des autres cartes

Pour le moment, la dernière version est la 0.37 : tout ce qui est dit dans la version 0.3 est faite, et une partie de la version 0.4 est traitée.

TeC'OBiR

1.0

- Utilise le protocole OBR
- On peut enlever "OBR" et "OBR_" au début de la commande
- Tous les espaces sont remplacés par des tirets
- Commande 'HELP' affiche l'aide et les commandes existantes lors de la création de la version 1.0
- Commande 'EXIT' Ferme la connexion et quitte le programme

1.1

- La casse est automatiquement mise en majuscule sur les commandes envoyées
- Ajout de la couleur bleue
- Ajout de la commande 'VERSION' qui affiche la version du programme
- Connexion automatique en essayant les 10 premiers ports en boucles
- Detection de la déconnexion de l'arduino
- Ajout de la connexion admin
- Passage au baudrate de 57600 bauds.

1.2

- réécriture du noyau
- Adaptation au nouveau protocole OBR 0.3
- Prise en compte des adresses

1.27

- Désactivation automatique du WatchDog inclus sur l'OBR 0.37 et +

1.3

- Ajout du choix de l'adresse destinatrice (Commande sous forme "add:OBR_COMMANDE-PARAMS" ex : pour connaitre le nom du maitre, "M:OBR_NOM")
- Ajout de l'adresse émetrice dans la réponse
- Séparation du code TeC'OBiR et de la bibliothèque OBR_Communication

1.4

- Adaptation au protocole OBR 0.4, qui inclus un watchdog sur la connexion série
- Prise en charge des fichiers de config .map
- Peut etre ouvert avec, comme parametre, un fichier .map. La configuration auto se fera dès que la connexion est effectuée

Pour le moment, la dernière version est la 1.27, qui désactive le chien de garde à la connexion, pour éviter les déconnexions intempestives. (il faudrait mettre moins de 5 secondes à taper une commande, et ne jamais s'arrêter...)

Liens de téléchargements