filterv2.c

来自「利用Stateflow 进行嵌入式代码开发很好用」· C语言 代码 · 共 27 行

#include "your_types.h"
#include "filter.h"

/* IIR First Order Filter */
FLT filterV2(const FLT* signal, const FLT prevSignal, const FLT gain)
{
  FLT filtOut;
  FLT a1,b0;
  
  /* Limit gain */
  if (gain > 1)
      a1 = 1;
  else if (gain < 0)
      a1 = 0;
  else
      a1 = gain;
  
  /* Calculate filter const */
  b0 = 1-a1;

  /* Calculate difference equation */
  filtOut = b0**signal + a1*prevSignal;
      
  /* Return Result */
  return filtOut;
}