Diff: hbCommand.cpp

Revision:

50:76413e8e073d

Parent:

48:71aec693a7dc

Child:

53:b09c062cc31c

--- a/hbCommand.cpp	Mon Feb 25 12:51:35 2019 +0000
+++ b/hbCommand.cpp	Tue Feb 26 08:44:06 2019 +0000
@@ -83,6 +83,16 @@
             gf_MtReq[2].val=(UINT16)atoi(&g_CmdBuf[arg2pos]);
             gf_MtReq[3].req=true;
             gf_MtReq[3].val=(UINT16)atoi(&g_CmdBuf[arg2pos]);            }
+        else if (strcmp(g_CmdBuf , "smao1"   )==0 ){gf_MtAttOfs[0].req=true; gf_MtAttOfs[0].val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        else if (strcmp(g_CmdBuf , "smao2"   )==0 ){gf_MtAttOfs[1].req=true; gf_MtAttOfs[1].val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        else if (strcmp(g_CmdBuf , "smao3"   )==0 ){gf_MtAttOfs[2].req=true; gf_MtAttOfs[2].val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        else if (strcmp(g_CmdBuf , "smao4"   )==0 ){gf_MtAttOfs[3].req=true; gf_MtAttOfs[3].val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        else if (strcmp(g_CmdBuf , "smao"   )==0 ){
+            for(int i = 0; i < 4; ++i){
+                gf_MtAttOfs[i].req=true; 
+                gf_MtAttOfs[i].val=(UINT16)atoi(&g_CmdBuf[arg2pos]);
+            }
+        }
         else if (strcmp(g_CmdBuf , "smo1"   )==0 ){gf_MtReqOfs[0].req=true; gf_MtReqOfs[0].val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
         else if (strcmp(g_CmdBuf , "smo2"   )==0 ){gf_MtReqOfs[1].req=true; gf_MtReqOfs[1].val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
         else if (strcmp(g_CmdBuf , "smo3"   )==0 ){gf_MtReqOfs[2].req=true; gf_MtReqOfs[2].val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
@@ -230,6 +240,16 @@
             gf_MtReqOfs[2].val=(UINT16)atoi(&g_CmdBuf[arg2pos]);
             gf_MtReqOfs[3].req=true;
             gf_MtReqOfs[3].val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
+        else if (strcmp(g_CmdBuf , "smao1"   )==0 ){gf_MtAttOfs[0].req=true; gf_MtAttOfs[0].val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}//!< Set Motor Attitude Offset 1
+        else if (strcmp(g_CmdBuf , "smao2"   )==0 ){gf_MtAttOfs[1].req=true; gf_MtAttOfs[1].val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}//!< Set Motor Attitude Offset 2
+        else if (strcmp(g_CmdBuf , "smao3"   )==0 ){gf_MtAttOfs[2].req=true; gf_MtAttOfs[2].val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}//!< Set Motor Attitude Offset 3
+        else if (strcmp(g_CmdBuf , "smao4"   )==0 ){gf_MtAttOfs[3].req=true; gf_MtAttOfs[3].val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}//!< Set Motor Attitude Offset 4
+        else if (strcmp(g_CmdBuf , "smao"   )==0 ){//!< Set Motor Attitude Offset
+            for(int i = 0; i < 4; ++i){
+                gf_MtAttOfs[i].req=true; 
+                gf_MtAttOfs[i].val=(UINT16)atoi(&g_CmdBuf[arg2pos]);
+            }
+        }
         else if (strcmp(g_CmdBuf , "smfpga1"   )==0 ){gf_MtReqDct[0].req=true; gf_MtReqDct[0].val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
         else if (strcmp(g_CmdBuf , "smfpga2"   )==0 ){gf_MtReqDct[1].req=true; gf_MtReqDct[1].val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}
         else if (strcmp(g_CmdBuf , "smfpga3"   )==0 ){gf_MtReqDct[2].req=true; gf_MtReqDct[2].val=(UINT16)atoi(&g_CmdBuf[arg2pos]);}