#include <actcalKALMAN.h>
Public Methods | |
actcalKALMAN () | |
~actcalKALMAN () | |
ccsCOMPL_STAT | Configure (vltDOUBLE inpSigmaXp_init, vltDOUBLE inpSigmaXv_init, vltDOUBLE inpSigmaXp, vltDOUBLE inpSigmaXv, vltDOUBLE inpSigmaNoise) |
ccsCOMPL_STAT | Init () |
ccsCOMPL_STAT | Calculate (vltDOUBLE time_mea, vltDOUBLE Xp_mea) |
vltDOUBLE | GetPosition () |
vltDOUBLE | GetSqrError () |
Private Attributes | |
vltDOUBLE | sigmaXp |
vltDOUBLE | sigmaXv |
vltDOUBLE | sigmaNoise |
vltDOUBLE | sigmaXp_init |
vltDOUBLE | sigmaXv_init |
vltDOUBLE | Xv_init |
vltDOUBLE | T_init |
vltDOUBLE | Qpp |
vltDOUBLE | Qvv |
vltDOUBLE | pee |
vltLOGICAL | first_iteration |
vltDOUBLE | Xp_new |
vltDOUBLE | Xv_new |
vltDOUBLE | Xp_err |
vltDOUBLE | Ppp_new |
vltDOUBLE | Ppv_new |
vltDOUBLE | Pvp_new |
vltDOUBLE | Pvv_new |
vltDOUBLE | time_old |
Vector | sigmaXpInit |
actcalMAX_NUM_MODES | |
Vector | sigmaXvInit |
Vector | sigmaXp |
Vector | sigmaXv |
Vector | sigmaNoise |
boolean | filterActive |
boolean | controlActive |
double | controlP |
double | controlI1 |
double | controlI2 |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|