teamALI / Mbed 2 deprecated HB2018

Dependencies:   mbed FreeRTOS

Revision:
27:ff63c23bc689
Parent:
26:732bc37fbefd
Child:
29:eb3d72dd94aa
--- a/hbCommand.cpp	Thu Dec 13 12:15:35 2018 +0000
+++ b/hbCommand.cpp	Fri Dec 14 12:32:27 2018 +0000
@@ -57,15 +57,11 @@
         else if (strcmp(g_CmdBuf , "sm2"   )==0 ){gf_MtReq[1].bf.req=true; gf_MtReq[1].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
         else if (strcmp(g_CmdBuf , "sm3"   )==0 ){gf_MtReq[2].bf.req=true; gf_MtReq[2].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
         else if (strcmp(g_CmdBuf , "sm4"   )==0 ){gf_MtReq[3].bf.req=true; gf_MtReq[3].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
-        else if (strcmp(g_CmdBuf , "sma"   )==0 ){
-            gf_MtReq[0].bf.req=true; 
-            gf_MtReq[0].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);
-            gf_MtReq[1].bf.req=true; 
-            gf_MtReq[1].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);
-            gf_MtReq[2].bf.req=true; 
-            gf_MtReq[2].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);
-            gf_MtReq[3].bf.req=true; 
-            gf_MtReq[3].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);
+        else if (strcmp(g_CmdBuf , "sm"   )==0 ){
+            for(int i = 0; i < 4; ++i){
+                gf_MtReq[i].bf.req=true; 
+                gf_MtReq[i].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);
+            }
             }
         else if (strcmp(g_CmdBuf , "smf"   )==0 ){
             gf_MtReq[0].bf.req=true;
@@ -77,7 +73,35 @@
             gf_MtReq[2].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);
             gf_MtReq[3].bf.req=true;
             gf_MtReq[3].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);            }
-        
+        else if (strcmp(g_CmdBuf , "smo1"   )==0 ){gf_MtReqOfs[0].bf.req=true; gf_MtReqOfs[0].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        else if (strcmp(g_CmdBuf , "smo2"   )==0 ){gf_MtReqOfs[1].bf.req=true; gf_MtReqOfs[1].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        else if (strcmp(g_CmdBuf , "smo3"   )==0 ){gf_MtReqOfs[2].bf.req=true; gf_MtReqOfs[2].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        else if (strcmp(g_CmdBuf , "smo4"   )==0 ){gf_MtReqOfs[3].bf.req=true; gf_MtReqOfs[3].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        else if (strcmp(g_CmdBuf , "smo"   )==0 ){
+            for(int i = 0; i < 4; ++i){
+                gf_MtReqOfs[i].bf.req=true; 
+                gf_MtReqOfs[i].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);
+            }
+        }
+        else if (strcmp(g_CmdBuf , "smof"   )==0 ){
+            gf_MtReqOfs[0].bf.req=true;
+            gf_MtReqOfs[0].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);
+            gf_MtReqOfs[1].bf.req=true;
+            gf_MtReqOfs[1].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        else if (strcmp(g_CmdBuf , "smor"   )==0 ){
+            gf_MtReqOfs[2].bf.req=true;
+            gf_MtReqOfs[2].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);
+            gf_MtReqOfs[3].bf.req=true;
+            gf_MtReqOfs[3].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);            }
+        //else if (strcmp(g_CmdBuf , "smfpga1"   )==0 ){gf_MtReqDct[0].bf.req=true; gf_MtReqDct[0].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        //else if (strcmp(g_CmdBuf , "smfpga2"   )==0 ){gf_MtReqDct[1].bf.req=true; gf_MtReqDct[1].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        //else if (strcmp(g_CmdBuf , "smfpga3"   )==0 ){gf_MtReqDct[2].bf.req=true; gf_MtReqDct[2].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        //else if (strcmp(g_CmdBuf , "smfpga4"   )==0 ){gf_MtReqDct[3].bf.req=true; gf_MtReqDct[3].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        //else if (strcmp(g_CmdBuf , "smfpga5"   )==0 ){gf_MtReqDct[4].bf.req=true; gf_MtReqDct[4].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        //else if (strcmp(g_CmdBuf , "smfpga6"   )==0 ){gf_MtReqDct[5].bf.req=true; gf_MtReqDct[5].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        //else if (strcmp(g_CmdBuf , "smfpga7"   )==0 ){gf_MtReqDct[6].bf.req=true; gf_MtReqDct[6].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        //else if (strcmp(g_CmdBuf , "smfpga8"   )==0 ){gf_MtReqDct[7].bf.req=true; gf_MtReqDct[7].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+
         //キャリブレーション
         else if (strcmp(g_CmdBuf , "calyaw")==0 ){gf_Cal.bf.yaw=true;}//
         else if (strcmp(g_CmdBuf , "calgyro")==0 ){gf_Cal.bf.gy=true;}//
@@ -159,15 +183,11 @@
         else if (strcmp(g_CmdBuf , "sm2"   )==0 ){gf_MtReq[1].bf.req=true; gf_MtReq[1].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
         else if (strcmp(g_CmdBuf , "sm3"   )==0 ){gf_MtReq[2].bf.req=true; gf_MtReq[2].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
         else if (strcmp(g_CmdBuf , "sm4"   )==0 ){gf_MtReq[3].bf.req=true; gf_MtReq[3].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
-        else if (strcmp(g_CmdBuf , "sma"   )==0 ){
-            gf_MtReq[0].bf.req=true; 
-            gf_MtReq[0].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);
-            gf_MtReq[1].bf.req=true; 
-            gf_MtReq[1].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);
-            gf_MtReq[2].bf.req=true; 
-            gf_MtReq[2].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);
-            gf_MtReq[3].bf.req=true; 
-            gf_MtReq[3].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);
+        else if (strcmp(g_CmdBuf , "sm"   )==0 ){
+            for(int i = 0; i < 4; ++i){
+                gf_MtReq[i].bf.req=true; 
+                gf_MtReq[i].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);
+            }
             }
         else if (strcmp(g_CmdBuf , "smf"   )==0 ){
             gf_MtReq[0].bf.req=true;
@@ -179,6 +199,34 @@
             gf_MtReq[2].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);
             gf_MtReq[3].bf.req=true;
             gf_MtReq[3].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);            }
