标题: 针对16位非负数的滑动滤波函数 [打印本页]

作者: daliu    时间: 2014-8-31 02:28
标题: 针对16位非负数的滑动滤波函数
介绍一个个人编写的滑动滤波函数:
#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;






欢迎光临 (http://www.51hei.com/bbs/) Powered by Discuz! X3.1