Révision 244
Ajouté par magraffin il y a presque 4 ans
| sp4a3_kalman.c | ||
|---|---|---|
|
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<mb;i++){
|
||
|
for (j=0;j<ma;j++){
|
||
|
out[i][j]=A[i][j]+B[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]){
|
||
|
int i,j;
|
||
|
for (i=0;i<na;i++){
|
||
|
for (j=0;j<mb;i++){
|
||
|
for (j=0;j<mb;j++){
|
||
|
out[i][j]=A[i][j]-B[i][j];
|
||
|
}
|
||
|
}
|
||
| ... | ... | |
|
for (j=0;j<mb;j++){
|
||
|
somme=0;
|
||
|
for (k=0;k<ma;k++){
|
||
|
somme+=A[i][k]*B[k][i];
|
||
|
somme+=A[i][k]*B[k][j];
|
||
|
}
|
||
|
out[i][j]=somme;
|
||
|
}
|
||
Formats disponibles : Unified diff
fin de l'implémentation des fonctions