角度調整用のプログラムです。 (モータードライバー+磁気センサー)

Dependencies:   ATP3012 mbed a HMC US015_2 getGPS

Revision:
1:f70beec382b6
Parent:
0:99f4fe3e21c6
Child:
2:83023bafb526
--- a/Function.h	Wed Dec 01 08:14:01 2021 +0000
+++ b/Function.h	Fri Dec 03 08:22:57 2021 +0000
@@ -116,7 +116,6 @@
         delta = angle - theta;
     }
     printf("delta=%f-%f=%f\r\n", angle, theta, delta); 
-    wait(2);
     return delta;
 }
 
@@ -124,13 +123,14 @@
 {
     xbee.printf("calibration start\r\n");
     compass.setCalibrationMode(0x43);
-    Move('4', 0.1);
+    Move('4', 0.15);
     xbee.printf("mortor mode:4 speed:0.1\n\r");
-    wait(6);
+    wait(180);
     Move('1', 0);
     xbee.printf("mortor mode:1 speed:0\n\r");
     compass.setCalibrationMode(0x45);
     xbee.printf("calibration end\r\n");
+/*    
     while(1) {
         if(gps.getgps()) {  //現在地取得
         GPS_x = gps.latitude;
@@ -142,7 +142,7 @@
             break;
         }
     }
-
+*/
     return;
 }