Dydaktyka
Dependencies: FastPWM mbed-src
Fork of 2015_04_17_quadro_bez_sterowania by
Diff: kalman.h
- Revision:
- 12:e955cc086c42
- Parent:
- 9:4e94a16ca90c
--- a/kalman.h Fri Apr 17 07:48:05 2015 +0000 +++ b/kalman.h Fri Apr 17 14:25:25 2015 +0000 @@ -16,13 +16,13 @@ //#define DT 0.002472 //klaman2 + filtr dolno x2 //#define DT 0.00223 //klaman2 + filtr dolno x2 bez kompl // Q matrix elements -#define Q1 0.2f //0.2f //5 //10 -#define Q2 2.0f //2.0f //80 //120 -#define Q3 0.01 //0.01f +#define Q1 0.2f //0.2f //5 //10 +#define Q2 2.0f //2.0f //80 //120 +#define Q3 0.01 //0.01f // R matrix elements -#define R1 120 //500.0f //900.0f //90 //tu duzo //10000 //500 -#define R2 150 //600.0f //1500.0f //150 //tu mniej //12000 //600 +#define R1 120 //500.0f //900.0f //90 //tu duzo //10000 //500 +#define R2 150 //600.0f //1500.0f //150 //tu mniej //12000 //600 struct _kalman_data { @@ -36,6 +36,4 @@ void kalman_innovate(kalman_data *data, float z1, float z2); void kalman_init(kalman_data *data); - - #endif /* KALMAN_H_ */