+        else if (strcmp(g_CmdBuf , "smo1"   )==0 ){gf_MtReqOfs[0].bf.req=true; gf_MtReqOfs[0].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        else if (strcmp(g_CmdBuf , "smo2"   )==0 ){gf_MtReqOfs[1].bf.req=true; gf_MtReqOfs[1].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        else if (strcmp(g_CmdBuf , "smo3"   )==0 ){gf_MtReqOfs[2].bf.req=true; gf_MtReqOfs[2].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        else if (strcmp(g_CmdBuf , "smo4"   )==0 ){gf_MtReqOfs[3].bf.req=true; gf_MtReqOfs[3].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        else if (strcmp(g_CmdBuf , "smo"   )==0 ){
+            for(int i = 0; i < 4; ++i){
+                gf_MtReqOfs[i].bf.req=true; 
+                gf_MtReqOfs[i].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);
+            }
+        }
+        else if (strcmp(g_CmdBuf , "smof"   )==0 ){
+            gf_MtReqOfs[0].bf.req=true;
+            gf_MtReqOfs[0].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);
+            gf_MtReqOfs[1].bf.req=true;
+            gf_MtReqOfs[1].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        else if (strcmp(g_CmdBuf , "smor"   )==0 ){
+            gf_MtReqOfs[2].bf.req=true;
+            gf_MtReqOfs[2].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);
+            gf_MtReqOfs[3].bf.req=true;
+            gf_MtReqOfs[3].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);            }
+        else if (strcmp(g_CmdBuf , "smfpga1"   )==0 ){gf_MtReqDct[0].bf.req=true; gf_MtReqDct[0].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        else if (strcmp(g_CmdBuf , "smfpga2"   )==0 ){gf_MtReqDct[1].bf.req=true; gf_MtReqDct[1].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        else if (strcmp(g_CmdBuf , "smfpga3"   )==0 ){gf_MtReqDct[2].bf.req=true; gf_MtReqDct[2].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        else if (strcmp(g_CmdBuf , "smfpga4"   )==0 ){gf_MtReqDct[3].bf.req=true; gf_MtReqDct[3].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        else if (strcmp(g_CmdBuf , "smfpga5"   )==0 ){gf_MtReqDct[4].bf.req=true; gf_MtReqDct[4].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        else if (strcmp(g_CmdBuf , "smfpga6"   )==0 ){gf_MtReqDct[5].bf.req=true; gf_MtReqDct[5].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        else if (strcmp(g_CmdBuf , "smfpga7"   )==0 ){gf_MtReqDct[6].bf.req=true; gf_MtReqDct[6].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        else if (strcmp(g_CmdBuf , "smfpga8"   )==0 ){gf_MtReqDct[7].bf.req=true; gf_MtReqDct[7].bf.val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
         
         //キャリブレーション
         else if (strcmp(g_CmdBuf , "calyaw")==0 ){gf_Cal.bf.yaw=true;}//