加速度・ジャイロによるカルマンフィルタ―用ライブラリ
Dependents: Kalman_test 201903_pf_lower_judgment_sashida 201903_pf_lower_judgment 201903_pf_lower_judgment
Kalman.h
- Committer:
- mikawataru
- Date:
- 2018-01-19
- Revision:
- 0:3e14df89021f
File content as of revision 0:3e14df89021f:
#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