teamALI / Mbed 2 deprecated HB2018

Dependencies:   mbed FreeRTOS

Revision:
67:ad35921e3cdc
Parent:
52:33fa8060dd8c
--- a/HbAttitude.cpp	Mon Mar 11 04:07:43 2019 +0000
+++ b/HbAttitude.cpp	Mon Mar 11 06:36:33 2019 +0000
@@ -106,6 +106,16 @@
 }
 
 //=========================================================
+//前回値・積分値のリセット
+//=========================================================
+void HbAttitude::resetValue()
+{
+    sum   =0    ;//積分値
+    old   =0    ;//1サンプル前のデータ(微分用)
+    oAng = 0    ;//1サンプル前の角度
+}
+
+//=========================================================
 //パラメータゲッター
 //=========================================================
 float HbAttitude::getPp(){return p;}