2020_TeamA / Mbed 2 deprecated Yoshida_MiniRobo

Dependencies:   mbed YKNCT_Movement SBDBT BNO055 YKNCT_MD YKNCT_I2C

Revision:
6:fa9121fe4a53
Parent:
5:8e257a254c73
Child:
7:8bea84f72e64
--- a/main.cpp	Sat Mar 14 05:35:35 2020 +0000
+++ b/main.cpp	Sat Mar 14 05:52:08 2020 +0000
@@ -133,8 +133,8 @@
     if(operate==0){
       /* 足回り停止 */
       omuni.XmarkOmni_Move(0,0,0);
-
-
+      for(int i=0;i<4;i++)
+        MD.Set(i,MovMotor[i]);
     }
     /* 操縦権:手動 */
     else if(operate==1){
@@ -151,8 +151,8 @@
       r_val+=(TarTheta-NowLoc.theta)*CONST_CORRECTION_YAW;
       
       omuni.XmarkOmni_Move(x_val,y_val,r_val);
-      
-      
+      for(int i=0;i<4;i++)
+        MD.Set(i,MovMotor[i]);
     }
     /* 操縦権:自動 */
     else if(operate==2){