针对16位非负数的滑动滤波函数

ID:65608 · 发表于 2014-8-31 02:28

介绍一个个人编写的滑动滤波函数：

#define OHG_BUF_IDX_MOV_STEP       1U
#define OHG_BUF_FLG_FULL             1U
#define OHG_BUF_FLG_NOT_FULL       0U
#define OHG_BUF_IDX_RESET          0U

typedef struct _T_OHG_FILTER
{
INT16U u16_mFilterRult;
INT32U u32_mDataSum;
INT8U  u8_mBufIndex;
INT8U  u8_mBufFullFlg;
INT8U  u8_mSampFactor;
}T_OHG_FILTER_TYP;

函数原型：

void hOverHeat_vMovFilter(INT16U sampData, T_OHG_FILTER_TYP *pMovFliterObj, INT16U *pBuf)
{
pMovFliterObj->u32_mDataSum += sampData;

pBuf[pMovFliterObj->u8_mBufIndex] = sampData;

pMovFliterObj->u8_mBufIndex = (INT8U)((pMovFliterObj->u8_mBufIndex + OHG_BUF_IDX_MOV_STEP) % (pMovFliterObj->u8_mSampFactor));

if (pMovFliterObj->u8_mBufFullFlg != OHG_BUF_FLG_NOT_FULL)
{
      pMovFliterObj->u32_mDataSum -= pBuf[pMovFliterObj->u8_mBufIndex];

      pMovFliterObj->u16_mFilterRult = (INT16U)(pMovFliterObj->u32_mDataSum / (pMovFliterObj->u8_mSampFactor));
}
else
{
      if (pMovFliterObj->u8_mBufIndex == OHG_BUF_IDX_RESET)
      {
         pMovFliterObj->u8_mBufFullFlg = OHG_BUF_FLG_FULL;

         pMovFliterObj->u16_mFilterRult = (INT16U)(pMovFliterObj->u32_mDataSum / (pMovFliterObj->u8_mSampFactor));
      }
      else
      {
         pMovFliterObj->u16_mFilterRult = (INT16U)(pMovFliterObj->u32_mDataSum / pMovFliterObj->u8_mBufIndex);
      }
}
}

用法：

1：定义对象和软件缓冲区：

static T_OHG_FILTER_TYP STC_CurMovFilterObj;

#define OHG_CUR_SAMP_FACTOR 10u
static INT16U hOverHeat_aCurFilterBuf[OHG_CUR_SAMP_FACTOR];

2：初始化对象

for(i=0; i
{
hOverHeat_aCurFilterBuf = 0U;
}

STC_CurMovFilterObj.u16_mFilterRult = 0U;

STC_CurMovFilterObj.u32_mDataSum = 0U;

STC_CurMovFilterObj.u8_mBufIndex = OHG_BUF_IDX_RESET;
STC_CurMovFilterObj.u8_mBufFullFlg = OHG_BUF_FLG_NOT_FULL;

STC_CurMovFilterObj.u8_mSampFactor = OHG_CUR_SAMP_FACTOR;

3：周期调用滤波函数：

hOverHeat_vMovFilter(((INT16U)MotorActualCur), &STC_CurMovFilterObj, hOverHeat_aCurFilterBuf);

4：需要时读取结果：

hOverHeat_u16SysCurrent = STC_CurMovFilterObj.u16_mFilterRult;

帐号		自动登录	找回密码
密码			立即注册