Révision 543
Ajouté par Yannis SENOUCI il y a environ 3 ans
| branch/SENOUCI/sp4a3/sp4a3_kalman.c | ||
|---|---|---|
|
|
||
|
Plot_Mat(P2," P(k+1|k+1) = P(k+1|k) - K.H.P(k+1|k) = ");
|
||
|
|
||
|
//la position change donc : X(k+1|k) prend la valeur de X(k+1|k+1)
|
||
|
//la position change donc : X(k+1|k) prend la valeur de X(k+1|k+1) et X(k|k) devient X(k+1|k
|
||
|
for(i=0;i<4;i++)
|
||
|
{
|
||
|
for(j=0;j<1;j++)
|
||
| ... | ... | |
|
}
|
||
|
}
|
||
|
|
||
|
//la variance du vecteur d'état change à chaque iteration de X : P(k+1|k) prend la valeur de P(k+1|k+1)
|
||
|
//la variance du vecteur d'état change à chaque iteration de X
|
||
|
for(i=0;i<4;i++)
|
||
|
{
|
||
|
for(j=0;j<4;j++)
|
||
Formats disponibles : Unified diff
rectification commentaire filtre kalman