sdカードに焦点調整を追加

Dependencies:   mbed MPU6050_2 HMC5883L_2 SDFileSystem3

Revision:
9:21cd5d18ad9e
Parent:
8:d11a59d2a2f1
Child:
10:63fe920595a7
--- a/main.cpp	Sat Feb 09 06:34:54 2019 +0000
+++ b/main.cpp	Sun Feb 10 06:15:21 2019 +0000
@@ -220,8 +220,9 @@
     SensingHMC();
     DebugPrint();
     
-    while(nowAngle_HMC <= nowAngle[YAW]+5 && nowAngle_HMC >= nowAngle[YAW]-5){
+    while(nowAngle[YAW] <= nowAngle_HMC+5 && nowAngle[YAW] >= nowAngle_HMC-5){
         MoveCansat('M');
+        SensingMPU();
     }
     return;
 }