前言
最近在考虑如何实现kalman跟踪,其中涉及较多矩阵运算,比如矩阵相乘、矩阵转置等,先实现了一个矩阵相乘的c代码如下。其实,后续可以使用matrix类实现kalman跟踪。
code
#include "stdio.h" void Multi(int * left, int * right, int * result, int f1, int f2, int s1, int s2); int main() { int i, j; int a[4][3] = { {1,2,3}, {4,5,6}, {7,8,9}, {1,2,3}}; int b[3][3] = { { 1,2,3 }, { 4,5,6 }, {7,8,9} }; //c矩阵为a矩阵与b矩阵的乘积 int c[4][3]; //计算两个矩阵相乘 Multi(a[0], b[0],c[0], 4, 3, 3, 3); //输出c矩阵 for (i = 0; i < 4; i++) { for(j=0;j<3;j++) printf("%4d ", c[i][j]); printf("\n"); } //system("pause"); return 0; } //矩阵相乘算法,最后四个参数是两个相乘的矩阵的行数和列数 void Multi(int * left, int * right, int * result,int f1, int f2, int s1, int s2) { //int a[f1][f2], b[s1][s2], c[f1][s2]; //a[i][j]==a[i*f2+j] //由矩阵相乘,要求f2=s1,以下用f2 for (int i = 0; i < f1; i++) //i表示第i行 { for (int j = 0; j < s2; j++) //j表示第j列 { result[i*f2 + j] = 0; //在这里 result[i][j] = result[i*f2+j]; for(int p=0;p<f2;p++) { result[i*f2 + j] +=left[i*f2+p]*right[p*f2+j]; } } } }View Code
参考
1. 矩阵相乘;
2. github_ikalman;
完 标签:Multi,kalman,int,矩阵,C语言,相乘 From: https://www.cnblogs.com/happyamyhope/p/16924803.html