加速度・ジャイロによるカルマンフィルタ―用ライブラリ
Dependents: Kalman_test 201903_pf_lower_judgment_sashida 201903_pf_lower_judgment 201903_pf_lower_judgment
Kalman.h@0:3e14df89021f, 2018-01-19 (annotated)
- Committer:
- mikawataru
- Date:
- Fri Jan 19 10:41:41 2018 +0000
- Revision:
- 0:3e14df89021f
initialize
Who changed what in which revision?
User | Revision | Line number | New 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 |