«
Précédent
|
Suivant
»
Révision 585
Ajouté par Mafall FALL il y a presque 3 ans
| branche/Mafall_FALL/sp4a3/sp4a3_kalman.c | ||
|---|---|---|
|
Plot_Mat(P," P(k+1|k+1) = P(k+1|k) - K.H.P(k+1|k) = ");
|
||
|
|
||
|
/// La matrice X doit contenir la position filtrée ///
|
||
|
}
|
||
|
|
||
|
int i;
|
||
|
for(i=0;i<4;i++) X[i][0]=G0[i][0];
|
||
|
}
|
||
|
|
||
|
t = cpt * dt;
|
||
|
dx = (xobs - oldx)/dt;
|
||
|
dy = (yobs - oldy)/dt;
|
||
Formats disponibles : Unified diff
Revision Kalmann