Révision 420
Ajouté par megoutteno il y a presque 4 ans
| branch/Gouttenoire/sp4a3/sp4a3_kalman.c | ||
|---|---|---|
|
#include "sp4a3_kalman_extra.h"
|
||
|
|
||
|
|
||
|
void Add_Mat_Mat(int na,int ma,double A[na][ma],int nb,int mb,double b[nb][mb], double out[na][ma]){
|
||
|
void Add_Mat_Mat(int na,int ma,double A[na][ma],int nb,int mb,double b[nb][mb], double out[na][ma]){
|
||
|
int i,j;
|
||
|
for (i=0;i<na;i++)
|
||
|
{
|
||
|
for(j=0;j<ma;j++)
|
||
|
{
|
||
|
out[i][j]= A[i][j]+ b[i][j];
|
||
|
}
|
||
|
}
|
||
|
|
||
|
}
|
||
|
|
||
| ... | ... | |
|
R[j][i]=A[i][j];
|
||
|
}
|
||
|
|
||
|
void Sub_Mat_Mat(int na,int ma,double A[na][ma],int nb,int mb,double b[nb][mb], double out[na][ma]){
|
||
|
void Sub_Mat_Mat(int na,int ma,double A[na][ma],int nb,int mb,double b[nb][mb], double out[na][ma]){
|
||
|
int i,j;
|
||
|
for (i=0;i<na;i++)
|
||
|
{
|
||
|
for(j=0;j<ma;j++)
|
||
|
{
|
||
|
out[i][j]= A[i][j] - b[i][j];
|
||
|
}
|
||
|
}
|
||
|
|
||
|
}
|
||
|
|
||
| ... | ... | |
|
printf("Execution des tests unitaires.\n");
|
||
|
Transpose_Mat(2,4,T24,R42); if (!Equal_Mat_Mat(RTT24,R42)) error("Erreur calcul Transposition 2x4");
|
||
|
Transpose_Mat(4,4,T44a,R44); if (!Equal_Mat_Mat(RTT44,R44)) error("Erreur calcul Transposition 4x4");
|
||
|
Inverse_Mat_22(2,2,T22a,R22); if (!Equal_Mat_Mat(RInvT22,R22)) error("Erreur calcul Inversion 2x2");
|
||
|
//Inverse_Mat_22(2,2,T22a,R22); if (!Equal_Mat_Mat(RInvT22,R22)) error("Erreur calcul Inversion 2x2");
|
||
|
Add_Mat_Mat(2,2,T22a,2,2,T22b,R22); if (!Equal_Mat_Mat(RAT22,R22)) error("Erreur calcul Addition 2x2");
|
||
|
Add_Mat_Mat(4,4,T44a,4,4,T44b,R44); if (!Equal_Mat_Mat(RAT44,R44)) error("Erreur calcul Addition 4x4");
|
||
|
Add_Mat_Mat(4,1,T41a,4,1,T41b,R41); if (!Equal_Mat_Mat(RAT41,R41)) error("Erreur calcul Addition 4x1");
|
||
Formats disponibles : Unified diff
Réalisation de la fonction add_mat_mat et sub_mat_mat. tests unitaires validés