Capteur_US

Dependencies:   mbed DRV8825

Revision:
8:eb9bbab312ff
Parent:
6:ea6b30c4bb01
Child:
10:0714feaaaee1
--- a/debugPC.cpp	Thu Jul 30 19:05:05 2020 +0000
+++ b/debugPC.cpp	Thu Jul 30 19:30:54 2020 +0000
@@ -75,6 +75,7 @@
         "mten", //13
         "mtdr", //14
         "mtvt", //15
+        "mtrt", //16
         0
     };
 
@@ -100,6 +101,7 @@
             pc.printf("mten : Activation/Desactivation des moteurs\r\n");
             pc.printf("mtdr : Changement de de sens de rotation des moteurs\r\n");
             pc.printf("mtvt : Changement de la vitesse de rotation (vitesse a preciser)\r\n");
+            pc.printf("mtrt : Sens de rotation des moteurs opposes\r\n");
             pc.printf("\n\r");
             // bt
             bt.printf("\n\n\r###HELP###\n\r");
@@ -112,6 +114,7 @@
             bt.printf("mten : Activation/Desactivation des moteurs\r\n");
             bt.printf("mtdr : Changement de de sens de rotation des moteurs\r\n");
             bt.printf("mtvt : Changement de la vitesse de rotation (vitesse a preciser)\r\n");
+            bt.printf("mtrt : Sens de rotation des moteurs opposes\r\n");
             bt.printf("\n\r");
             break;
         case 1:     //usao
@@ -217,6 +220,12 @@
             bt.printf("Vitesse en mm/s (sous la forme xxxx): ");
             cmdType=2;
             break;
+        case 16:
+            pc.printf("Rotation du robot");
+            bt.printf("Rotation du robot");
+            motGauche_fwd();
+            motDroite_bck();
+            break;
         default:
             pc.printf("Commande invalide\n\r");
             bt.printf("Commande invalide\n\r");