以陷波器为例:
1、编写NF.c文件
主要的内容有:
- include本身的h文件
- define 函数需要使用的常量,但是后期有可能会修改的,以便后期更改
- 函数本体
- 函数初始化
#include "SimMath.h" //重要,一定需要!!
//################################NF Algorithm###############################
void NF_Fun(NF_STRUCT *nf)
{
nf->a1 = -1.93531624555232; //1e-4的采样率
nf->a2 = 0.939140180772028;
nf->b0 = 0.969600520295628;
nf->b1 = -1.93531624555232;
nf->b2 = 0.969539660476400;
nf->Out = nf->b0 * nf->In + nf->b1 * nf->rn1 + nf->b2 * nf->rn2- (nf->a1*nf->cn1 + nf->a2*nf->cn2);
nf->cn2 = nf->cn1;
nf->cn1 = nf->Out;
nf->rn2 = nf->rn1;
nf->rn1 = nf->In;
}
//###################################PID Initialize###################################
void NF_Init(NF_STRUCT *nf)
{
nf->Out = 0;
nf->cn1 &#