Octopus!!

Dependencies:   2017NHKpin_config FEP HMC6352 PID QEI R1307 ikarashiMDC omni_wheel

Fork of KANIv3 by NagaokaRoboticsClub_mbedTeam

Revision:
50:3a7c858aa0f9
Parent:
49:69a7235d837a
Child:
51:64534e908d5c
Child:
52:320f910ca6ca
--- a/main.cpp	Sat Nov 11 17:40:10 2017 +0900
+++ b/main.cpp	Mon Nov 13 17:33:30 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(INTERVAL);
+        wait(0.01);
     }
 }