Keuronde/Robot2025
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Compare commits

base: Keuronde:7f2af55e02f2610dbf9f185559b47839ba6c94ca
Branches Tags
Keuronde:master
...
compare: Keuronde:37b1b75d5f7d2d760823ea8e59dff4c599603900
Branches Tags
Keuronde:master

2 Commits
7f2af55e02 ... 37b1b75d5f

Author SHA1 Message Date
Samuel
37b1b75d5f Ajout de la communicatio vers la detection de l'adversaire. Fonction démo uniquement pour l'instant 2025-03-19 11:58:17 +01:00
Samuel
0ad8474d94 Code refactorisé - déplacements relatifs OK 2025-03-19 11:30:38 +01:00
9 changed files with 319 additions and 171 deletions
Show Stats Expand all files Collapse all files

260
Cerveau/Cerveau.ino
View File

@ -1,9 +1,12 @@
#include <M5Core2.h> #include <M5Core2.h>
#include <Wire.h> #include <Wire.h>
#include <WiFi.h> #include <WiFi.h>
#include <WebServer.h>
#include <math.h> #include <math.h>
#include "Communication_chassis.h"
#include "Communication_detection_adversaire.h"
#include "ServerWeb.h"
#define WIRE Wire #define WIRE Wire
@ -24,10 +27,10 @@ IPAddress subnet(255, 255, 255, 0);
// IPAddress local_IP(192, 168, 1, 99); // IPAddress local_IP(192, 168, 1, 99);
// IPAddress gateway(192, 168, 1, 1); // IPAddress gateway(192, 168, 1, 1);
// IPAddress subnet(255, 255, 255, 0); // IPAddress subnet(255, 255, 255, 0);
WebServer server(80);
const int16_t I2C_MASTER = 0x42; const int16_t I2C_MASTER = 0x42;
const int16_t I2C_SLAVE_chassi = 0x55;
const int16_t I2C_SLAVE_trian = 0x30; const int16_t I2C_SLAVE_trian = 0x30;
uint8_t test = 32; uint8_t test = 32;
uint32_t i = 0; uint32_t i = 0;
@ -82,78 +85,6 @@ char* tableau[] = {"Lecture serveur", "Prise position", "Verif mvmt end ou cmd",
char* statu[] = {"/..","./.","../"}; char* statu[] = {"/..","./.","../"};
int index_statu=0; int index_statu=0;
struct chassis_reception_t {
unsigned char status;
};
struct chassis_emission_t {
unsigned char status;
int translation_x, translation_y, rotation_y;
};
void Scan_chassis(struct chassis_reception_t * chassis_reception);
#define FORM \
"<!DOCTYPE html>\n" \
"<html>\n" \
"<head>\n" \
"<meta charset=\"UTF-8\">\n" \
"<title>A simple form</title>\n" \
"</head>\n" \
"<body>\n" \
"<form action=\"/form\" method=\"post\">\n" \
"<br>" \
"<label for=\"X\">X : en mm</label>\n" \
"<br>" \
"<input type=\"text\" id=\"X\" name=\"X\">\n" \
"<br>" \
"<label for=\"Y\">Y : en mm</label>\n" \
"<br>" \
"<input type=\"text\" id=\"Y\" name=\"Y\">\n" \
"<br>" \
"<label for=\"R\">Rotation : en degres</label>\n" \
"<br>" \
"<input type=\"text\" id=\"R\" name=\"R\">\n" \
"<br>" \
"<label for=\"V\">Vitesse : </label>\n" \
"<br>" \
"<input type=\"text\" id=\"V\" name=\"V\" value=\"2000\">\n" \
"<br>" \
"<br>" \
"<label for=\"A\">Accel : </label>\n" \
"<br>" \
"<input type=\"text\" id=\"A\" name=\"A\"value=\"1500\">\n" \
"<br>" \
"<br>" \
"<input type=\"submit\" value=\" Vas-Y \">\n" \
"<br>" \
"<br>" \
"<input type=\"reset\" value=\"Reset\">\n" \
"<br>" \
"<br>" \
"<input type=\"submit\" value=\" STOP \">\n" \
"</form>\n" \
"</body>\n" \
"</html>\n"
void handleForm() {
String message;
message += FORM;
server.send(200, "text/html", message);
String myString0 = server.arg("X"); //positon de cmd en X mm
// x= myString0.toInt() * coef_mvt/10;
xA= myString0.toInt();
String myString1 = server.arg("Y"); //positon de cmd en Y mm
// y= myString1.toInt() * coef_mvt/10;
yA= myString1.toInt();
String myString2 = server.arg("R"); //positon de cmd en Rotation Deg °
rot= myString2.toInt() * 13.88888;
String myString3 = server.arg("V"); // Vitesse de cmd en
vit= myString3.toInt();
String myString4 = server.arg("A"); // Acceleration de cmd
acc= myString4.toInt();
}
void setup() { void setup() {
// put your setup code here, to run once: // put your setup code here, to run once:
@ -162,7 +93,7 @@ void setup() {
M5.Lcd.setTextSize(2); M5.Lcd.setTextSize(2);
M5.Lcd.print("Bonjour\nEcran\n\nRecherche Wifi"); M5.Lcd.print("Bonjour\nEcran\n\nRecherche Wifi");
Initialisation_wifi(); Initialisation_wifi();
server.on("/form", handleForm); Web_init();
WIRE.begin(); WIRE.begin();
M5.Lcd.clear(); M5.Lcd.clear();
@ -177,20 +108,18 @@ void setup() {
//} //}
// MemPosition_X = 800; // MemPosition_X = 800;
// MemPosition_Y = 800; // MemPosition_Y = 800;
M5.Lcd.clear(); struct detect_adv_reception_t detect_adv_reception;
M5.Lcd.setCursor(0, 0);M5.Lcd.print("Pos");M5.Lcd.setCursor(50, 0);M5.Lcd.print("X :");M5.Lcd.setCursor(150, 0);M5.Lcd.print("|Xp:");
M5.Lcd.setCursor(0, 20);M5.Lcd.print("n-1"); while(1){
M5.Lcd.setCursor(50, 20);M5.Lcd.print("Y :");M5.Lcd.setCursor(150, 20);M5.Lcd.print("|Yp:"); Detect_adv_lire(&detect_adv_reception);
M5.Lcd.setCursor(0, 40);M5.Lcd.print("Pos"); char chaine[40];
M5.Lcd.setCursor(50, 40);M5.Lcd.print("X :"); sprintf(chaine, "Distance: %d cm\n Distance: %d cm\n", detect_adv_reception.distance_cm[0],
M5.Lcd.setCursor(0, 60);M5.Lcd.print("Act"); detect_adv_reception.distance_cm[11]);
M5.Lcd.setCursor(50, 60);M5.Lcd.print("Y :"); affiche_msg("Scan_Detect_adversaire", chaine);
M5.Lcd.setCursor(10, 80);M5.Lcd.print("Trans I2C"); }
M5.Lcd.setCursor(10, 100);M5.Lcd.print("Triangulation ");
M5.Lcd.setCursor(10, 120);M5.Lcd.print("AngleRad"); affichage_standard_init();
M5.Lcd.setCursor(10, 140);M5.Lcd.print("Tol x:");
M5.Lcd.setCursor(10, 160);M5.Lcd.print("Tol y:");
M5.Lcd.setCursor(10, 180);M5.Lcd.print("Case");
//M5.Lcd.setCursor(10, 200);M5.Lcd.print("cmd :"); //M5.Lcd.setCursor(10, 200);M5.Lcd.print("cmd :");
} }
@ -202,7 +131,7 @@ void loop() {
strategie(); strategie();
affichage_resultats(); affichage_resultats();
delay(500); delay(10);
} }
void affichage_resultats() { void affichage_resultats() {
@ -237,7 +166,7 @@ void Initialisation_wifi(){
if (test_wifi > 10) break; if (test_wifi > 10) break;
} }
if (WiFi.status() == WL_CONNECTED) { if (WiFi.status() == WL_CONNECTED) {
server.begin();
Serial.println("Server started"); Serial.println("Server started");
delay(500); delay(500);
M5.Lcd.clear(); M5.Lcd.clear();
@ -254,7 +183,6 @@ void Initialisation_wifi(){
while(1); while(1);
} }
IPAddress myIP = WiFi.softAPIP(); IPAddress myIP = WiFi.softAPIP();
server.begin();
M5.Lcd.clear(); M5.Lcd.clear();
M5.Lcd.setCursor(10,10); M5.Lcd.setCursor(10,10);
M5.Lcd.print("Creation Hotspot ;-)"); M5.Lcd.print("Creation Hotspot ;-)");
@ -266,6 +194,23 @@ void Initialisation_wifi(){
delay(1500); delay(1500);
} }
void affichage_standard_init(){
M5.Lcd.clear();
M5.Lcd.setCursor(0, 0);M5.Lcd.print("Pos");M5.Lcd.setCursor(50, 0);M5.Lcd.print("X :");M5.Lcd.setCursor(150, 0);M5.Lcd.print("|Xp:");
M5.Lcd.setCursor(0, 20);M5.Lcd.print("n-1");
M5.Lcd.setCursor(50, 20);M5.Lcd.print("Y :");M5.Lcd.setCursor(150, 20);M5.Lcd.print("|Yp:");
M5.Lcd.setCursor(0, 40);M5.Lcd.print("Pos");
M5.Lcd.setCursor(50, 40);M5.Lcd.print("X :");
M5.Lcd.setCursor(0, 60);M5.Lcd.print("Act");
M5.Lcd.setCursor(50, 60);M5.Lcd.print("Y :");
M5.Lcd.setCursor(10, 80);M5.Lcd.print("Trans I2C");
M5.Lcd.setCursor(10, 100);M5.Lcd.print("Triangulation ");
M5.Lcd.setCursor(10, 120);M5.Lcd.print("AngleRad");
M5.Lcd.setCursor(10, 140);M5.Lcd.print("Tol x:");
M5.Lcd.setCursor(10, 160);M5.Lcd.print("Tol y:");
M5.Lcd.setCursor(10, 180);M5.Lcd.print("Case");
}
void affiche_erreur(char * chaine1, char * chaine2){ void affiche_erreur(char * chaine1, char * chaine2){
M5.Lcd.clear(); M5.Lcd.clear();
M5.Lcd.setCursor(10,10); M5.Lcd.setCursor(10,10);
@ -290,10 +235,19 @@ void affiche_msg(char * chaine1, char * chaine2){
void strategie(){ void strategie(){
struct chassis_reception_t chassis_reception; struct chassis_reception_t chassis_reception;
struct chassis_emission_t chassis_emission;
switch(index_Maitre){ switch(index_Maitre){
case 0 : //--------------------------------------------------------------------------------------------------------- case 0 : //---------------------------------------------------------------------------------------------------------
server.handleClient(); //************* Lecture des données recu pour coordoné (X,Y,rotation) /// Lecture des commandes venant du serveur web et envoi des commandes au chassis
if(vit!=0 && !corrige){ Web_gestion();
M5.update();
/// Si on a une réponse du client
/// On lit la réponse
if(Web_nouveau_message()){
if(Web_type_requete() == WEB_DEPLACEMENT_RELATIF){
chassis_emission = Web_get_donnees();
send_Chassis(&chassis_emission);
}
Serial.printf("vit:%d, corrige: %d\n", vit, corrige); Serial.printf("vit:%d, corrige: %d\n", vit, corrige);
MemCmd_X = xA; //Memorisation de la comande pour comparaison avec arrivé MemCmd_X = xA; //Memorisation de la comande pour comparaison avec arrivé
MemCmd_Y = yA; MemCmd_Y = yA;
@ -301,6 +255,41 @@ void strategie(){
//index_Maitre = 1; // Bloc le serveur WEB si on n'a pas la triangulation //index_Maitre = 1; // Bloc le serveur WEB si on n'a pas la triangulation
index_Maitre = 2; index_Maitre = 2;
} }
if(M5.BtnA.read() == 1){
// Déplacement en X
chassis_emission.translation_x_mm = 2000;
chassis_emission.translation_y_mm = 0;
chassis_emission.rotation_z_rad = 0;
chassis_emission.vitesse = 2000;
chassis_emission.acceleration = 1500;
send_Chassis(&chassis_emission);
index_Maitre = 2;
}
if(M5.BtnB.read() == 1){
// Déplacement en Y
chassis_emission.translation_x_mm = 0;
chassis_emission.translation_y_mm = 2000;
chassis_emission.rotation_z_rad = 0;
chassis_emission.vitesse = 2000;
chassis_emission.acceleration = 1500;
send_Chassis(&chassis_emission);
index_Maitre = 2;
}
if(M5.BtnC.read() == 1){
// Rotation
chassis_emission.translation_x_mm = 0;
chassis_emission.translation_y_mm = 0;
chassis_emission.rotation_z_rad = 100;
chassis_emission.vitesse = 2000;
chassis_emission.acceleration = 1500;
send_Chassis(&chassis_emission);
index_Maitre = 2;
}
break; break;
case 1 : //--------------------------------------------------------------------------------------------------------- case 1 : //---------------------------------------------------------------------------------------------------------
@ -315,8 +304,9 @@ void strategie(){
//Si position Pas OK ****************** //Si position Pas OK ******************
break; break;
case 2 : //--------------------------------------------------------------------------------------------------------- case 2 : // Deplacement relatif en cours
Scan_chassis(&chassis_reception); //Verif de la fin de mouvement remonté par le chassis Scan_chassis(&chassis_reception); //Verif de la fin de mouvement remonté par le chassis
// Pour l'instant, Scan_chassis bloque le programme en cas de problème de communication
if(Err_Chassi_com !=0){ if(Err_Chassi_com !=0){
for(int j=0; j<10; j++){ for(int j=0; j<10; j++){
affichage_resultats(); affichage_resultats();
@ -325,25 +315,13 @@ void strategie(){
} }
// ********************************* ERREUR DE COM FATAL *********************** // ********************************* ERREUR DE COM FATAL ***********************
} }
if(Mvt_finit==0){ if(chassis_reception.status != MOUVEMENT_FINI){
cmd_chassi_x = xA;
cmd_chassi_y = yA;
Cmd_Angle = rot;
send_Chassis(); //Envoie des coordonées à atteindre
while(Mvt_finit!=1){
Serial.println("while Mvt_finit");
Scan_chassis(&chassis_reception); //Verif de la fin de mouvement remonté par le chassis (time out ?**********)
delay(50);
}
Scan_chassis(&chassis_reception); //Verif de la fin de mouvement remonté par le chassis (time out ?**********)
}else{ }else{
send_Chassis_RAZ(); //Envoie des coordonées à atteindre send_Chassis_RAZ(); // Immobilisation du robot
index_Maitre = 0; // On attend l'ordre suivant
} }
//M5.Lcd.clear();
Serial.println("case 2 fin1/2");
index_Maitre = 0;
Serial.println("case 2 fin2/2");
break; break;
} }
} }
@ -390,34 +368,6 @@ void compar_cinematique(){
} }
} }
/// @brief Lit l'état du chassis en I2C
void Scan_chassis(struct chassis_reception_t * chassis_reception){
unsigned char tampon2[14];
//(Adresse I2c, Adresse dans le registre, tampon, longueur de donnée)
Serial.println("avant lire registre");
error = I2C_lire_registre(I2C_SLAVE_chassi, 0, tampon2, 12);
Serial.println("apres lire registre");
if (error !=0){
Serial.println("Erreur I2C");
Err_Chassi_com =1;IndexErr = 2;
affiche_erreur("Scan_Chassi", "Erreur I2C");
while(1);
}else{
Serial.println("I2C OK");
Err_Chassi_com =0;
IndexErr = 0;
int valeur;
Mvt_finit = (MOUVEMENT_FINI == tampon2[0]);
char chaine[100];
sprintf(chaine, "tampon2: %x %x %x %x %x %x %x %x %x %x %x %x %x %x\n", tampon2[0], tampon2[1], tampon2[2], tampon2[3], tampon2[4],
tampon2[5], tampon2[6], tampon2[7], tampon2[8], tampon2[9], tampon2[10], tampon2[11], tampon2[12], tampon2[13]);
affiche_msg("Scan_Chassi", chaine);
Serial.println("Affect struct");
chassis_reception->status = tampon2[0];
Serial.println("apres Affect struct");
}
}
/// @brief Récupère position (X, Y) et l'orientation du robot /// @brief Récupère position (X, Y) et l'orientation du robot
void Scan_Triangulation(){ void Scan_Triangulation(){
@ -448,37 +398,7 @@ void Scan_Triangulation(){
} }
} }
void send_Chassis_RAZ(){
uint8_t RAZ_Message[11]={0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0};
error = I2C_ecrire_registre(I2C_SLAVE_chassi, 0, RAZ_Message, 11);
}
void send_Chassis(){
//if(nbr_essai<=10){
// Prévient le chassis d'un nouveau mouvement avec le 2eme bit du premier Octet
Mot[0] = MOUVEMENT_EN_COURS;
//y*=-1;
//y = y*direction;
Mot[1] = cmd_chassi_x >>8; Mot[2] = cmd_chassi_x;
Mot[3] = cmd_chassi_y >>8; Mot[4] = cmd_chassi_y;
//Serial.println(y);
Mot[5] = Cmd_Angle >>8; Mot[6] = Cmd_Angle;
Mot[7] = vit >>8; Mot[8] = vit;
Mot[9] = acc >>8; Mot[10] = acc;
error = I2C_ecrire_registre(I2C_SLAVE_chassi, 0, Mot, 11);
if (error !=0){Err_Cha_send =1; IndexErr = 5;}
else{Err_Cha_send =0;IndexErr = 0;}
if(error==0){ //si pas d'erreur de transmission alors RAZ des valeurs
nbr_essai ++;
cmd_chassi_x = 0;
cmd_chassi_y = 0;
Cmd_Angle = 0;
vit = 0;
acc = 0;
}
}
void scan_I2C_bus(){ void scan_I2C_bus(){
char error, address; char error, address;

20
Cerveau/Communication_chassis.h Normal file
View File

@ -0,0 +1,20 @@
#ifndef CHASSIS_H
#define CHASSSI_H
#define I2C_SLAVE_chassi 0x55
struct chassis_reception_t {
unsigned char status;
};
struct chassis_emission_t {
unsigned char status;
int translation_x_mm, translation_y_mm, rotation_z_rad;
int vitesse, acceleration;
};
void Scan_chassis(struct chassis_reception_t * chassis_reception);
void send_Chassis(struct chassis_emission_t * chassis_emission);
void send_Chassis_RAZ(void);
#endif

61
Cerveau/Communication_chassis.ino Normal file
View File

@ -0,0 +1,61 @@
//#include "Chassis.h"
#include <Arduino.h>
#include <HardwareSerial.h>
/// @brief Lit l'état du chassis en I2C
void Scan_chassis(struct chassis_reception_t * chassis_reception){
unsigned char tampon2[14];
//(Adresse I2c, Adresse dans le registre, tampon, longueur de donnée)
error = I2C_lire_registre(I2C_SLAVE_chassi, 0, tampon2, 12);
if (error !=0){
Err_Chassi_com =1;IndexErr = 2;
affiche_erreur("Scan_Chassi", "Erreur I2C");
while(1);
}else{
Serial.println("I2C OK");
Err_Chassi_com =0;
IndexErr = 0;
Mvt_finit = (MOUVEMENT_FINI == tampon2[0]);
chassis_reception->status = tampon2[0];
}
}
void send_Chassis(struct chassis_emission_t * chassis_emission){
//if(nbr_essai<=10){
// Prévient le chassis d'un nouveau mouvement avec le 2eme bit du premier Octet
Mot[0] = MOUVEMENT_EN_COURS;
//y*=-1;
//y = y*direction;
Mot[1] = chassis_emission->translation_x_mm >>8;
Mot[2] = chassis_emission->translation_x_mm;
Mot[3] = chassis_emission->translation_y_mm >>8;
Mot[4] = chassis_emission->translation_y_mm;
//Serial.println(y);
Mot[5] = chassis_emission->rotation_z_rad >>8;
Mot[6] = chassis_emission->rotation_z_rad;
Mot[7] = chassis_emission->vitesse >>8; Mot[8] = chassis_emission->vitesse;
Mot[9] = chassis_emission->acceleration >>8;
Mot[10] = chassis_emission->acceleration;
error = I2C_ecrire_registre(I2C_SLAVE_chassi, 0, Mot, 11);
if (error !=0){Err_Cha_send =1; IndexErr = 5;}
else{Err_Cha_send =0;IndexErr = 0;}
if(error==0){ //si pas d'erreur de transmission alors RAZ des valeurs
nbr_essai ++;
cmd_chassi_x = 0;
cmd_chassi_y = 0;
Cmd_Angle = 0;
vit = 0;
acc = 0;
}
}
void send_Chassis_RAZ(){
uint8_t RAZ_Message[11]={0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0};
error = I2C_ecrire_registre(I2C_SLAVE_chassi, 0, RAZ_Message, 11);
}

12
Cerveau/Communication_detection_adversaire.h Normal file
View File

@ -0,0 +1,12 @@
#ifndef DETEC_ADV_H
#define DETEC_ADV_H
#define I2C_SLAVE_detect_adv 0x18
struct detect_adv_reception_t {
unsigned char distance_cm[12];
};
void Detect_adv_lire(struct detect_adv_reception_t * detect_adv_reception);
#endif

18
Cerveau/Communication_detection_adversaire.ino Normal file
View File

@ -0,0 +1,18 @@
//#include "Chassis.h"
#include <Arduino.h>
#include <HardwareSerial.h>
/// @brief Lit les capteurs VL53L1X
void Detect_adv_lire(struct detect_adv_reception_t * detect_adv_reception){
unsigned char tampon2[14];
//(Adresse I2c, Adresse dans le registre, tampon, longueur de donnée)
error = I2C_lire_registre(I2C_SLAVE_detect_adv, 0, detect_adv_reception->distance_cm, 12);
if (error !=0){
affiche_erreur("Scan_Detect_adversaire", "Erreur I2C");
while(1);
}else{
Serial.println("I2C OK");
}
}

4
Cerveau/I2C_Master_lib.ino
View File

@ -26,7 +26,9 @@ uint8_t I2C_lire_registre(int adresse_i2c, uint adresse_registre, unsigned char
WIRE.requestFrom(adresse_i2c, taille_donnees + 1); WIRE.requestFrom(adresse_i2c, taille_donnees + 1);
// ceci contient l'adresse // ceci contient l'adresse
Wire.readBytes(&temp, 1); if(adresse_i2c == I2C_SLAVE_chassi){
Wire.readBytes(&temp, 1);
}
// Et ceci les données // Et ceci les données
Wire.readBytes(donnees_recues, taille_donnees); Wire.readBytes(donnees_recues, taille_donnees);
return status; return status;

9
Cerveau/ServerWeb.h Normal file
View File

@ -0,0 +1,9 @@
#define WEB_DEPLACEMENT_RELATIF 1
#define WEB_DEPLACEMENT_ABSOLU 2
void Web_init(void);
bool Web_nouveau_message(void);
int Web_type_requete(void);
void Web_gestion(void);
struct chassis_emission_t Web_get_donnees(void);

101
Cerveau/ServerWeb.ino Normal file
View File

@ -0,0 +1,101 @@
#include <Arduino.h>
#include <WebServer.h>
//#include "Chassis.h"
//#include "ServerWeb.h"
int Web_nouvelle_entree;
int type_requete;
struct chassis_emission_t chassis_emission_web;
#define FORM \
"<!DOCTYPE html>\n" \
"<html>\n" \
"<head>\n" \
"<meta charset=\"UTF-8\">\n" \
"<title>A simple form</title>\n" \
"</head>\n" \
"<body>\n" \
"<form action=\"/form\" method=\"post\">\n" \
"<br>" \
"<label for=\"X\">X : en mm</label>\n" \
"<br>" \
"<input type=\"text\" id=\"X\" name=\"X\">\n" \
"<br>" \
"<label for=\"Y\">Y : en mm</label>\n" \
"<br>" \
"<input type=\"text\" id=\"Y\" name=\"Y\">\n" \
"<br>" \
"<label for=\"R\">Rotation : en degres</label>\n" \
"<br>" \
"<input type=\"text\" id=\"R\" name=\"R\">\n" \
"<br>" \
"<label for=\"V\">Vitesse : </label>\n" \
"<br>" \
"<input type=\"text\" id=\"V\" name=\"V\" value=\"2000\">\n" \
"<br>" \
"<br>" \
"<label for=\"A\">Accel : </label>\n" \
"<br>" \
"<input type=\"text\" id=\"A\" name=\"A\"value=\"1500\">\n" \
"<br>" \
"<br>" \
"<input type=\"submit\" value=\" Vas-Y \">\n" \
"<br>" \
"<br>" \
"<input type=\"reset\" value=\"Reset\">\n" \
"<br>" \
"<br>" \
"<input type=\"submit\" value=\" STOP \">\n" \
"</form>\n" \
"</body>\n" \
"</html>\n"
WebServer server(80);
void Web_init(){
server.begin();
server.on("/form", handleForm);
}
bool Web_nouveau_message(){
if(Web_nouvelle_entree){
Web_nouvelle_entree = 0;
return 1;
}
return 0;
}
int Web_type_requete(){
return type_requete;
}
void Web_gestion(){
server.handleClient();
}
struct chassis_emission_t Web_get_donnees(){
return chassis_emission_web;
}
void handleForm() {
String message;
type_requete = WEB_DEPLACEMENT_RELATIF;
message += FORM;
server.send(200, "text/html", message);
String myString0 = server.arg("X"); //positon de cmd en X mm
// x= myString0.toInt() * coef_mvt/10;
chassis_emission_web.translation_x_mm = myString0.toInt();
String myString1 = server.arg("Y"); //positon de cmd en Y mm
// y= myString1.toInt() * coef_mvt/10;
chassis_emission_web.translation_y_mm = myString1.toInt();
String myString2 = server.arg("R"); //positon de cmd en Rotation Deg °
chassis_emission_web.rotation_z_rad = myString2.toInt() * 13.88888;
String myString3 = server.arg("V"); // Vitesse de cmd en
chassis_emission_web.vitesse = myString3.toInt();
String myString4 = server.arg("A"); // Acceleration de cmd
chassis_emission_web.acceleration = myString4.toInt();
Web_nouvelle_entree=1;
}

5
Readme.md
View File

@ -4,4 +4,9 @@ Déplacement fonctionnel
Côté cerveau, un serveur web qui permet d'envoyer un ordre de déplacement relatif au châssis. Côté cerveau, un serveur web qui permet d'envoyer un ordre de déplacement relatif au châssis.
Calibration des sens des moteurs pour les translations en X, Y et pour la rotation. Calibration des sens des moteurs pour les translations en X, Y et pour la rotation.
Calibration des translations non effectuées.
Vidéo réalisée le 24 février 2024, paramètres :
- vitesse : 2000
- acceleration : 1500