rampgen.c

来自「在ccs编程环境下」· C语言 代码 · 共 27 行

#include "IQmathLib.h"         /* Include header for IQmath library */
/* Don't forget to set a proper GLOBAL_Q in "IQmathLib.h" file */
#include "rampgen.h"

void rampgen_calc(RAMPGEN *v)
{	

        v->angle_rg += _IQmpy(v->step_angle_max,v->rmp_freq);       
        
        if (v->angle_rg>_IQ(1.0))
          v->angle_rg -= _IQ(1.0);
        //else if (v->angle_rg<_IQ(-1))
        //  v->angle_rg += _IQ(1);

       v->rmp_out = _IQmpy(v->angle_rg,v->rmp_gain) + v->rmp_offset;

       if (v->rmp_out>_IQ(1))
          v->rmp_out -= _IQ(1);
        else if (v->rmp_out<_IQ(-1))
          v->rmp_out += _IQ(1);

}