Wataru Mikawa / Kalman

加速度・ジャイロによるカルマンフィルタ―用ライブラリ

Dependents:   Kalman_test 201903_pf_lower_judgment_sashida 201903_pf_lower_judgment 201903_pf_lower_judgment

Diff: Kalman.h

Revision:
0:3e14df89021f
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Kalman.h	Fri Jan 19 10:41:41 2018 +0000
@@ -0,0 +1,15 @@
+#ifndef _KALMAN_H
+#define _KALMAN_H
+
+class KalmanFilter {
+private:
+    float angle;
+    float bias;
+    float P[2][2];
+public:
+    KalmanFilter();
+    void setAngle(float newAngle);
+    float calcAngle(float newAngle, float newRate, float dt);
+};
+
+#endif
\ No newline at end of file