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

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