Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Diff: hbCommand.cpp
- 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;}//