AresENSEA-CDF2020 / Mbed 2 deprecated AresCDFMainCode_us2

Test

Dependencies:   mbed DRV8825

Diff: debugBT.cpp

Revision:
5:34ed652f8c31
Parent:
4:ad9b7355332e
Child:
10:0714feaaaee1
--- a/debugBT.cpp	Sat Jul 18 17:09:08 2020 +0000
+++ b/debugBT.cpp	Tue Jul 21 19:33:38 2020 +0000
@@ -16,7 +16,8 @@
         buffer[i]=bt.getc();
         pc.printf("%c",buffer[i]);
         bt.printf("%c",buffer[i]);
-        i++;
+
+        if((buffer[i] >= 48 && buffer[i] <=57) || (buffer[i]>=97 && buffer[i]<=122) || buffer[i]==13) i++;
     }
 
     if(buffer[i-1]=='\r') {
@@ -31,6 +32,10 @@
                 StringToAngle(cmd);
                 cmdType=0;
                 break;
+            case 2 : // Commande test vitesse
+                StringToVitesse(cmd);
+                cmdType=0;
+                break;
             default : // Commande par défaut
                 cmdChoice(cmd);
         }