teamALI / Mbed 2 deprecated HB2018

Dependencies:   mbed FreeRTOS

Revision:
63:aee44afe6363
Parent:
56:f363a6877c6a
Child:
66:0b3b290137b6
--- a/userTask.cpp	Fri Mar 08 11:43:00 2019 +0000
+++ b/userTask.cpp	Mon Mar 11 02:25:41 2019 +0000
@@ -77,6 +77,7 @@
     INT16 TrtlVal;
     float AxlRow;
 
+    INT16 MotorOffsetValue = 1500;
     
     while(1){
         // DISPLAY LED
@@ -226,6 +227,7 @@
                 if(gf_StateEnt){
                     sp.printf("UPPER IDLE state\r\n");
                     hb.calAtt();//現在値でヨー角校正
+                    // 
                     gf_StateEnt = false;
                 }
                 //SWのチェック
@@ -237,6 +239,7 @@
             case TAKE_OFF:
                 if(gf_StateEnt){
                     sp.printf("TAKE_OFF state\r\n");
+                    hb.setMotTakeOffOffset();
                     hb.calAtt();//現在値でヨー角校正
                     gf_StateEnt = false;
                 }