ftf5.h

快速横向滤波器FTF用于系统参数估计

# define N 5
# include <iostream.h>
#include <iomanip.h>
#include <stdlib.h>
#include <time.h>


  double matrix_product(double X[][N], double Y[][1], int row)
  { double sum=0.0;
    for(int i=0;i<1;i++)
      for(int j=0;j<row;j++)
      sum+=X[i][j]*Y[j][i];
    return sum;
  }
  void matrix_copy (double X[][1], double Y[][1], int row)
  { for(int i=0;i<row;i++)
     for(int j=0;j<1;j++)
      X[i][j]=Y[i][j];
  }
  void matrix_copy2 (double X[][N], double Y[][N], int column)
  { for(int i=0;i<1;i++)
     for(int j=0;j<column;j++)
      X[i][j]=Y[i][j];
  }
  void matrix_coefficient(double x, double Y[][1], int row)
  { for(int i=0;i<row;i++)
     for(int j=0;j<1;j++)
     Y[i][j]=x*Y[i][j];
  }
  void matrix_sum(double X[][1], double Y[][1], int row)
  { for(int i=0;i<row;i++)
     for(int j=0;j<1;j++)
     X[i][j]+=Y[i][j];
  }
  void matrix_equivalent(double X[][1], double Y[][1], int row, double first_element)
  { X[0][0]=first_element;
    for(int i=1;i<row;i++)
     for(int j=0;j<1;j++)
     X[i][j]=Y[i-1][j];
  }
  void matrix_new(double x, double X[][N], int column)
  { for(int i=0;i<1;i++)
     for(int j=column-1;j>=1;j--)
     X[i][j]=X[i][j-1];
     X[0][0]=x;
  }