加速度・ジャイロによるカルマンフィルタ―用ライブラリ
Dependents: Kalman_test 201903_pf_lower_judgment_sashida 201903_pf_lower_judgment 201903_pf_lower_judgment
Diff: Kalman.h
- Revision:
- 0:3e14df89021f
diff -r 000000000000 -r 3e14df89021f Kalman.h --- /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