Révision 254
Ajouté par magraffin il y a presque 4 ans
| branch/graffin/sp4a3/sp4a3_kalman.c | ||
|---|---|---|
|
// P = P - K*H*P;
|
||
|
Mul_Mat_Mat(4,2,K,2,4,H,Res2); //K*H
|
||
|
Mul_Mat_Mat(4,4,Res2,4,4,P,Res3); //K*H*P
|
||
|
Sub_Mat_Mat(4,4,P,4,4,Res4,Res2);
|
||
|
Sub_Mat_Mat(4,4,P,4,4,Res3,Res2);
|
||
|
copie_mat(4,4,Res2,P);
|
||
|
|
||
|
|
||
Formats disponibles : Unified diff
mise a jour du code il reste une erreur