Diff: HbManager.cpp

Revision:

57:56b7e66a0c3d

Parent:

56:f363a6877c6a

Child:

59:6b4dcd964d0f

--- a/HbManager.cpp	Wed Mar 06 02:18:47 2019 +0000
+++ b/HbManager.cpp	Thu Mar 07 04:01:10 2019 +0000
@@ -847,6 +847,31 @@
             gf_AxReq[1].bf.val = tmpAxl;
         }
     }
+    if(chkSWUserOpeRE(HbUserOpe::CTRL_SW)){
+        bool flg = false;
+        switch (g_PidPara.mode)
+        {
+            case PID_0_OFF:
+                g_PidPara.mode = PID_0_ON;
+                flg = true;
+                break;
+            case PID_1_OFF:
+                g_PidPara.mode = PID_1_ON;
+                flg = true;
+                break;
+            case PID_0_ON:
+                /* code */
+                g_PidPara.mode = PID_0_OFF;
+                break;
+            case PID_1_ON:
+                g_PidPara.mode = PID_1_OFF;
+                break;
+            default:
+                g_PidPara.mode = PID_0_OFF;
+                break;
+        }
+        sp.printf("CTRL_SW Push : %d \r\n", flg);
+    }
     // if(chkSWUserOpe(HbUserOpe::ALL_STOP)){
     //     // モーター
     //     for(int i = 0; i < 4; ++i){