NagaokaRoboticsClub_mbedTeam / Mbed OS NHK2017_octopus2

Octopus!!

Dependencies:   2017NHKpin_config FEP HMC6352 PID QEI R1307 ikarashiMDC omni_wheel

Fork of KANIv3 by NagaokaRoboticsClub_mbedTeam

Diff: main.cpp

Revision:
51:64534e908d5c
Parent:
50:3a7c858aa0f9
diff -r 3a7c858aa0f9 -r 64534e908d5c main.cpp
--- a/main.cpp	Mon Nov 13 17:33:30 2017 +0900
+++ b/main.cpp	Mon Nov 13 17:34:01 2017 +0900
@@ -11,15 +11,15 @@
     while(1) {
         printf("loop\n\r");
         OCTOPUS.confirmPad1();
-        OCTOPUS.confirmPad2();
-        //OCTOPUS.controllDrive();
-        OCTOPUS.controllDrive2();
+        //OCTOPUS.confirmPad2();
+        OCTOPUS.controllDrive();
+        //OCTOPUS.controllDrive2();
         // OCTOPUS.controllDrive3();
         //OCTOPUS.controllDrive4();
         OCTOPUS.controllMech();
         //OCTOPUS.calibrate();
         //OCTOPUS.checkConnection();
         //OCTOPUS.checkDegree();
-        wait(0.01);
+        wait(INTERVAL);
     }
 }