From 89d3bf21cdbcf306b90af9a1a22f3e15ae093671 Mon Sep 17 00:00:00 2001
From: Geoffrey Frogeye <geoffrey@frogeye.fr>
Date: Fri, 16 Feb 2018 21:35:05 +0100
Subject: [PATCH] =?UTF-8?q?Rattrapage=20de=20session=20abandonn=C3=A9e=20A?=
 =?UTF-8?q?rduino?=
MIME-Version: 1.0
Content-Type: text/plain; charset=UTF-8
Content-Transfer-Encoding: 8bit

---
 chef/src/CA.c       | 41 +++++++++++++++++++++++++++++++++++++++++
 chef/src/CA.h       |  2 ++
 chef/src/movement.c |  3 ++-
 3 files changed, 45 insertions(+), 1 deletion(-)

diff --git a/chef/src/CA.c b/chef/src/CA.c
index 1fe0759..6538cf7 100644
--- a/chef/src/CA.c
+++ b/chef/src/CA.c
@@ -25,6 +25,7 @@ void configureArduino()
 {
     // Connection au port série
     printf("Connexion à %s... ", ARDUINO_PORTNAME);
+    fflush(stdout);
     arduino = open(ARDUINO_PORTNAME, O_RDWR | O_NOCTTY | O_NDELAY);
     if (arduino < 0) {
         printf("Échec !\n");
@@ -93,6 +94,16 @@ void onA2CD_ERR()
     printf("Erreur reçue : %c (%2x)\n", s.code, s.code);
 }
 
+void setPret()
+{
+    pret = true;
+}
+
+void doNothing()
+{
+
+}
+
 void configureCA()
 {
     configureArduino();
@@ -102,6 +113,36 @@ void configureCA()
 
     pthread_mutex_init(&sSendCA, NULL);
     pthread_create(&tReaderAC, NULL, TaskReaderAC, NULL);
+
+    printf("Attente de réponse de l'Arduino... ");
+    fflush(stdout);
+    struct timespec tim;
+    tim.tv_sec = 0;
+    tim.tv_nsec = 100000000L;
+    // Dans le cas où on aurait laissé l'Arduino en attente de donnée,
+    // on envoie des pings en boucle jusqu'à ce qu'il nous réponde.
+    pret = false;
+    registerRxHandler(C2AD_PING, setPret);
+    while (!pret) {
+        sendCA(C2AD_PING, NULL, 0);
+        nanosleep(&tim, NULL);
+    }
+    registerRxHandler(C2AD_PING, doNothing);
+
+    // Dans le cas où les données de ping complèteraient une commande de déplacement,
+    // on envoie un STOP en préventif. Ça permet aussi d'attendre que les PING
+    // en trop aient été absorbés
+    pret = false;
+    registerRxHandler(C2AD_STOP, setPret);
+    sendCA(C2AD_STOP, NULL, 0);
+    while (!pret) {
+        nanosleep(&tim, NULL);
+    }
+
+    registerRxHandler(C2AD_STOP, NULL);
+    registerRxHandler(C2AD_PING, NULL);
+    printf("OK !\n");
+
     registerRxHandler(A2CD_ERR, onA2CD_ERR);
 }
 
diff --git a/chef/src/CA.h b/chef/src/CA.h
index e7e380d..56b45d5 100644
--- a/chef/src/CA.h
+++ b/chef/src/CA.h
@@ -4,6 +4,7 @@
 #include <sys/ioctl.h>
 #include <pthread.h>
 #include <termios.h> // baudrates
+#include <stdbool.h>
 
 #include "ACsignals.h"
 
@@ -17,6 +18,7 @@ pthread_t tReaderAC;
 
 typedef void (*rxHandler)(void);
 rxHandler rxHandlersAC[256];
+bool pret;
 
 void registerRxHandler(unsigned char code, rxHandler handler); // À utiliser après configureCA();
 void sendByteCA(unsigned char data); // Privé
diff --git a/chef/src/movement.c b/chef/src/movement.c
index f9bd0a7..2f07e5d 100644
--- a/chef/src/movement.c
+++ b/chef/src/movement.c
@@ -8,13 +8,14 @@ void onC2AD_STOP()
 {
     // On considère que l'arrêt se fait très rapidement pour ne pas
     // avoir à attendre le signal de retour de C2AD_STOP
+    registerRxHandler(C2AD_STOP, NULL);
 }
 
 void stop()
 {
     printf("→ Arrêt\n");
-    sendCA(C2AD_STOP, NULL, 0);
     registerRxHandler(C2AD_STOP, onC2AD_STOP);
+    sendCA(C2AD_STOP, NULL, 0);
 }
 
 // Inspiré de https://stackoverflow.com/a/1760819