VS2010环境下编写C程序,提示缺少“)”、“{”等符号,是哪个地方出错了?我把代码贴出来,还望大神指导一下,多谢!
#define N 10 /Kalman滤波器追踪点数/
typedef struct Kalman_state
{
float x[2][1]; /状态矩阵/
float A[2][2]; /转移矩阵/
float H[2][2]; /测量矩阵/
float Q[2][2]; /系统噪声矩阵/
float P[2][2]; /协方差矩阵/
float K[2][2]; /Kalman增益/
float R[2][2]; /测量噪声矩阵/
};
void Kalman_init(Kalman_state *state)
{
//state->x = {900,0}
state->x[0][0] = 900;
state->x[1][0] = 0;
for(int i = 1; i < N-1; i++)
{
state->x[0][i] = 0;
state->x[1][i] = 0;
}
//state->P_last = {
{30,0},{0,50}}
state->P[0][0] = 30;
state->P[0][1] = 0;
state->P[1][0] = 0;
state->P[1][1] = 50;
//state->A = {
{1,0},{0,1}}
state->A[0][0] = 1;
state->A[0][1] = 0;
state->A[1][0] = 0;
state->A[1][1] = 1;
//state->H = {
{1,0},{0,1}}
state->H[0][0] = 1;
state->H[0][1] = 0;
state->H[1][0] = 0;
state->H[1][1] = 1;
//state->Q = {
{50,0},{0,13}}
state->Q[0][0] = 1;
state->Q[0][1] = 0;
state->Q[1][0] = 0;
state->Q[1][1] = 1;
//state->R = {
{80,0},{0,0}}
state->R[0][0] = 80;
state->R[0][1] = 0;
state->R[1][0] = 0;
state->R[1][1] = 0;
}
float Kalman_filter(Kalman_state state, float s_measure)
{
float P_mid[2][2];
float temp_P[2][2];
float temp_HP[2][2];
float A_T[2][2];
float H_T[2][2];
float temp_PH_T[2][2];
float temp_RHPH_T[2][2];
float temp_RHPH_