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

Dependents:   Kalman_test 201903_pf_lower_judgment_sashida 201903_pf_lower_judgment 201903_pf_lower_judgment

Committer:
mikawataru
Date:
Fri Jan 19 10:41:41 2018 +0000
Revision:
0:3e14df89021f
initialize

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mikawataru 0:3e14df89021f 1 #ifndef _KALMAN_H
mikawataru 0:3e14df89021f 2 #define _KALMAN_H
mikawataru 0:3e14df89021f 3
mikawataru 0:3e14df89021f 4 class KalmanFilter {
mikawataru 0:3e14df89021f 5 private:
mikawataru 0:3e14df89021f 6 float angle;
mikawataru 0:3e14df89021f 7 float bias;
mikawataru 0:3e14df89021f 8 float P[2][2];
mikawataru 0:3e14df89021f 9 public:
mikawataru 0:3e14df89021f 10 KalmanFilter();
mikawataru 0:3e14df89021f 11 void setAngle(float newAngle);
mikawataru 0:3e14df89021f 12 float calcAngle(float newAngle, float newRate, float dt);
mikawataru 0:3e14df89021f 13 };
mikawataru 0:3e14df89021f 14
mikawataru 0:3e14df89021f 15 #endif