NHK2017 octopus robot

Dependencies:   2017NHKpin_config mbed FEP ikarashiMDC PID jy901 omni HMC6352 omni_wheel

Fork of KANI2017v2 by NagaokaRoboticsClub_mbedTeam

Revision:
26:7258d5ad0bff
Parent:
25:d199d621ecca
--- a/main.cpp	Sat Sep 30 17:59:10 2017 +0900
+++ b/main.cpp	Wed Oct 25 03:25:06 2017 +0900
@@ -9,10 +9,16 @@
 {
   //printf("start\r\n");
     while(1) {
-        OCTOPUS.confirmAll();
+        OCTOPUS.confirmPad1();
+        OCTOPUS.confirmPad2();
+        //OCTOPUS.drive();
         OCTOPUS.controllDrive();
+        //OCTOPUS.controllDrive2();
+        //OCTOPUS.controllDrive3();
         OCTOPUS.controllMech();
-        OCTOPUS.debugPrint();
-        //wait(0.05);
+        //OCTOPUS.checkConnection();
+        //OCTOPUS.debugCompass();
+        OCTOPUS.calibrate();
+        wait(INTERVAL);
     }
 }